address the comment

This commit is contained in:
Yilun Chen
2020-01-19 18:35:52 -05:00
committed by GitHub
parent 0de06534d2
commit 1c081ed3e0

View File

@@ -77,9 +77,9 @@ def motion(x, u, dt):
motion model
"""
x[2] += u[1] * dt
x[0] += u[0] * math.cos(x[2]) * dt
x[1] += u[0] * math.sin(x[2]) * dt
x[2] += u[1] * dt
x[3] = u[0]
x[4] = u[1]