box_with_hj_with_ccylinder.rsg

rcssserver3d Robocup 3D比赛官方指定平台

;; -*- mode: lisp; -*-

(RSG 0 1)
(
 (templ $name $perceptorName $effectorName $attach
	$x $y $z
	$lenX $lenY $lenZ
	$anchorX $anchorY $anchorZ
	$axisX $axisY $axisZ $minDeg $maxDeg
	$totalMass $material $ElbowRadius $ElbowLen)

 (nd Transform
     (setName $name)
     (setLocalPos $x $y $z)
     (importScene rsg/agent/soccerbot058/box.rsg
		  $lenX $lenY $lenZ
		  $totalMass $material)

     ;; install hinge joint
     (importScene rsg/agent/nao/hingejoint.rsg
		  $perceptorName $effectorName
		  ../boxBody $attach
		  $anchorX    $anchorY   $anchorZ
		  $axisX      $axisY     $axisZ
		  $minDeg $maxDeg)
	
     ;; static cylinder for the elbow
     (nd Transform
	 (setLocalPos $anchorX $anchorY $anchorZ)
	 (setLocalRotation 0 90 0)
	 (nd CCylinder
	     (setMaterial matGrey)
	     (setParams $ElbowRadius $ElbowLen)
	     )
	 )
     )
 )