你的浏览器版本过低,可能导致网站不能正常访问!
为了你能正常使用网站功能,请使用这些浏览器。

STM32通过单线串口对总线舵机的控制

[复制链接]
feixiang20 发布时间:2017-5-22 09:58
1 总线舵机的介绍. H' t9 i% i; _2 j
总线伺服舵机即串行总线智能舵机,实际上可以理解为数字舵机的衍生品,数字舵机与模拟舵机相比而言是控制系统设计上的颠覆,而总线伺服舵机对于舵机而言则是在功能和运用上的颠覆。舵机的运用方式实际上只能发挥出总线伺服舵机非常小的一部分功能。这款TS-315是通过单线的串口通信对旋转进行控制的,控制字符串协议如下:4 Y/ ^' A& M1 E4 {" C( T

6 e9 x1 U1 `) P  L9 Q+ f; V) O& r. o
" I& q* Z' T2 D; p
字符串协议:: F% L4 a9 l! d+ b/ n' c/ o4 `
#1P1500T100 控制舵机旋转,无返回% i1 O& p! S6 q
(1P是ID为1的舵机,中间的1500是参数,范围是500-2500,控制舵机范围,后面的参数100,表示舵机旋转的时间参数,也就是速度,意思是舵机从当前角度达到命令中的1500的位置,所需要的时间为100ms,时间的范围是1-50000,时间越大速度越慢,但是舵机的最快速度以实际舵机的参数而定)4 z: M' I) g3 H7 l! [- C
#1PRAD  读取角度,返回格式 #001P1467  
8 J9 q- X* {! q7 O7 `& {( q#1PULK 释放扭力,无返回4 L( x( l% A; i, R
#1PID002  改变ID (将1改成2,后面的参数必须为3位数,不够补0),返回格式 #002P
# N* e% ?6 V# ]/ i5 Z# q#1PBD1  返回 #OK!
% [2 q9 M0 y/ A# i. ^. a改变波特率(9600,19200,38400,115200,128000)  (舵机重启之后才会生效)
2 O! r# H0 V; ~3 e; m* j. v, v//1:9600 , 2:19200 , 3:38400 , 4:57600 , 5:115200 , 6:128000
% T( K) D/ ~- P$ h#1PCSD  将当前位置设置舵机的初始位置,返回 #OK!  (设置之后舵机上电之后会旋转到设置的位置)
3 ~. Q' x" I( I2 e+ ?6 D#1PCLE  (恢复出厂设置)(舵机重启之后才会生效),返回 #OK!
7 }, w* q) {5 C#1PMOD1   ,返回 #OK!
! C2 L5 N: l; e3 z2 s' ?1 R(最后的参数1表示工作模式,0:270度逆向,1:270度顺向,2:180度逆向,3:180度顺向,4:连续旋转)
! }3 n7 D+ {5 F4 o- d; Z逆向和顺向表示舵机的旋转方向。逆向:脉冲信号从500到2500,舵机逆时针旋转。顺向:脉冲信号从500到2500,舵机顺时针旋转。& O: C1 C" ^, c) m
连续旋转模式就是普通的360度舵机,连续旋转的,无法控制角度,这个模式下控制舵机的命令#1P1500T100这样的命令的作用就改变了,这个命令在这个模式下面的作用是:8 Y5 P; h- f# O+ N( ^
中间的参数1500,范围为500-2500,其中500-1500控制舵机的正转,1500-2500控制舵机的反转。越接近1500速度越慢,越远离1500速度越快(即500和2500速度都是最快的,1500是停止)6 q- y' g- s' Z4 o% G* r7 p
最后的参数100,表示舵机旋转的圈数,100就是100圈(存在一两圈的误差,正常!),如果这个参数改成50000,那就是无限旋转。如果参数是49999,那就只会转49999圈
# p1 L; e; J9 N. q/ T2 r6 i上面的1P 表示编号为1的舵机,上面所有的命令最后都要带回车换行符(0x0d 和 0x0a)* ]' n# {# [/ `* ~: `
舵机的ID默认是1,ID为255是广播,广播命令对所有舵机都有效。默认波特率128000  g0 G! N( F  {
2 L- k2 ^. F+ g+ y! y
2 STM32单线串口通信
9 A, J6 u7 h! o. A% Q0 P+ K/ n参考手册里面是这样描述的,非常简单单线半双方模式通过设置USART_CR3寄存器的HDSEL位选择。在这个模式里,下面的位必须保持清零状态:$ s" z. W4 C& y8 n  y( N
● USART_CR2寄存器的LINEN和CLKEN位
$ F* [/ S' a  s# g3 S● USART_CR3寄存器的SCEN和IREN位
+ M) h. m. U2 ~& ~+ tUSART可以配置成遵循单线半双工协议。在单线半双工模式下,TX和RX引脚在芯片内部互连。使用控制位”HALF DUPLEX SEL”(USART_CR3中的HDSEL位)选择半双工和全双工通信。8 P! w4 {1 I" a9 ?8 v/ O
当HDSEL为’1’时
0 d7 ?7 L+ |' ^0 ~% f' [● RX不再被使用
/ B- T" b' ?8 h& s● 当没有数据传输时,TX总是被释放。因此,它在空闲状态的或接收状态时表现为一个标准I/O口。这就意味该I/O在不被USART驱动时,必须配置成悬空输入(或开漏的输出高)。& F, P. y8 o, v: x. l% g
除此以外,通信与正常USART模式类似。由软件来管理线上的冲突(例如通过使用一个中央仲裁器)。特别的是,发送从不会被硬件所阻碍。当TE位被设置时,只要数据一写到数据寄存器上,发送就继续。( J9 @2 t* ^; S: P/ L. X1 n
参考初始化源码如下
$ B1 d) C3 ]8 c; w3 \//初始化IO 串口2" O2 n/ ^" ^7 s
//pclk2CLK2时钟频率(Mhz). u5 p% |' @/ v+ x' `8 \
//bound:波特率6 Z1 R" `" @2 f8 ^5 P0 ~
void uart2_init(u32 pclk2,u32 bound)
# A( u' t* a" O& w' Q2 G{         0 k$ _3 c) U. j2 e5 l) g
  ?" ]- k; p+ f" Z
        u32        temp;         
. A# L0 |2 O: \6 y        temp=(pclk2*1000000+bound/2)/bound;        //得到USARTDIV@OVER8=0,采用四舍五入计算" a" I$ [: e1 M3 g
" [" @8 k  W# S( g/ B  p, d

6 K# R. l. i9 i' g' o+ p4 F        RCC->AHB1ENR|=1<<0;           //使能PORTA口时钟  
0 V2 k! T4 K% b; i9 [9 V+ X% T* v6 D        RCC->APB1ENR|=1<<17;          //使能串口2时钟
! J* h% `& i; H/ O" L1 H5 S3 h        GPIO_Set(GPIOA,PIN2|PIN3,GPIO_MODE_AF,GPIO_OTYPE_OD,GPIO_SPEED_50M,GPIO_PUPD_PU);//PA2,PA3,复用功能,上拉输出/ {3 d" p: S( J* Q2 A$ |9 b! s5 L
        GPIO_AF_Set(GPIOA,2,7);        //PA2,AF7
% @3 g: V) j2 ^* i6 f0 E        GPIO_AF_Set(GPIOA,3,7);//PA3,AF7            
7 b3 D# z- p! |- p" I2 V% E        USART2->CR1=0;                         //清零CR1寄存器
: ?5 l6 B9 `+ z& Z        USART2->BRR=temp/2;                 //波特率设置@OVER8=0
% N) ]0 W: H5 q$ E
- Z% p4 C' x8 g& `1 r% \. W/ h& K) [2 o//下面5行代码是根据参考手册设置寄存器,注意使能HDSEL放到最后
8 x, ~8 j. H9 X* ]0 Y, T        USART2->CR3&=0<<5;                //清SCEN
, T8 x" R* C' x5 W* \* s  s& \$ q        USART2->CR3&=0<<1;                //清IREN- u4 X0 J' T$ N; _, D6 x
        USART2->CR2&=0<<11;                //清CLKEN5 E; z0 R( J8 z, D1 {4 x
        USART2->CR2&=0<<14;                //清LINEN
  s! }7 h, Q, G6 b* \        USART2->CR3|=1<<3;                //使能HDSEL% D5 o, f  ^! V2 A6 O1 @& |

$ Y5 T! \7 `8 l. |6 P  Q9 v& c
9 d. L2 N4 m; z3 y0 S; X( N& t+ |+ P3 {& F7 ?4 E3 j
        USART2->CR1|=0<<28;                 //设置M1=0
) o" l6 ]5 h) Q/ @9 W; i6 S        USART2->CR1|=0<<12;                 //设置M0=0&M1=0,选择8位字长6 F' y. n8 @7 B0 p1 A
        USART2->CR1|=0<<15;         //设置OVER8=0,16倍过采样: I/ W& \! \& W7 }8 I3 Z- T0 R" y' i: V
        USART2->CR1|=1<<3;          //串口发送使能
) X' l8 F- S8 j. c/ H- n) G9 z. z+ q#if EN_USART2_RX                          //如果使能了接收
3 c* A' E4 k# l% N        //使能接收中断1 j+ v4 A5 M3 z# \7 G( A
        USART2->CR1|=1<<2;          //串口接收使能
5 n+ r, D# H7 D4 m8 u& U$ F        USART2->CR1|=1<<5;            //接收缓冲区非空中断使能                   * o8 s3 ]3 W" l3 J4 O
        MY_NVIC_Init(0,0,USART2_IRQn,2);//组2,最低优先级
2 }) G$ y  h% w7 C8 k3 S#endif. S+ }4 m) D1 ?1 N# i, U' v
        USART2->CR1|=1<<0;          //串口使能" p- V/ s; {# F" v0 b9 ^

; i7 X& o1 R0 Y0 [; q/ d, y) H, D2 p& r7 L9 H* N3 A$ t, ?6 z
}/ A* n0 {3 H/ D% W

3 u$ t  ~$ G- V8 U4 `* p" S3数据读取时的注意点: _) e* A. S: V/ v- V
# p  i; p5 U5 ]5 W0 B# W
通过逻辑分析仪分析,命令传送至舵机后,舵机给出了正确的反馈,但是由于舵机回馈数据的速度非常快,造成了丢包问题,数据总是无**确传送至单片机,由于在单线模式,RXD一直接收TXD发送的数据,致使真正需要的数据丢包,因而只需要修改程序即可修正,更改的程序只是判断下是否是自己发送的命令即可,若是,则不在接收,最后验证,已经可以正确读取舵机反馈值- L/ q5 Y/ o- l; ~& p

" [8 H+ m8 H5 r) C7 su16 USART2_RX_STA=0;       //接收状态标记         
# |% X5 y) I- C! A: k: }
# F% W0 B5 B8 i5 Pvoid USART2_IRQHandler(void)
0 g" M* _" M5 `0 j( y* |{
. ]0 a( K- Q' ^2 I! @2 y4 q        u8 res;       9 U7 x# ]9 E; m; u! o' R, a
#if SYSTEM_SUPPORT_OS                 //如果SYSTEM_SUPPORT_OS为真,则需要支持OS.6 E* h7 e7 k# `* A8 b
        OSIntEnter();   / }; n" C6 `0 g+ a% N' H
#endif
) y# [# K: w! F9 \3 n. q( L, r& j        if(USART2->ISR&(1<<5))//接收到数据1 y7 {* _% _& r* J  N( H
        {       7 Q* l) S5 ~. [. w1 L6 Q- @4 x
                res=USART2->RDR;
/ {5 q$ ]) W6 W+ Z: R9 C" M% Y5 P                //if(USART2->RDR!=USART2->TDR)  y3 a; _3 l  m, h" l* b
                {
) W. |% j1 a  f" N& F1 |
' T2 F+ P* M5 r5 [, b5 t8 V+ ?                        if((USART2_RX_STA&0x8000)==0)//接收未完成- O4 L- p+ j, S; O; B& o) u) S
                        {
$ Q. T/ Z2 ?( a* R7 |                                if(USART2_RX_STA&0x4000)//接收到了0x0d
9 I" o" J0 n. v% B                                {
* a; w# _4 }) E4 F' e& t2 h" m                                        if(res!=0x0a)USART2_RX_STA=0;//接收错误,重新开始       # k' H# S6 p$ G1 z2 \
                                        else if (USART2_RX_BUF[5]==0x44)USART2_RX_STA=0;        //防止丢包,禁止接收自己发送出去的命名                               - t3 }% L; |& N' r4 s$ Q$ ]" U. X
                                        else
5 Z% Q  e+ J4 P' K                                        {" n' D+ K7 W' e0 [# u3 E
                                                USART2_RX_STA|=0x8000;        //接收完成了& ^4 z/ L% w  }
                                        }) s* G8 u$ d+ P! N8 ~0 m
                                }; X' b: H+ ]( F% ~
                                else //还没收到0X0D! o, i8 r! w: B( E" E2 f5 R
                                {      
# n  M6 ]1 Y; D                                        if(res==0x0d)USART2_RX_STA|=0x4000;
! ~9 E) s: K+ @3 R3 c1 Y, j                                        else
1 |4 c# u+ M& @8 K5 i/ r) Z                                        {
0 l5 T5 L( ]: O+ s  {                                                USART2_RX_BUF[USART2_RX_STA&0X3FFF]=res;$ m. v* ?/ ]: Q+ b
                                                USART2_RX_STA++;
" b/ v' h4 x( M                                                if(USART2_RX_STA>(USART2_REC_LEN-1))USART2_RX_STA=0;//接收数据错误,重新开始接收         
8 @( V) u3 u) U" ~% {" T                                        }                 % o" X3 e1 O3 `2 v
                                }
0 G9 u. ^+ ^2 S8 z                        }    j# j2 V; _% I- `( Y4 y8 H; V
                }               * Y! F# h) w/ h
        }( a5 T; V  y9 M# V$ x6 ?: u5 B2 z
# o/ m4 S. c- I' F/ K2 P' i
赞 收藏 评论1 发布时间:2017-5-22 09:58

举报

1个回答
我是疯子 回答时间:2017-12-5 10:18:31
本帖最后由 我是疯子 于 2017-12-5 10:26 编辑 ) a; w+ A) `# M* J4 ]; s

& L. ]7 N; r6 Q8 |7 Y) J. H4 x中断接收
关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版