from msppg import MAVLink_Parser as Parser import serial import time from sys import argv import threading if len(argv) < 2: print('Usage: python %s PORT' % argv[0]) print('Example: python %s /dev/ttyUSB0' % argv[0]) exit(1) print('Sorry; not working yet!') exit(1) parser = Parser() port = serial.Serial(argv[1], BAUD) # This thread sethe throttle based on incoming messages class SetterThread(threading.Thread): def __init__(self, getter): threading.Thread.__init__(self, target=self.setter) self.setDaemon(True) self.getter = getter def setter(self):
BAUD = 57600 from msppg import MAVLink_Parser as Parser import serial from math import degrees from sys import argv if len(argv) < 2: print('Usage: python %s PORT' % argv[0]) print('Example: python %s /dev/ttyACM0' % argv[0]) exit(1) parser = Parser() port = serial.Serial(argv[1], BAUD) def rad2deg(rad): return '%+3.3f' % degrees(rad) def handler(time_boot_ms, roll, pitch, yaw, rollspeed, pitchspeed, yawspeed): print('Roll=%s Pitch=%s Yaw=%s' % (rad2deg(roll), rad2deg(pitch), rad2deg(yaw))) parser.set_ATTITUDE_Handler(handler) while True: try: