pub fn generate_clamped_joint_positions_from_limits<T>( angles: &[T], limits: &Vec<Option<Range<T>>>, ) -> Result<Vec<T>>where T: RealField + Copy,
Clamp joint angles to set angles safely