from jetduino_pins import *

servo = 1

jetduino.dynamixelSetRegister(servo, jetduino.AX_RETURN_LEVEL, 1, 1)

print ("Setting servo 1 to be endless turns.")
jetduino.dynamixelSetEndless(servo, 1)

for num in range(1,2):
    try:
        print ("Turning CW at 1000")
        jetduino.dynamixelTurnSpeed(servo, CLOCKWISE, 1000);
        time.sleep(5)

        print ("Turning CCW at 500")
        jetduino.dynamixelTurnSpeed(servo, COUNTER_CLOCKWISE, 500);
        time.sleep(5)

    except KeyboardInterrupt:
        print("Exiting loop")
        break
    except IOError:
        print ("Error")

print ("Setting servo 1 to back to regular servo.")
jetduino.dynamixelSetEndless(servo, 0)
jetduino.dynamixelMove(servo, 512, 1000);


import time
import jetduino
from jetduino_pins import *

servo = 1

# set the dynamixel so it only returns back data for read commands.
print("setting return status level to 1")
jetduino.dynamixelSetRegister(servo, jetduino.AX_RETURN_LEVEL, 1, 1)
jetduino.dynamixelSetRegister(servo, jetduino.AX_CW_ANGLE_LIMIT_L, 2, 0)
jetduino.dynamixelSetRegister(servo, jetduino.AX_CCW_ANGLE_LIMIT_L, 2, 1023)
jetduino.dynamixelSetEndless(servo, 0)

print("Move to 0 at fastest speed")
jetduino.dynamixelMove(servo, 0, 0)
time.sleep(2)

print("Move to 1023 slowly")
jetduino.dynamixelMove(servo, 1023, 200)
time.sleep(1)

print("stop the servo at its current position.")
jetduino.dynamixelStop(servo)
time.sleep(1)

while True:
    try:
        print("Moving to 1023 at 100")
        jetduino.dynamixelMove(servo, 1023, 100)