pca9685驅(qū)動(dòng)板驅(qū)動(dòng)9個(gè)舵機(jī)單片機(jī)源程序 - pca9685驅(qū)動(dòng)舵機(jī)程序+實(shí)例解析

　　pca9685驅(qū)動(dòng)板驅(qū)動(dòng)9個(gè)舵機(jī)單片機(jī)源程序如下：

　　#include《reg52.h》

　　#include 《intrins.h》

　　#include 《stdio.h》

　　#include 《math.h》

　　typedef unsigned char uchar;

　　typedef unsigned int uint;

　　unsigned char buf;

　　sbit scl=P2^6;

　　sbit sda=P2^7;

　　#define PCA9685_adrr 0x80// 1+A5+A4+A3+A2+A1+A0+w/r

　　#define PCA9685_SUBADR1 0x2

　　#define PCA9685_SUBADR2 0x3

　　#define PCA9685_SUBADR3 0x4

　　#define PCA9685_MODE1 0x0

　　#define PCA9685_PRESCALE 0xFE

　　#define LED0_ON_L 0x6

　　#define LED0_ON_H 0x7

　　#define LED0_OFF_L 0x8

　　#define LED0_OFF_H 0x9

　　#define ALLLED_ON_L 0xFA

　　#define ALLLED_ON_H 0xFB

　　#define ALLLED_OFF_L 0xFC

　　#define ALLLED_OFF_H 0xFD

　　#define SERVOMIN 115 // this is the ‘minimum’ pulse length count （out of 4096）

　　#define SERVOMAX 590 // this is the ‘maximum’ pulse length count （out of 4096）

　　#define SERVO000 130 //0度

　　#define SERVO180 520 //180度

　　#define SERVO80 284 //80度

　　#define SERVO110 340//110度

　　void delayms（uint z）

　　{

　　uint x，y;

　　for（x=z;x》0;x--）

　　for（y=148;y》0;y--）;

　　}

　　void delayus（） //大于4.7us

　　{

　　_nop_（）;

　　_nop_（）;

　　_nop_（）;

　　_nop_（）;

　　_nop_（）;

　　}

　　IIC初始化

　　void init（）

　　{

　　sda=1; //sda scl使用前被拉高

　　delayus（）;

　　scl=1;

　　delayus（）;

　　}

　　void start（）

　　{

　　sda=1;

　　delayus（）;

　　scl=1; //scl高 sda拉低 ？？？？IIC啟動(dòng)

　　delayus（）;

　　sda=0;

　　delayus（）;

　　scl=0;

　　delayus（）;

　　}

　　IIC停止

　　void stop（）

　　{

　　sda=0;

　　delayus（）;

　　scl=1; //scl？？？ sda？？？？？？？ ？？？？IIC？？

　　delayus（）;

　　sda=1;

　　delayus（）;

　　}

　　IIC應(yīng)答

　　void ACK（）

　　{

　　uchar i;

　　scl=1;

　　delayus（）;

　　while（（sda=1）&&（i《255））

　　i++;

　　scl=0;

　　delayus（）;

　　}

　　寫字節(jié)

　　void write_byte（uchar byte）

　　{

　　uchar i，temp;

　　temp=byte;

　　for（i=0;i《8;i++）

　　{

　　temp=temp《《1;

　　scl=0;

　　delayus（）;

　　sda=CY;

　　delayus（）;

　　scl=1;

　　delayus（）;

　　}

　　scl=0;

　　delayus（）;

　　sda=1;

　　delayus（）;

　　}

　　uchar read_byte（）

　　{

　　uchar i，j，k;

　　scl=0;

　　delayus（）;

　　sda=1;

　　delayus（）;

　　for（i=0;i《8;i++）

　　{

　　delayus（）;

　　scl=1;

　　delayus（）;

　　if（sda==1）

　　{

　　j=1;

　　}

　　else j=0;

　　k=（k《《 1）|j;

　　scl=0;

　　}

　　delayus（）;

　　return k;

　　}

　　void PCA9685_write（uchar address，uchar date）

　　{

　　start（）;

　　write_byte（PCA9685_adrr）; //PCA9685

　　ACK（）;

　　write_byte（address）; //

　　ACK（）;

　　write_byte（date）; //

　　ACK（）;

　　stop（）;

　　}

　　從PCA9685讀數(shù)據(jù)有返回值

　　uchar PCA9685_read（uchar address）

　　{

　　uchar date;

　　start（）;

　　write_byte（PCA9685_adrr）; //PCA9685

　　ACK（）;

　　write_byte（address）;

　　ACK（）;

　　start（）;

　　write_byte（PCA9685_adrr|0x01）; //

　　ACK（）;

　　date=read_byte（）;

　　stop（）;

　　return date;

　　}

　　PCA9685復(fù)位

　　void reset（void）

　　{

　　PCA9685_write（PCA9685_MODE1，0x0）;

　　}

　　void begin（void）

　　{

　　reset（）;

　　}

　　PCA9685修改頻率

　　void setPWMFreq（float freq）

　　{

　　uint prescale，oldmode，newmode;

　　float prescaleval;

　　freq *= 0.92; // Correct for overshoot in the frequency setting

　　prescaleval = 25000000;

　　prescaleval /= 4096;

　　prescaleval /= freq;

　　prescaleval -= 1;

　　prescale = floor（prescaleval + 0.5）;

　　oldmode = PCA9685_read（PCA9685_MODE1）;

　　newmode = （oldmode&0x7F） | 0x10; // sleep

　　PCA9685_write（PCA9685_MODE1， newmode）; // go to sleep

　　PCA9685_write（PCA9685_PRESCALE， prescale）; // set the prescaler

　　PCA9685_write（PCA9685_MODE1， oldmode）;

　　delayms（2）;

　　PCA9685_write（PCA9685_MODE1， oldmode | 0xa1）;

　　}

　　void setPWM（uint num， uint on， uint off）

　　{

　　PCA9685_write（LED0_ON_L+4*num，on）;

　　PCA9685_write（LED0_ON_H+4*num，on》》8）;

　　PCA9685_write（LED0_OFF_L+4*num，off）;

　　PCA9685_write（LED0_OFF_H+4*num，off》》8）;

　　}

　　void main（）

　　{

　　init（）;

　　begin（）;

　　setPWMFreq（50）; //設(shè)置50hz

　　SCON=0x50; //設(shè)定串口工作方式

　　PCON=0x00; //波特率不倍增

　　TMOD=0x20; //定時(shí)器1工作于8位自動(dòng)重載模式， 用于產(chǎn)生波特率

　　EA=1;

　　ES = 1; //允許串口中斷

　　TL1=0xfd;

　　TH1=0xfd; //波特率9600

　　TR1=1;

　　// delayms（1000）;

　　//60度=0.5ms+（60/180）*（2.5ms-0.5ms）=1.1666ms

　　//利用占空比=1.1666ms/20ms=off/4096，off=239，50hz對(duì)應(yīng)周期20ms

　　setPWM（0， 0， SERVOMAX）;

　　setPWM（1， 0， SERVOMAX）;

　　setPWM（2， 0， SERVOMAX）;

　　setPWM（3， 0， SERVOMAX）;

　　setPWM（4， 0， SERVOMAX）;

　　setPWM（5， 0， SERVOMAX）;

　　setPWM（6， 0， SERVOMAX）;

　　setPWM（7， 0， SERVOMAX）;

　　setPWM（8， 0， SERVOMAX）;

　　while（1）

　　{

　　pca9685驅(qū)動(dòng)舵機(jī)實(shí)例解析

　　本程序用來(lái)驅(qū)動(dòng)PCA9685模塊

　　接線如下：2腳接PCA9685的vcc，樹(shù)莓派的3腳接PCA9685的sda，樹(shù)莓派的5腳接PCA9685的scl，樹(shù)莓派的6腳接PCA9685的GND，。我接的是9G的舵機(jī)，電流比較小，可以直接從樹(shù)莓派的5V供電，也就是樹(shù)莓派的4腳接PCA9685的v+。但是如果接大舵機(jī)，就需要外接供電了。

　　壓縮包里面兩個(gè)程序，一個(gè)是驅(qū)動(dòng)，一個(gè)是測(cè)試程序。

　　測(cè)試程序如下

　　# -*- coding： UTF-8 -*-

　　from PCA9685 import PCA9685 #導(dǎo)入驅(qū)動(dòng)，

　　import time

　　pwm=PCA9685（）

　　pwm.init（）#初始化pca9685

　　pwm.setsq（50）#設(shè)置頻率

　　pwm.allinit（）#把16個(gè)通道初始化

　　jiaodu=0

　　ledoff=0

　　while 1：

　　while jiaodu《179：

　　pwm.setduoji（0，jiaodu）#設(shè)置0通道角度

　　pwm.setduoji（1，jiaodu）#設(shè)置1通道角度

　　pwm.setpwm（15，0，ledoff）#設(shè)置15通道pwm

　　jiaodu=jiaodu+1

　　ledoff+=20

　　time.sleep（0.1）

　　print jiaodu

　　while jiaodu》0：

　　pwm.setduoji（0，jiaodu）

　　pwm.setduoji（1，jiaodu）

　　jiaodu=jiaodu-1

　　time.sleep（0.1）

　　print jiaodu