// ************************* Part 2
 public double getBodyPitch() {
   return bodyJoint2.getQ();
 }