Example 6: Locomotion of a 6 module pitch-yaw snake