pub const MAX_WAYPOINTS: usize = 32;
Fixed capacity of waypoints in a published CuJointPlanPath.
CuJointPlanPath