import time
from darkwater_640.darkwater_640 import dw_Controller, dw_Servo, dw_Motor

dw = dw_Controller( addr=0x60 )
s1 = dw.getServo(1)
s2 = dw.getServo(2)

s1.off()
s2.off()
time.sleep(1)

##time.sleep(10)
print "Set forward - "
print "Servo 1"
s1.setPWMmS(2000)
time.sleep(1)
print "Servo 2"
s2.setPWMmS(2000)
time.sleep(1)
print "Set neutral - "
print "Servo 1"
s1.setPWMmS(1500)
time.sleep(1)
print "Servo 2"
s2.setPWMmS(1500)
time.sleep(1)
print "Set reverse - "
print "Servo 1"
s1.setPWMmS(1000)
time.sleep(1)
print "Servo 2"
s2.setPWMmS(1000)
time.sleep(1)
print "All off"
s1.off()
s2.off()