|
|
EDA365欢迎您登录！
您需要 登录 才可以下载或查看，没有帐号？注册
x
多自由度人形双足舞蹈机器人 ——疯壳·机器人开发系列 多个舵机不同速率转动
9 E* D: {9 R" Q
8 }# w3 s. R* G% N5 Z6 [
( S. X$ L9 g# ^, h3 d/ k; w+ h. W
4 {7 g* ^ t+ `5 x$ ~6 b( H 1相关简介. E, q6 X3 r) t: h
4 r. a6 g$ e$ u, Z( p5 I 本章将介绍两个舵机的不同速率转动原理以及代码实现，多个舵机不同速率的转动跟两个舵机的不同速率转动的原理基本一致。
1 `" Y1 [' f+ a* }7 r3 ~* c 首先要知道的一点就是我们的舵机速率是一定的，不可控制。我们要完成两个舵机不同速率的转动，是采用了一个积分算法。其实就是延时，从而降低一个或者多个舵机的转动速率。! x9 }6 [/ `" W8 r/ Y, M
我们先举个例子。假设 1 号舵机要从 0°转到 180°，同时 2 号舵机要从 0° 转到 90°。如果不做任何处理，那么当 1 号、2 号舵机同时转到 90°时，2 号舵机不转，1 号舵机继续转动到 180°。这样就会导致机器人难以完成许多动作。假设舵机直接从 0°转到 180°的时间是 t，那么 2 号舵机实际转动时间就是t/2，暂停时间是 t/2。如果我们将整个时间 t 分成 n 份，每次先让舵机转动 t/2n，然后再暂停 t/2n。当 n 足够大时，我们的舵机就可以按照以原来二分之一的角速度匀速转动，从而达到控制舵机的转速。
- A, q6 B. I8 u, Y! ?# C, I) s 2硬件设计5 c9 i0 z2 g! x. S
本次将要控制机器人的两条腿，也就是 2、16 号舵机，对应的 IAP15W4K61S4 单片机管脚是 P15 和 P44，通过这两个 IO 口连接 74HC244 间接控制两个腿部舵机。: i: z1 z# l- |5 u9 A4 M
) `9 L0 h. N' H- P0 x/ K) x
2 F3 Z$ t5 S9 Y 图 1! h6 l8 W3 b$ g G1 U% x
3软件设计1 s: s9 l" `# D; x9 P: T
. d R# T* F1 F2 |
软件方面，关于舵机的控制可以参考上一章节，这里只讲解积分算法。按照前面所提及的例子，我们的时间份数 n 应该尽可能大，这样才会使舵机转动得更加均匀。但由于实际情况下，舵机的控制时间是 2.5ms，那么分成的最小时间块的长度就不能小于 2.5ms。
7 M h1 l( n, }% |& P3 s' w- `3 f+ M/ S 在本次代码中，我们设置一个动作完成时间（舵机从目前角度转到目标角度的时间，时间可以自己设置）是 1s，那么时间份数，也就是积分次数就是NeedCount = 1000*2/5（1000 除以 2.5）。每一次装载的 PWM 对应的角度为当前角度加上动作角度差的 NeedCount 分之一，从而实现舵机的近似匀速转动。' Y- ~% u3 |% Y6 K
本次积分代码如下。 y& d2 O c. M* g& s0 B- l2 H3 n
e! y( A! v$ w5 A
$ K; U, }- n; V+ b3 o1 |- F
7 N d; y' E" [/ Q, Y) U
' D2 ~1 A4 G- {' z: Q! @
代码1
1 I) m) {# V) J* d5 g 4实验现象
5 s9 `* j* v: p G! [
# b6 q! F$ ?5 w6 G3 X: N) c2 Q 首先打开下载软件 STC-ISP。
' S- T; B- C) w8 f! J- H5 C8 x" y0 A
: K( j. c7 J: w. t. @
图 2
Y/ v/ l5 P) u9 {& }' ` （1）点击 Keil 仿真设置，添加 STC 相关的头文件。STC 的相关头文件路径是我们之前安装 Keil C51 的路径，如果之前采用的默认路径，那么选择 C 盘 Keil 文件夹。
) `- F: q& C2 |! o1 [, Z
8 `6 |- S1 n- f3 j; M! u8 S. X2 v
) }6 i ?+ i, p& E& _. r5 R% M6 [
图 38 f7 | j# l4 j3 `9 D# P/ J( h; u
（2）添加完 STC 相关的头文件，点击弹窗中的确定。+ Z% s, L6 ^1 N! b" g8 K2 t2 e
2 _5 x2 A, F1 B% q0 x; R, _( E ~
( T1 e g' Y; }! a1 F w 图 4) Y2 i6 `9 h$ _6 o
（3）设置单片机的型号、最低波特率、最高波特率如下图所示，硬件选项等选项默认即可。串口号根据实际情况选择。5 `0 \2 n5 ]/ {4 q! F! L
1 Y% Q- q2 X% a- t, G7 b
8 v$ ?1 g' K0 @5 B7 E4 e
图 5
( z: ~1 [+ k5 d （4）点击打开程序文件，选择我们例程中的.hex 文件。7 ]4 m: F2 I' Y5 N) ^7 k
7 s9 d' c! Z; G7 K; S- X- s
4 ^5 {( S3 }+ r- g4 j& T 图 67 _6 t- I$ i7 I% |' H
（5）点击下载/编程，下载代码。
* M( d% j+ _. q! E+ s0 ?% A3 v! ~% l; y
% U# ?: {1 r& ~: M5 Q! _
图 7
6 V% m: S- q C U' E# [, A& w& x8 }+ Y2 ?6 D7 S6 J5 u
（6）按一下电路板上面的 RST 按键，完成下载。
2 c0 i7 V( @. E: {- @5 c7 d& J D, w( |' O) Z- K4 {4 A
3 D F% E7 _. M% a
图 8. o$ ]% C0 W* z: w$ a+ l$ H% s; i
Y8 v9 |) @# y
代码下载完成之后，打开机器人的电源开关，运行代码，就能看到我们的机器人的两条腿以不同的速率上下摆动。
- t1 H+ G6 O+ c% a6 b
3 p) j; [2 {. h Y& K! j. G( y3 i7 F4 M+ c# ^2 I$ q& _* q* \/ s5 f6 t- ~( t
, {) u6 \3 e6 w' C% e0 {8 t8 }# r2 e
- n1 j0 x/ m; I- ]8 L
文件下载请点击：
7_多个舵机不同速率转动.pdf
(1.02 MB, 下载次数: 0)
* C/ Y4 F2 Z' p0 {4 \# m8 R; N8 E! b; o1 V! `: z
|
|
/1 
发表于 2022-8-25 13:59
收藏
淘帖
支持！
反对！