Neng-Hong Zeng / PCA9685

test

Dependencies:   PCA9685PWM

main.cpp

Committer:
wrxavex
Date:
2017-10-18
Revision:
0:711cd84845cd

File content as of revision 0:711cd84845cd:

#include"PCA9685.h"
#include"mbed.h"



PCA9685 pwm(p9,p10);
 
void setServoPulse(uint8_t n, float pulse) {
    pwm.setPWM(n, 0, pulse);
}
 
void initServoDriver() {
    pwm.begin();
    //pwm.setPrescale(121);     // set 20ms for generic servos
    pwm.setPWMFreq(1000);
    pwm.frequencyI2C(400000); //400kHz fast I2C comunication
    
}
 
int main() {
    
 initServoDriver();

    while(1){
        for ( uint16_t i = 0; i<4095; i++){
            pwm.setPWM(0, 0, i);
        }
        for ( uint16_t i = 4095; i>0; i--){
            pwm.setPWM(0, 0, i);
        }
        
        for ( uint16_t i = 0; i<4095; i++){
            pwm.setPWM(1, 0, i);
        }
        for ( uint16_t i = 4095; i>0; i--){
            pwm.setPWM(1, 0, i);
        }
    
    
    }  
             
}