@@ -602,10 +602,10 @@ def compute_simple_fk(self, arm_id="left_arm"):
602602 def _init_pose (self ):
603603 # Initialize robot pose
604604 poses = {
605- self .interface .head : [0.0 , 0.0 ],
606- self .interface .leg : [0.2 , 0.756 , 0.53 , 0.0 ],
607- self .interface .left_arm : [- 0.4654513936071508 , 1.4785659313201904 , - 0.6235712173907869 , 2.097979784011841 , 1.3999720811843872 , - 0.009971064515411854 , 1.0999830961227417 ],
608- self .interface .right_arm : [0.4654513936071508 , - 1.4785659313201904 , 0.6235712173907869 , - 2.097979784011841 , - 1.3999720811843872 , 0.009971064515411854 , - 1.0999830961227417 ]
605+ self .interface .head : [0.0 , 0.26 ],
606+ self .interface .leg : [0.0821758285164833 , 0.6340972781181335 , 0.5227039456367493 , - 0.00001198422432935331 ],
607+ self .interface .left_arm : [2.0020599365234375 , - 1.5977126359939575 , - 0.5948255658149719 , - 1.694089651107788 , - 0.0002879792882595211 , - 0.7909831404685974 , - 0.00016755158139858395 ],
608+ self .interface .right_arm : [- 2.001628875732422 , 1.6029852628707886 , 0.6024474501609802 , 1.6955766677856445 , - 0.0002391100861132145 , 0.7967827916145325 , - 0.00014311698032543063 ]
609609 }
610610
611611 for module , pose in poses .items ():
0 commit comments