欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

標(biāo)題: 16路PWM舵機(jī)PCA9685模塊的單片機(jī)源程序 [打印本頁]

作者: KOD    時(shí)間: 2018-7-13 20:48
標(biāo)題: 16路PWM舵機(jī)PCA9685模塊的單片機(jī)源程序
16路PWM舵機(jī)模塊

單片機(jī)源程序如下:
  1. /**************************************************************************
  2.                         PCA9685模塊簡(jiǎn)單應(yīng)用
  3.                 平臺(tái):89C52,晶振:11.0592
  4. ***************************************************************************/
  5. #include <reg52.h>           
  6. #include <intrins.h>  
  7. #include <stdio.h>
  8. #include <math.h>
  9. typedef  unsigned char  uchar;        
  10. typedef  unsigned int   uint;        


  11. sbit scl=P3^6;                        //時(shí)鐘輸入線
  12. sbit sda=P3^7;                   //數(shù)據(jù)輸入/輸出端

  13. sbit KEY1=P2^0;
  14. sbit KEY2=P2^1;


  15. #define PCA9685_adrr 0x80//  1+A5+A4+A3+A2+A1+A0+w/r
  16.                         //片選地址,將焊接點(diǎn)置1可改變地址,
  17.                         // 當(dāng)IIC總 呱嫌 多片PCA9685或相同地址時(shí)才需焊接
  18. // #define PCA9685_SUBADR1 0x2
  19. // #define PCA9685_SUBADR2 0x3
  20. // #define PCA9685_SUBADR3 0x4


  21. #define PCA9685_MODE1 0x0
  22. #define PCA9685_PRESCALE 0xFE


  23. #define LED0_ON_L 0x6
  24. #define LED0_ON_H 0x7
  25. #define LED0_OFF_L 0x8
  26. #define LED0_OFF_H 0x9


  27. // #define ALLLED_ON_L 0xFA
  28. // #define ALLLED_ON_H 0xFB
  29. // #define ALLLED_OFF_L 0xFC
  30. // #define ALLLED_OFF_H 0xFD


  31. #define SERVOMIN  115 // this is the 'minimum' pulse length count (out of 4096)
  32. #define SERVOMAX  590 // this is the 'maximum' pulse length count (out of 4096)
  33. #define SERVO000  130 //0度對(duì)應(yīng)4096的脈寬計(jì)數(shù)值
  34. #define SERVO180  520 //180度對(duì)應(yīng)4096的脈寬計(jì)算值,四個(gè)值可根據(jù)不同舵機(jī)修改


  35. /**********************函數(shù)的聲明*********************************/
  36. /*---------------------------------------------------------------
  37.                   毫秒延時(shí)函數(shù)
  38. ----------------------------------------------------------------*/
  39. void delayms(uint z)
  40. {
  41.   uint x,y;
  42.   for(x=z;x>0;x--)
  43.       for(y=148;y>0;y--);
  44. }
  45. /*---------------------------------------------------------------
  46.                                                                         IIC總線所需的通用函數(shù)
  47. ----------------------------------------------------------------*/
  48. /*---------------------------------------------------------------
  49.                  微妙級(jí)別延時(shí)函數(shù) 大于4.7us
  50. ----------------------------------------------------------------*/
  51. void delayus()
  52. {
  53.           _nop_();          //在intrins.h文件里
  54.                 _nop_();
  55.                 _nop_();
  56.                 _nop_();
  57.                 _nop_();

  58. }
  59. /*---------------------------------------------------------------
  60.                  IIC總線初始化函數(shù)
  61. ----------------------------------------------------------------*/
  62. void init()
  63. {
  64.     sda=1;                //sda scl使用前總是被拉高
  65.     delayus();
  66.     scl=1;
  67.     delayus();
  68. }
  69. /*---------------------------------------------------------------
  70.                  IIC總線啟動(dòng)信號(hào)函數(shù)
  71. ----------------------------------------------------------------*/
  72. void start()
  73. {
  74.     sda=1;
  75.     delayus();
  76.     scl=1;                        //scl拉高時(shí) sda突然來個(gè)低電平 就啟動(dòng)了IIC總線
  77.     delayus();
  78.     sda=0;
  79.     delayus();
  80.     scl=0;
  81.     delayus();
  82. }
  83. /*---------------------------------------------------------------
  84.                  IIC總線停止信號(hào)函數(shù)
  85. ----------------------------------------------------------------*/
  86. void stop()
  87. {
  88.     sda=0;
  89.     delayus();
  90.     scl=1;                         //scl拉高時(shí) sda突然來個(gè)高電平 就停止了IIC總線
  91.     delayus();
  92.     sda=1;                  
  93.     delayus();
  94. }
  95. /*---------------------------------------------------------------
  96.                  IIC總線應(yīng)答信號(hào)函數(shù)
  97. ----------------------------------------------------------------*/
  98. void ACK()
  99. {
  100.     uchar i;
  101.     scl=1;
  102.     delayus();
  103.     while((sda=1)&&(i<255))         
  104.                 i++;                                       
  105.     scl=0;                                 
  106.     delayus();
  107. }
  108. /*---------------------------------------------------------------
  109.                  寫一個(gè)字節(jié),無返回值,需輸入一個(gè)字節(jié)值
  110. ----------------------------------------------------------------*/
  111. void write_byte(uchar byte)
  112. {
  113.     uchar i,temp;
  114.     temp=byte;
  115.     for(i=0;i<8;i++)
  116.     {
  117.         temp=temp<<1;  
  118.         scl=0;                  
  119.                                 delayus();
  120.                                 sda=CY;                 
  121.                                 delayus();
  122.                                 scl=1;           
  123.                                 delayus();
  124.     }
  125.     scl=0;                  
  126.     delayus();
  127.     sda=1;                 
  128.     delayus();
  129. }
  130. /*---------------------------------------------------------------
  131.                  讀一個(gè)字節(jié)函數(shù),有返回值
  132. ----------------------------------------------------------------*/
  133. uchar read_byte()
  134. {
  135.                 uchar i,j,k;
  136.                 scl=0;
  137.                 delayus();
  138.                 sda=1;
  139.                 delayus();
  140.                 for(i=0;i<8;i++)        
  141.                 {
  142.                                 delayus();
  143.                                 scl=1;
  144.                 delayus();
  145.                 if(sda==1)
  146.                 {
  147.                                 j=1;
  148.                 }
  149.                 else j=0;
  150.                 k=(k<< 1)|j;  
  151.                 scl=0;            
  152.                 }
  153.                 delayus();
  154.                 return k;
  155. }
  156. /*---------------------------------------------------------------
  157.                 有關(guān)PCA9685模塊的函數(shù)
  158. ----------------------------------------------------------------*/
  159. /*---------------------------------------------------------------
  160.                 向PCA9685里寫地址,數(shù)據(jù)
  161. ----------------------------------------------------------------*/
  162. void PCA9685_write(uchar address,uchar date)
  163. {
  164.                 start();
  165.                 write_byte(PCA9685_adrr);        //PCA9685的片選地址
  166.                 ACK();                          
  167.                 write_byte(address);  //寫地址控制字節(jié)
  168.                 ACK();
  169.                 write_byte(date);          //寫數(shù)據(jù)
  170.                 ACK();
  171.                 stop();
  172. }
  173. /*---------------------------------------------------------------
  174.             從PCA9685里的地址值中讀數(shù)據(jù)(有返回值)
  175. ----------------------------------------------------------------*/
  176. uchar PCA9685_read(uchar address)
  177. {
  178.                 uchar date;
  179.                 start();
  180.                 write_byte(PCA9685_adrr); //PCA9685的片選地址
  181.                 ACK();
  182.                 write_byte(address);
  183.                 ACK();
  184.                 start();
  185.                 write_byte(PCA9685_adrr|0x01);        //地址的第八位控制數(shù)據(jù)流方向,就是寫或讀
  186.                 ACK();
  187.                 date=read_byte();
  188.                 stop();
  189.                 return date;
  190. }
  191. /*---------------------------------------------------------------
  192.                         PCA9685復(fù)位
  193. ----------------------------------------------------------------*/
  194. void reset(void)
  195. {
  196.                 PCA9685_write(PCA9685_MODE1,0x0);
  197. }


  198. void begin(void)
  199. {
  200.                 reset();
  201. }
  202. /*---------------------------------------------------------------
  203.                                         PCA9685修改頻率函數(shù)
  204. ----------------------------------------------------------------*/
  205. void setPWMFreq(float freq)
  206. {
  207.                 uint prescale,oldmode,newmode;
  208.                 float prescaleval;
  209.                 freq *= 0.92;  // Correct for overshoot in the frequency setting
  210.                 prescaleval = 25000000;
  211.                 prescaleval /= 4096;
  212.                 prescaleval /= freq;
  213.                 prescaleval -= 1;
  214.                 prescale = floor(prescaleval + 0.5);

  215.                 oldmode = PCA9685_read(PCA9685_MODE1);
  216.                 newmode = (oldmode&0x7F) | 0x10; // sleep
  217.                 PCA9685_write(PCA9685_MODE1, newmode); // go to sleep
  218.                 PCA9685_write(PCA9685_PRESCALE, prescale); // set the prescaler
  219.                 PCA9685_write(PCA9685_MODE1, oldmode);
  220.                 delayms(2);
  221.                 PCA9685_write(PCA9685_MODE1, oldmode | 0xa1);
  222. }
  223. /*---------------------------------------------------------------
  224.                                 PCA9685修改角度函數(shù)
  225. num:舵機(jī)PWM輸出引腳0~15,on:PWM上升計(jì)數(shù)值0~4096,off:PWM下降計(jì)數(shù)值0~4096
  226. 一個(gè)PWM周期分成4096份,由0開始+1計(jì)數(shù),計(jì)到on時(shí)跳變?yōu)楦唠娖剑^續(xù)計(jì)數(shù)到off時(shí)
  227. 跳變?yōu)榈碗娖剑钡接?jì)滿4096重新開始。所以當(dāng)on不等于0時(shí)可作延時(shí),當(dāng)on等于0時(shí),
  228. off/4096的值就是PWM的占空比。
  229. ----------------------------------------------------------------*/
  230. void setPWM(uint num, uint on, uint off)
  231. {
  232.                 PCA9685_write(LED0_ON_L+4*num,on);
  233.                 PCA9685_write(LED0_ON_H+4*num,on>>8);
  234.                 PCA9685_write(LED0_OFF_L+4*num,off);
  235.                 PCA9685_write(LED0_OFF_H+4*num,off>>8);
  236.         }


  237. /*---------------------------------------------------------------
  238.                       主函數(shù)
  239. ----------------------------------------------------------------*/
  240. void main()
  241. {         
  242.                 unsigned char min;
  243.                       min=200;
  244.                      
  245.                       begin();
  246.                 setPWMFreq(50);  
  247.                 //例如要求舵機(jī)轉(zhuǎn)到60度,這么算,
  248.                 //60度對(duì)應(yīng)的脈寬=0.5ms+(60/180)*(2.5ms-0.5ms)=1.1666ms
  249.                 //利用占空比=1.1666ms/20ms=off/4096,off=239,50hz對(duì)應(yīng)周期20ms
  250.                 //setPWM(num,0,239);;;;當(dāng)然也可以利用SERVO000和SERVO180計(jì)算
  251.                       setPWM(0, 0, 200);//第0路舵機(jī)轉(zhuǎn)到最小角度
  252.         setPWM(0, 0, 200);//第0路舵機(jī)轉(zhuǎn)到最小角度
  253.         setPWM(1, 0, 150);//第0路舵機(jī)轉(zhuǎn)到最小角度
  254.         setPWM(2, 0, 200);//第0路舵機(jī)轉(zhuǎn)到最小角度
  255.         setPWM(3, 0, 250);//第0路舵機(jī)轉(zhuǎn)到最小角度
  256.         setPWM(4, 0, 300);//第0路舵機(jī)轉(zhuǎn)到最小角度
  257.         setPWM(5, 0, 350);//第0路舵機(jī)轉(zhuǎn)到最小角度
  258.                 while(1)
  259.                 {                       
  260.                     if(KEY1==0)
  261.                                                                                 {
  262.                                                                                         delayms(10);
  263.                                                                                         if(KEY1==0)
  264.                                                                                                 while(!KEY1);
  265.                                                                                            if(min<500)
  266.                                                                                                          min=min+50;
  267.                                                                                                  else
  268.                                                                                                          min=500;
  269.                                                                                                
  270.                                                                                 }
  271.                                                                                 if(KEY2==0)
  272.                                                                                 {
  273.                                                                                         delayms(10);
  274.                                                                                         if(KEY2==0)
  275.                                                                                                 while(!KEY2);
  276.                                                                                            if(min>150)
  277.                                                                                                          min=min-50;
  278.                                                                                                  else
  279.                                                                                                          min=150;
  280.                                                                                                
  281.                                                                                 }
  282.                                                                                  setPWM(0, 0, SERVO000);//第0路舵機(jī)轉(zhuǎn)到最小角度
  283.                                                                                        
  284. //                                setPWM(0, 0, SERVOMIN);//第0路舵機(jī)轉(zhuǎn)到最小角度
  285. //                                setPWM(1, 0, SERVO000);//第1路舵機(jī)轉(zhuǎn)到0角度
  286. //                                setPWM(15, 0, 2000);
  287.                                delayms(1500);
  288. //                                setPWM(0, 0, SERVOMAX);
  289.                      setPWM(0, 0, SERVO180);
  290.                                delayms(1500);
  291.                                                                 }
  292.                                                                                
  293.                                                                                                     
  294. }

復(fù)制代碼

所有資料51hei提供下載:
舵機(jī)模塊.zip (50.44 KB, 下載次數(shù): 144)



作者: swordiii3    時(shí)間: 2018-7-16 13:19
想問一下貼主是怎么接線的呢?
作者: 孤仙1233    時(shí)間: 2018-8-30 10:09
這個(gè)如何與51單片機(jī)接線
作者: idy123    時(shí)間: 2018-10-27 18:02
沒接線完全看不懂
作者: everglow_    時(shí)間: 2019-2-24 14:09
112.                 IIC總線應(yīng)答信號(hào)函數(shù)

113.----------------------------------------------------------------*/

114.void ACK()

115.{

116.    uchar i;

117.    scl=1;

118.    delayus();

119.    while((sda=1)&&(i<255))         

120.                i++;                                       

121.    scl=0;                                 

122.    delayus();

123.}/            這個(gè)函數(shù)里面的 i 為什么沒賦值呢?

273.        setPWM(0, 0, 200);//第0路舵機(jī)轉(zhuǎn)到最小角度

274.        setPWM(1, 0, 150);//第1路舵機(jī)轉(zhuǎn)到最小角度

275.        setPWM(2, 0, 200);//第2路舵機(jī)轉(zhuǎn)到最小角度

276.        setPWM(3, 0, 250);//第3路舵機(jī)轉(zhuǎn)到最小角度

277.        setPWM(4, 0, 300);//第4路舵機(jī)轉(zhuǎn)到最小角度

278.        setPWM(5, 0, 350);//第5路舵機(jī)轉(zhuǎn)到最小角度
為什么同樣是最小角度,最后一位off值不一樣呢?
作者: 創(chuàng)意    時(shí)間: 2019-4-2 09:06
大佬,請(qǐng)教一下如何將兩個(gè)pca9685舵機(jī)控制器連接在一起當(dāng)整體使用呢?
作者: q1184924693    時(shí)間: 2019-4-7 23:15
程序很好備注能不能更詳細(xì)呀
作者: jemery1030    時(shí)間: 2019-7-23 16:27
感謝分享
作者: 694812363    時(shí)間: 2020-5-19 17:00
脈寬計(jì)數(shù)值 130到 520 是為什么啊
作者: 快樂眼淚    時(shí)間: 2020-6-11 10:05
能不能把接線圖放上來啊?
作者: arnold0998    時(shí)間: 2022-2-1 12:52
swordiii3 發(fā)表于 2018-7-16 13:19
想問一下貼主是怎么接線的呢?

13、14行就是接線




歡迎光臨 (http://www.raoushi.com/bbs/) Powered by Discuz! X3.1