Skip to content

Commit

Permalink
tools: fixed lat speed bug.
Browse files Browse the repository at this point in the history
  • Loading branch information
yifeijiang authored and xiaoxq committed Oct 7, 2019
1 parent 0806f44 commit 4af8dbc
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions modules/tools/plot_planning/imu_speed.py
Original file line number Diff line number Diff line change
Expand Up @@ -35,7 +35,7 @@ def add(self, location_est):
timestamp_sec = location_est.measurement_time
self.timestamp_list.append(timestamp_sec)
if self.is_lateral:
speed = location_est.pose.linear_velocity.x \
speed = -1 * location_est.pose.linear_velocity.x \
* math.sin(location_est.pose.heading) + \
location_est.pose.linear_velocity.y * \
math.cos(location_est.pose.heading)
Expand Down Expand Up @@ -106,5 +106,5 @@ def get_lastest_timestamp(self):
ax[0].set_ylabel('Lon Acc')
ax[1].set_xlabel('Timestamp')
ax[1].set_ylabel('Lat Acc')

plt.show()

0 comments on commit 4af8dbc

Please sign in to comment.