@@ -13,13 +13,9 @@ def __init__(self) -> None:
1313 self ._logger = logging .getLogger (__name__ )
1414 # b is the mobile base
1515 # d is the camera
16- self ._T_d_b = np .array (
17- [[0 , 0 , - 1 , 250 ], [0 , - 1 , 0 , - 150 ], [- 1 , 0 , 0 , 200 ], [0 , 0 , 0 , 1 ]]
18- )
16+ self ._T_d_b = np .array ([[0 , 0 , - 1 , 250 ], [0 , - 1 , 0 , - 150 ], [- 1 , 0 , 0 , 200 ], [0 , 0 , 0 , 1 ]])
1917
20- self ._T_d_e = np .array (
21- [[0 , 0 , - 1 , 300 ], [0 , - 1 , 0 , 100 ], [- 1 , 0 , 0 , 120 ], [0 , 0 , 0 , 1 ]]
22- ) # e is the object
18+ self ._T_d_e = np .array ([[0 , 0 , - 1 , 300 ], [0 , - 1 , 0 , 100 ], [- 1 , 0 , 0 , 120 ], [0 , 0 , 0 , 1 ]]) # e is the object
2319 self ._T_b_c = np .array (
2420 [
2521 [0 , - 1 / np .sqrt (2 ), - 1 / np .sqrt (2 ), 30 ],
@@ -28,9 +24,7 @@ def __init__(self) -> None:
2824 [0 , 0 , 0 , 1 ],
2925 ]
3026 ) # c is the joint of the gripper
31- self ._T_a_d = np .array (
32- [[0 , 0 , - 1 , 400 ], [0 , - 1 , 0 , 50 ], [- 1 , 0 , 0 , 300 ], [0 , 0 , 0 , 1 ]]
33- ) # a is the root
27+ self ._T_a_d = np .array ([[0 , 0 , - 1 , 400 ], [0 , - 1 , 0 , 50 ], [- 1 , 0 , 0 , 300 ], [0 , 0 , 0 , 1 ]]) # a is the root
3428
3529 def get_object_in_gripper_frame (self ) -> npt .NDArray [np .float64 ]:
3630 T_c_e = (
0 commit comments