Exemplo n.º 1
0
'''

PORT = '/dev/ttyACM0'

import serial
from msppg import MSP_Parser


def handler(agl, flowx, flowy):
    print(agl, flowx, flowy)


port = serial.Serial(PORT, 115200)

parser = MSP_Parser()
parser.set_RANGE_AND_FLOW_Handler(handler)

while True:

    c = None

    try:

        c = port.read()

    except KeyboardInterrupt:

        port.close()
        break

    parser.parse(c)