Updated translations calculations

I made changes that will calculate the power going to the translational thrusters given an arbitrary angle.  The angle is calculated from the x and y coordinates of the joystick.