Skip to content

Commit a87f632

Browse files
committed
fix theta
1 parent b6b109b commit a87f632

File tree

1 file changed

+1
-0
lines changed

1 file changed

+1
-0
lines changed

src/robotics/kinematics.h

Lines changed: 1 addition & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -98,6 +98,7 @@ class Kinematics{
9898
delta_y=delta_travel*sin(theta+delta_theta/2.0);
9999
x+=delta_x;
100100
y+=delta_y;
101+
theta+=delta_theta;
101102
travel+=delta_travel;
102103
}
103104

0 commit comments

Comments
 (0)