Change to how the UnderwaterAcrobot is defined. Assumes that each link is a circular beam, rather than a 2D ellipse. Far easier to come up with reasonable control vlaues this way