The self-right routine only works when the robot is on it's side (90 degrees). We need to enable the robot to self-right in more situations.