Handle singularities in joint space to avoid flipping leg joints

[LouKordos]

Look into this to handle singularities in a better way, which might allow the robot to walk more upright, reducing energy consumption.