diff --git a/script/visualization_classes.py b/script/visualization_classes.py index 0ef0e5d..ddc5abb 100644 --- a/script/visualization_classes.py +++ b/script/visualization_classes.py @@ -135,9 +135,9 @@ def ego_track_cb(self, msg): for i in range(len(msg.poses)-2): pos_x = msg.poses[i].pose.position.x - pos_y = msg.poses[i].pose.position.y + pos_y = -msg.poses[i].pose.position.y pos_x_n = msg.poses[i+1].pose.position.x - pos_y_n = msg.poses[i+1].pose.position.y + pos_y_n = -msg.poses[i+1].pose.position.y yaw = np.arctan2(pos_y_n - pos_y, pos_x_n - pos_x) mk = Marker()