from EMSPcore.pyEMSP import EMSP if __name__ == "__main__": board = EMSP("/dev/cu.SLAB_USBtoUART", 115200) try: while True: data = board.getData('ATTITUDE') message = "angx = {:+.2f} \t angy = {:+.2f} \t heading = {:+.2f} \t elapsed = {:+.4f} \t".format( float(data['angx']), float(data['angy']), float(data['heading']), float(data['elapsed'])) print message except Exception, error: board.Log("ERR", "Error in test-getATTITUDE. " + str(error))
import sys, time from EMSPcore.pyEMSP import EMSP if __name__ == "__main__": board = EMSP("/dev/ttyUSB0", 115200) try: if 'ATTITUDE' in sys.argv: data = board.getData('ATTITUDE') message = "angx = {:+.2f} \t angy = {:+.2f} \t heading = {:+.2f} \t elapsed = {:.4f} ms \t".format( data['angx'], data['angy'], data['heading'], data['elapsed']) print message if 'RC' in sys.argv: data = board.getData('RC') message = "roll = {:+.2f} \t pitch = {:+.2f} \t yaw = {:+.2f} \t throttle = {:+.2f} \t elapsed = {:.4f} ms \t".format( data['roll'], data['pitch'], data['yaw'], data['throttle'], data['elapsed']) print message if 'RAW_IMU' in sys.argv: data = board.getData('RAW_IMU') message = "ax = {:+.2f} \t ay = {:+.2f} \t az = {:+.2f} \t gx = {:+.2f} \t gy = {:+.2f} \t gz = {:+.2f} \t elapsed = {:.4f} ms \t".format( data['ax'], data['ay'], data['az'], data['gx'], data['gy'], data['gz'], data['elapsed']) print message if 'MOTOR' in sys.argv: data = board.getData('MOTOR') message = "M1 = {:+.2f} \t M2 = {:+.2f} \t M3 = {:+.2f} \t M4 = {:+.2f} \n M5 = {:+.2f} \t M6 = {:+.2f} \t M7 = {:+.2f} \t M8 = {:+.2f} \telapsed = {:.4f} ms \t".format( data['m1'], data['m2'], data['m3'], data['m4'], data['m5'], data['m6'], data['m7'], data['m8'], data['elapsed']) print message