树莓派:PCA9685控制伺服电机,深度解析date = int(4096 * ((angle * 11) + 500) / 20000 + 0.5)

4.1、PCA9685模块介绍

PCA9685模块

PCA9685模块

PCA9685模块中左侧边的 VCC、GND、SDA、SCL四点接入到树莓派中的对应的引脚即可,中间绿色部分的V+、GND是给舵机供电的,可以单独接入5V的电压,下面的一排三色的插针,分别连接伺服电机,上面的数字对应控制的通道。

4.2、安装Adafruit_Python_PCA9685库

安装Adafruit:sudo pip install adafruit-pca9685

github下载地址:<u>https://github.com/adafruit/Adafruit_Python_PCA9685</u>

模块的使用:

导入Adafruit_PCA9685模块

import Adafruit_PCA9685  

4.3、树莓派 开启IIC功能:

sudo raspi-config -> 5.Interfacing Options -> P5 I2C,设置enable使能,然后重启树莓派。

接着在/boot/config.txt中进行配置,添加如下:

dtparam=i2c_arm=on

device_tree=bcm2710-rpi-3-b.dtb

配置完成后同样重启一下;

然后我们在树莓派中执行命令安装i2c-tools(sudo apt-get install i2c-tools);

执行指令查看舵机驱动板是否已接入树莓派4B+中:

sudo i2cdetect -y 1

查询硬件地址

4.4、使用Adafruit_Python_PCA9685库驱动舵机

整个程序并不复杂,核心语句为date = int(4096 * ((angle * 11) + 500) / 20000+0.5),接下来我们一点一点的来分析一下这个计算公式。

首先,舵机的控制一般需要一个20ms的时基脉冲,该脉冲的高电平部分一般为0.5ms~2.5ms范围内的角度控制脉冲部分。以180度角度舵机为例,那么对应的控制关系是这样的:
0.5ms————–0度;
1.0ms————45度;
1.5ms————90度;
2.0ms———–135度;
2.5ms———–180度;

角度转换成数值,angle输入的角度值(0--180),pulsewidth高电平占空时间(0.5ms--2.5ms);

脉冲数值以微秒us为单位,pulsewidth高电平占空时间500us--2480(2500)us,这里少的20us是精度问题,我们不难看出角度可以分成180份,高电平占空时间大约分为2000份,2000/180 = 11.111,这里我们可以约等于11,但是高电平是从500us开始的,所以angle*11后要再加上500,/1000是再将us转换为ms;

pulse_width=((angle*11)+500)/1000,当angle=180时
pulse_width=2480us(2.5ms) 这里的pulse_width是脉冲的宽度,PCA9685可以设置更新频率,实际脉冲周期20ms相当于50HZ更新频率,这里使用的脉冲周期为50HZ,也就是周期为20ms;

周期 / 脉冲宽度 = 占空比;
pulse_width / 20 = pulse_width=((angle*11)+500)/ 20000。

这里的占空比是脉冲信号的一个概念,脉冲信号是一种离散信号,形状多种多样,与普通模拟信号(如正弦波)相比,波形之间在Y轴不连续(波形与波形之间有明显的间隔)但具有一定的周期性是它的特点。最常见的脉冲波是矩形波(也就是方波)。

单脉冲

初始位置 ==> 0度 ==> 脉冲宽度 ==> 0.5ms ==> 空占比 ==> 0.5ms / 20ms ==> 2.5%

结束位置 ==> 180度 ==> 脉冲宽度 ==> 2.5ms ==> 空占比 ==> 2.5ms / 20ms ==> 12.5%

因此占空比应该在2.5%到12.5%之间。

占空比

这里的精度是212,212= 4096;

date/4096 (date/分辨率) = pulse_width / 20 (占空比)有上pulse_width的计算结果得:

date = int(4096 * ((angle * 11) + 500) / 20000)

在python的运算中,进行int强转的时候,小数点会被抹去,所以这里+0.5实现四舍五入。
date = int(4096 * ((angle * 11) + 500) / 20000 + 0.5)

程序演示:

# coding:utf-8

# 导入 __future__ 文件的 division 是为了精确除法。
from __future__ import division  
import time

# 导入Adafruit_PCA9685模块
import Adafruit_PCA9685

# 使用默认地址(0x40)初始化PCA9685。
# 把Adafruit_PCA9685.PCA9685()引用地址赋给PWM标签
pwm = Adafruit_PCA9685.PCA9685() 

# 或者指定不同的地址和/或总线:
# pwm = Adafruit_PCA9685.PCA9685(address=0x41, busnum=2)

def set_servo_angle(channel, angle):  # 输入角度转换成12^精度的数值
    # + 0.5是进行四舍五入运算。
    date = int(4096 * ((angle * 11) + 500) / 20000 + 0.5) 
    pwm.set_pwm(channel, 0, date)

# 将频率设置为50赫兹,适合伺服系统。
pwm.set_pwm_freq(50)

print('Moving servo on channel x, press Ctrl-C to quit...')
while True:
    # 选择需要移动的伺服电机的通道与角度
    channel = int(input('pleas input channel:'))
    angle = int(input('pleas input angle:'))
    set_servo_angle(channel, angle)
    time.sleep(1)

输入通道与角度。即可选通并使该通道的舵机转动到相应的角度!

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 201,552评论 5 474
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 84,666评论 2 377
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 148,519评论 0 334
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 54,180评论 1 272
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 63,205评论 5 363
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 48,344评论 1 281
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 37,781评论 3 393
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 36,449评论 0 256
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 40,635评论 1 295
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 35,467评论 2 317
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 37,515评论 1 329
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 33,217评论 3 318
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 38,775评论 3 303
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 29,851评论 0 19
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 31,084评论 1 258
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 42,637评论 2 348
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 42,204评论 2 341

推荐阅读更多精彩内容