diff --git a/msg/trajectory_bezier.msg b/msg/trajectory_bezier.msg
index 934b45ff69..28701a49df 100644
--- a/msg/trajectory_bezier.msg
+++ b/msg/trajectory_bezier.msg
@@ -17,11 +17,11 @@ uint8 MAV_TRAJECTORY_REPRESENTATION_BEZIER = 1
 
 uint8 type # Type from MAV_TRAJECTORY_REPRESENTATION enum.
 
-float32[6] point_0    # MAV_TRAJECTORY_REPRESENTATION_BEZIER, index 0-2 position sp, index 3 time horizon, index 9 yaw, index 10 yaw speed
-float32[6] point_1    # MAV_TRAJECTORY_REPRESENTATION_BEZIER, index 0-2 position sp, index 3 time horizon, index 9 yaw, index 10 yaw speed
-float32[6] point_2    # MAV_TRAJECTORY_REPRESENTATION_BEZIER, index 0-2 position sp, index 3 time horizon, index 9 yaw, index 10 yaw speed
-float32[6] point_3    # MAV_TRAJECTORY_REPRESENTATION_BEZIER, index 0-2 position sp, index 3 time horizon, index 9 yaw, index 10 yaw speed
-float32[6] point_4    # MAV_TRAJECTORY_REPRESENTATION_BEZIER, index 0-2 position sp, index 3 time horizon, index 9 yaw, index 10 yaw speed
+float32[6] point_0    # MAV_TRAJECTORY_REPRESENTATION_BEZIER, index 0-2 position sp, index 3 time horizon, index 4 yaw, index 5 yaw speed
+float32[6] point_1    # MAV_TRAJECTORY_REPRESENTATION_BEZIER, index 0-2 position sp, index 3 time horizon, index 4 yaw, index 5 yaw speed
+float32[6] point_2    # MAV_TRAJECTORY_REPRESENTATION_BEZIER, index 0-2 position sp, index 3 time horizon, index 4 yaw, index 5 yaw speed
+float32[6] point_3    # MAV_TRAJECTORY_REPRESENTATION_BEZIER, index 0-2 position sp, index 3 time horizon, index 4 yaw, index 5 yaw speed
+float32[6] point_4    # MAV_TRAJECTORY_REPRESENTATION_BEZIER, index 0-2 position sp, index 3 time horizon, index 4 yaw, index 5 yaw speed
 
 bool[5] point_valid   # States if respective point is valid