Example #1
0
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))
Example #2
0
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))
Example #3
0
    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
Example #4
0
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'])
Example #5
0
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