Skip to content

Commit

Permalink
clearer wording
Browse files Browse the repository at this point in the history
  • Loading branch information
Liam committed Jul 23, 2017
1 parent f0052fa commit cb1de43
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions ukf.py
Original file line number Diff line number Diff line change
Expand Up @@ -69,8 +69,8 @@ def predict(self, delta_t):
px, py, v, yaw, yawd, nu_a, nu_yawdd = X_sigma_aug[:, col]

# predicted state values for CTRV motion model
# division by zero or very small value implies a nearly straight line,
# so degenerate to simpler CV motion model when yawd is sufficiently small
# if yawd is a very small value, it implies a nearly straight line,
# so degenerate to simpler CV motion model in that case
if abs(yawd) > 0.001:
px_p = px + v / yawd * (np.sin(yaw + yawd * delta_t) - np.sin(yaw))
py_p = py + v / yawd * (np.cos(yaw) - np.cos(yaw + yawd * delta_t))
Expand Down

0 comments on commit cb1de43

Please sign in to comment.