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
