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:
