the scissor stl file is added.

2026-07-27 20:34:02 +01:00
parent d1080638c1
commit ceb80a8b17
8 changed files with 509 additions and 15986 deletions
@@ -100,9 +100,12 @@ def main():
                if d_p_ik < 0.01:
                    result[0][1] += 1

-                # robot_mjk.send_command(q)
-                # robot_mjk.wait_until_reached()
-                # robot_mjk.print_state()
+                while 1:
+                    time.sleep(1)
+
+                robot_mjk.send_command(q)
+                robot_mjk.wait_until_reached()
+                robot_mjk.print_state()
            else:
                fk_qp_p2 = robot_kine_qp.forward_kinematics(q, tool=tool_name)
                d_p_ik = cal_pose_deviation(pose1=t_p, pose2=fk_qp_p2)