find an answer for task3

This commit is contained in:
2024-09-06 16:06:24 +08:00
parent 03af8507d8
commit 26b81de3e8
4 changed files with 83 additions and 4 deletions

View File

@@ -27,7 +27,7 @@ class Dragon:
return (self.kAlpha * theta * mp.cos(theta), self.kAlpha * theta * mp.sin(theta))
def GenerateFirstNodeTheta(self, delta_theta):
return kInnerCircleRadius/self.kAlpha
return kInnerCircleRadius/self.kAlpha + delta_theta
def GenerateFollowNodeTheta(self, cur_node_theta, expected_distance):
cur_node_dot = self.Theta2Dot(cur_node_theta)