Angle for firing

Updated the code to calculate the angle needed to fire