In qp inverse kinematic file, the tool frames self.tcps is defined as [] if not given a value.
This commit is contained in:
@@ -138,7 +138,7 @@ class KinematicsSolver():
|
|||||||
)
|
)
|
||||||
|
|
||||||
if tcps is None:
|
if tcps is None:
|
||||||
pass
|
self.tcps = []
|
||||||
else:
|
else:
|
||||||
self.tcps = tcps
|
self.tcps = tcps
|
||||||
self.tcp_ids = []
|
self.tcp_ids = []
|
||||||
|
|||||||
@@ -102,7 +102,7 @@ lb = -ub
|
|||||||
MESH_DIR = str(Path(URDF_PATH).parent)
|
MESH_DIR = str(Path(URDF_PATH).parent)
|
||||||
|
|
||||||
# ----------- rm75 qp based kine ------------
|
# ----------- rm75 qp based kine ------------
|
||||||
robot_kine_qp = kine_qp(urdf_path=URDF_PATH, mesh_dir=MESH_DIR)
|
robot_kine_qp = kine_qp(urdf_path=URDF_PATH, mesh_dir=MESH_DIR, tcps=["scissor_tcp", "camera_tcp"])
|
||||||
robot_kine_qp.add_tool_frames(tools_in_ee)
|
robot_kine_qp.add_tool_frames(tools_in_ee)
|
||||||
robot_kine_qp.cfg_j_limit(min_j=lb, max_j=ub, rad_flag=True)
|
robot_kine_qp.cfg_j_limit(min_j=lb, max_j=ub, rad_flag=True)
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user