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))
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))
board = EMSP("/dev/cu.SLAB_USBtoUART",115200)
try:
if 'ARM' in sys.argv:
board.arm()
print "Board is armed now!"
print "In 3 seconds it will disarm..."
time.sleep(3)
board.disarm()
print "Disarmed."
exit(0)
while True:
if 'ATTITUDE' in sys.argv:
data = board.getData('ATTITUDE')
message = "angx = {:+.2f} \t angy = {:+.2f} \t heading = {:+.2f} \t elapsed = {:+.4f} \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} \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} \t".format(data['ax'],data['ay'],data['az'],data['gx'],data['gy'],data['gz'],data['elapsed'])
print message
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
if 'SERVO' in sys.argv:
data = board.getData('SERVO')
message = "S1 = {:+.2f} \t S2 = {:+.2f} \t S3 = {:+.2f} \t S4 = {:+.2f} \n S5 = {:+.2f} \t S6 = {:+.2f} \t S7 = {:+.2f} \t S8 = {:+.2f} \telapsed = {:.4f} ms \t".format(data['s1'],data['s2'],data['s3'],data['s4'],data['s5'],data['s6'],data['s7'],data['s8'],data['elapsed'])
print message
if 'API_VERSION' in sys.argv:
data = board.getData('API_VERSION')
massage = "Version : {:d}.{:d}.{:d} \t elapsed = {:.4f} ms \t".format(data['protver'],data['majorver'],data['minorver'],data['elapsed'])
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