#!/usr/bin/python
import enum
import time
import RPi.GPIO as GPIO
from PCA9685 import PCA9685
pwm = PCA9685(address=0x40)
try:
print ("This is an PCA9685 routine")
pwm.setPWMFreq(50)
#pwm.setServoPulse(1,500)
pwm.setRotationAngle(2, 0)
time.sleep(0.3)
pwm.setRotationAngle(2, 0)
time.sleep(0.3)
pwm.setRotationAngle(2, 40)
time.sleep(0.3)
pwm.setRotationAngle(2, 40)
time.sleep(0.3)
pwm.setRotationAngle(2, 90)
time.sleep(0.3)
pwm.setRotationAngle(2, 90)
print ("This is an PCA9685 routine")
# while True:
# # setServoPulse(2,2500)
# for i in range(10,170,45):
# pwm.setRotationAngle(3, i)
# if(i<80):
# pwm.setRotationAngle(3, i)
# time.sleep(0.1)
#
# for i in range(170,10,-45):
# pwm.setRotationAngle(3, i)
# if(i<80):
# pwm.setRotationAngle(3, i)
# time.sleep(0.1)
except:
pwm.exit_PCA9685()
print ("\nProgram end")
exit()