找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 238|回复: 0
收起左侧

STC89单片机超级PCA9685舵机控制程序

[复制链接]
天蓝色的Toto 发表于 2020-11-24 23:35 | 显示全部楼层 |阅读模式
网上的STC89的PCA9685的程序几乎都找不到,或者是找得到用不了,所以就随手写了个程序送给大家,哈哈哈哈哈。
一次性用两个IO就可以控制16个舵机,节省一大把的IO口。

制作出来的实物图如下:
51hei图片_20201124233435.jpg

单片机源程序如下:
  1. #ifndef __PCA9685_H__
  2. #define __PCA9685_H__
  3. /*舵机控制函数*/
  4. #include "iic89.h"

  5. #define u8 unsigned char
  6. #define u16 unsigned int
  7.        
  8. #define PCA9685_Write_ADDR 0x80  //写地址
  9. #define PCA9685_Read_ADDR 0x81                //读地址
  10. #define LEDN_ON_L 0x06                                        //起始低位
  11. #define LEDN_ON_H 0x07                                        //起始高位
  12. #define LEDN_OFF_L 0X08         //结束低位
  13. #define LEDN_OFF_H 0x09                                        //结束高位
  14. #define MODE_1 0x00                                                        //mode_1寄存器,起始到结束为高,结束以后为低
  15. #define PRE_SCALE 0xfe                                        //PWM寄存器

  16. void Write_IIC(u8 Addr,u8 dat)//写到PCA9685里面
  17. {
  18.         IIC_Start();
  19.         IIC_Send(PCA9685_Write_ADDR);
  20.         IIC_Ack();
  21.         IIC_Send(Addr);
  22.         IIC_Ack();
  23.         IIC_Send(dat);
  24.         IIC_Ack();
  25.         IIC_Stop();
  26. }

  27. u8 Reads_IIC(u8 Addr)//读取PCA9685的数据
  28. {
  29.         u8 dat;
  30.         IIC_Start();
  31.         IIC_Send(PCA9685_Write_ADDR);
  32.         IIC_Ack();
  33.         IIC_Send(Addr);
  34.         IIC_Ack();
  35.         IIC_Start();
  36.         IIC_Send(PCA9685_Read_ADDR);
  37.         IIC_Ack();
  38.         dat=Read_IIC();
  39.         IIC_Stop();
  40.         return dat;
  41. }

  42. void PCA9685_Reset()//PCA9685超级复位函数,把MODE_1清空
  43. {
  44.          Write_IIC(MODE_1,0x00);
  45. }

  46. void Duoji_Init(u16 freq)//舵机初始化,设定频率freq
  47. {
  48.         u16 hym=1500;//用来退出sleep后拖一拖的延时
  49.         u16 prescale,oldmode,newmode;//prescale为PWM的数值,其他两个用于控制MODE_1
  50.         prescale=6634/freq-1;//查数据手册可知
  51.         oldmode=Reads_IIC(MODE_1);   //读取模式1寄存器,oldmode为退出sleep的数值
  52.         newmode=(oldmode&0x7F)|0x10;   //进入sleep的数值
  53.         Write_IIC(MODE_1,newmode);//进入sleep,调节PRE_SCALE,即PWM的频率                                                                                               
  54.         Write_IIC(PRE_SCALE,prescale);//往PRE_SCALE中写数值,公式为25*10^6/(4096*freq)/0.92-1    0.92为参数
  55.         Write_IIC(MODE_1,oldmode);//退出sleep
  56.         while(hym--);//拖一拖的延时,不然PCA9685反应不过来了
  57.         Write_IIC(MODE_1,oldmode|0xA1);//立即重启       
  58. }

  59. void Set_Duoji(u8 channel,u8 angle)//舵机控制函数 channel为通道  angle为角度,0-180
  60. {
  61.         u16 DJ=102+(angle*9/4);   //占空比为DJ/4096,且占空比属于2.5%-12.5%
  62.         /*查手册得知,某个通道所在寄存器为channel*4+(0x06,0x07,0x08,0x09) 如LED1_ON_L=00001010 ,即为00000110+4*00000001*/
  63.         //简单来说就是把起始位设成0,然后再到DJ时为结束位
  64.         Write_IIC(LEDN_ON_L+4*channel,0);               
  65.         Write_IIC(LEDN_ON_H+4*channel,0);
  66.         Write_IIC(LEDN_OFF_L+4*channel,DJ);
  67.         Write_IIC(LEDN_OFF_H+4*channel,DJ>>8);
  68. }

  69. #endif
复制代码
  1. #include<reg52.h>
  2. #include "pca9685.h"
  3. #define u8 unsigned char
  4. #define Duojipinlv 50   //SG90舵机频率,50HZ
  5. u8 code dushu[]={30,45,60,90,120,150};  //用于实验的度数数组
  6. void Delay500ms();                //@11.0592MHz  延时500ms
  7. void main()
  8. {
  9.         u8 i;
  10.         PCA9685_Reset();                //模式1超级复位
  11.         Duoji_Init(Duojipinlv);                        //舵机初始化函数
  12.         while(1)
  13.         {
  14.                 for(i=0;i<6;i++)
  15.                 {
  16.                         Set_Duoji(0,dushu[i]);                //设置舵机角度
  17.                         Delay500ms();                               
  18.                         Set_Duoji(1,dushu[i]);
  19.                         Delay500ms();       
  20.                         Set_Duoji(2,dushu[i]);
  21.                         Delay500ms();       
  22.                         Set_Duoji(3,dushu[i]);
  23.                         Delay500ms();                               
  24.                 }
  25.                 for(i=5;i>=0;i--)
  26.                 {                       
  27.                         Set_Duoji(0,dushu[i]);               
  28.                         Delay500ms();                               
  29.                         Set_Duoji(1,dushu[i]);
  30.                         Delay500ms();       
  31.                         Set_Duoji(2,dushu[i]);
  32.                         Delay500ms();       
  33.                         Set_Duoji(3,dushu[i]);
  34.                         Delay500ms();                               
  35.                 }
  36.         }
  37. }

  38. void Delay500ms()                //@11.0592MHz
  39. {
  40.         unsigned char i, j, k;

  41.         _nop_();
  42.         i = 1;
  43.         j = 129;
  44.         k = 119;
  45.         do
  46.         {
  47.                 do
  48.                 {
  49.                         while (--k);
  50.                 } while (--j);
  51.         } while (--i);
  52. }
复制代码
所有资料51hei提供下载:
天极PCA9685神奇的舵机控制程序.zip (29.7 KB, 下载次数: 15)

评分

参与人数 1黑币 +70 收起 理由
admin + 70 共享资料的黑币奖励!

查看全部评分

回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表