better write task1

2024-09-05 22:52:04 +08:00
parent afbb7ade5c
commit 31b558080b
3 changed files with 80 additions and 3 deletions
--- a/A/1/mp_cal.py
+++ b/A/1/mp_cal.py
@@ -41,7 +41,7 @@ def CalcMoveList(time_point, last_theta):

    node_list = [{"theta": first_node_theta, "node": first_node_dot, "C": first_node_C, "v": mp.mpf('1.0')}]

-    for i in range(1, 225):
+    for i in range(1, 224):
        expected_distance = kSegLength1 if i == 1 else kSegLength2
        cur_node_theta = GenerateFollowNodeTheta(node_list[-1]["theta"], expected_distance)
        cur_node_dot = Theta2Dot(cur_node_theta)