Follow the gimbal range in degrees

Finally worked out the math to use degree of gimbal range rather than
the hack of just summing up vectors.