import math heading = 360 heading=heading+180 if heading>360: heading=heading-360 print('head',heading) if 0 < heading <= 90: yaw = (90 - float(heading)) print('yaw',yaw) else: yaw = (450-float(heading)) print('yaw3',yaw)