Fix for rotate and translate when body is up high

limits on how tall we will allow the  robot to get.  Note: we also
added Dynamic leg positioning as the body Y changes