久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费
標題:
51單片機PCA9685驅動9個舵機舵機的源程序
[打印本頁]
作者:
569099575
時間:
2018-12-21 11:42
標題:
51單片機PCA9685驅動9個舵機舵機的源程序
51單片機PCA9685驅動板驅動舵機
單片機源程序如下:
#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();
}
/*---------------------------------------------------------------
IIC????????
----------------------------------------------------------------*/
void start()
{
sda=1;
delayus();
scl=1; //scl高 sda拉低 ????IIC啟動
delayus();
sda=0;
delayus();
scl=0;
delayus();
}
/*---------------------------------------------------------------
IIC停止
----------------------------------------------------------------*/
void stop()
{
sda=0;
delayus();
scl=1; //scl??? sda??????? ????IIC??
delayus();
sda=1;
delayus();
}
/*---------------------------------------------------------------
IIC應答
----------------------------------------------------------------*/
void ACK()
{
uchar i;
scl=1;
delayus();
while((sda=1)&&(i<255))
i++;
scl=0;
delayus();
}
/*---------------------------------------------------------------
寫字節
----------------------------------------------------------------*/
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;
}
/*---------------------------------------------------------------
??PCA9685?????
----------------------------------------------------------------*/
/*---------------------------------------------------------------
?PCA9685????,??
----------------------------------------------------------------*/
void PCA9685_write(uchar address,uchar date)
{
start();
write_byte(PCA9685_adrr); //PCA9685?????
ACK();
write_byte(address); //???????
ACK();
write_byte(date); //???
ACK();
stop();
}
/*---------------------------------------------------------------
從PCA9685讀數據有返回值
----------------------------------------------------------------*/
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復位
----------------------------------------------------------------*/
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);
}
/*---------------------------------------------------------------
PCA9685??????
num:??PWM????0~15,on:PWM?????0~4096,off:PWM?????0~4096
??PWM????4096?,?0??+1??,??on???????,?????off?
??????,????4096????????on???0?????,?on??0?,
off/4096????PWM?????
----------------------------------------------------------------*/
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); //設置50hz
SCON=0x50; //設定串口工作方式
PCON=0x00; //波特率不倍增
TMOD=0x20; //定時器1工作于8位自動重載模式, 用于產生波特率
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對應周期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)
{
switch(buf)
{
case 0x11: setPWM(0, 0, SERVO110); break;
case 0x12: setPWM(0, 0, SERVOMAX); break;
case 0x13: setPWM(1, 0, SERVO110); break;
case 0x14: setPWM(1, 0, SERVOMAX); break;
case 0x15: setPWM(2, 0, SERVO110); break;
case 0x16: setPWM(2, 0, SERVOMAX); break;
case 0x17: setPWM(3, 0, SERVO110); break;
case 0x18: setPWM(3, 0, SERVOMAX); break;
case 0x19: setPWM(4, 0, SERVO110); break;
case 0x20: setPWM(4, 0, SERVOMAX); break;
case 0x21: setPWM(5, 0, SERVO110); break;
case 0x22: setPWM(5, 0, SERVOMAX); break;
case 0x23: setPWM(6, 0, SERVO110); break;
case 0x24: setPWM(6, 0, SERVOMAX); break;
case 0x25: setPWM(7, 0, SERVO110); break;
case 0x26: setPWM(7, 0, SERVOMAX); break;
case 0x27: setPWM(8, 0, SERVO110); break;
case 0x28: setPWM(8, 0, SERVOMAX); break;
default:break; //接受到其它數據,蜂鳴器響
}
}
}
void serial() interrupt 4
{
ES = 0; //關閉串行中斷
RI = 0; //清除串行接受標志位
buf = SBUF; //從串口緩沖區取得數據
ES = 1; //允許串口中斷
}
復制代碼
以上代碼51hei下載(請大家多多指教):
51單片機PCA9685驅動板驅動舵機.zip
(35.92 KB, 下載次數: 90)
2018-12-21 11:41 上傳
點擊文件名下載附件
下載積分: 黑幣 -5
作者:
nsj21n
時間:
2019-8-12 08:39
不錯的資料,我手上有PCA9635,不知道是不是可以通用驅動。
作者:
魯大仙
時間:
2020-2-10 16:13
94行是不是應該是while((sda==1)&&(i<255))
作者:
lgp_my
時間:
2021-4-5 16:19
測試無任何反應。
作者:
dawei。
時間:
2022-3-11 23:41
nsj21n 發表于 2019-8-12 08:39
不錯的資料,我手上有PCA9635,不知道是不是可以通用驅動。
可以驅動嗎
歡迎光臨 (http://www.zg4o1577.cn/bbs/)
Powered by Discuz! X3.1
主站蜘蛛池模板:
男人天堂网站
|
国产精品一区二区在线播放
|
亚洲国产成人精品一区二区
|
狠狠撸在线视频
|
在线观看亚洲精品视频
|
www.99热这里只有精品
|
亚洲成人精品一区二区
|
欧美三区在线观看
|
欧美精品欧美精品系列
|
一区在线观看
|
亚洲97
|
亚洲精品在线播放
|
久久99国产精品
|
国产偷自视频区视频
|
亚洲五码在线
|
中文字幕日韩欧美一区二区三区
|
日韩在线免费视频
|
国产一区不卡
|
国产精品成人在线播放
|
日韩一区中文字幕
|
亚洲免费精品
|
成人av电影网
|
日本不卡一区二区三区在线观看
|
懂色中文一区二区三区在线视频
|
日韩av一区二区在线观看
|
91欧美精品成人综合在线观看
|
99视频在线免费观看
|
日韩国产中文字幕
|
日本三级全黄三级a
|
亚洲九九色
|
欧美在线播放一区
|
久久国产亚洲
|
久久免费精品
|
亚洲一区二区免费
|
黄网站免费在线观看
|
亚洲成人第一页
|
日韩欧美三级电影在线观看
|
婷婷色在线播放
|
www.五月天婷婷.com
|
一区二区av
|
日本三级网站在线
|