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

【经验分享】stm32 解析sbus

[复制链接]
STMCU小助手 发布时间:2022-1-27 22:58
1. S.BUS
7 Z% W( c% E0 y0 p% l1.1 协议介绍
S.BUS是FUTABA提出的舵机控制总线,全称Serial Bus,别名S-BUS或SBUS,也称 Futaba S.BUS。: B( T$ _/ l* G7 a! }
S.BUS是一个串行通信协议,也是一个数字串行通信接口(单线),适合与飞控连接。它可以连接很多设备,每个设备通过一个HUB与它相连,得到各自的控制信息。
( i5 D# t2 \; ?! aS.BUS可以传输16个比例通道和2个数字(bool)通道。其硬件上基于RS232协议,采用TTL电平,但高位取反(负逻辑,低电平为“1”,高电平为“0”),通信波特率为100K(不兼容波特率115200)。
1.2 协议解析
0 b1 b- |0 B5 |7 o+ D0 i7 d& w通信接口:USART(TTL)0 j; T) ?3 m- w+ L+ k9 ~
通信参数:1个起始位+8个数据位+偶校验位+2个停止位,波特率=100000bit/s,电平逻辑反转。
. @' Q1 L2 X" j" K通信速率:每14ms(模拟模式)或7ms(高速模式)发送,即数据帧间隔为 11ms(模拟模式)或4ms(高速模式)。: y  @7 R% |& Q. |5 t
数据帧格式:[1]4 L1 A6 J5 X. N1 Y& v5 g
字节位 byte1 byte2-23 byte24 byte25: t6 O5 T, {+ U  t8 }
类型 开始字节 通道数据字节(含16个脉宽通道) 标志位字节(含2个数字通道) 结束字节8 `" q/ z$ d  B! g4 H* j3 I
数据 0x0F 通道数据范围11Bits = [0,2047] 2个数字通道位+2个状态位 0x00
8 |& p9 e2 @/ Fbyte1:8 ^$ `- D# G; i5 K0 Z* v
startbyte = 0000 1111b (0x0F)
byte2-23:
/ f# q1 K: e9 N. ]: m; }databytes = 22bytes = 22 x 8Bits = 16 x 11Bits(CH1-16)
  v1 F' M  ~1 [: d$ k" o通道数据低位在前,高位在后,每个数据取11位,具体协议如下:0 x5 t9 ^' R, V
读取的databyte值:
byte 2 3 4 5 6 7 etc
! j& v: Q: \% ~4 Q; d! M" G内容 12345678 12345678 12345678 12345678 12345678 12345678 etc
4 A8 G! }7 p; Y- P  L转化后的通道值:
通道 CH01 CH02 CH03 CH04 etc1 ]. i. P5 ]- k7 _
内容 67812345678 34567812345 81234567812 56781234567 etc0 n2 l9 x# U& G2 m. P# k
byte24:
Bit 7 6 5 4 3 2 1 01 O/ I/ @, d: F! q4 D8 y
含义 数字通道CH17 数字通道CH18 帧丢失位 故障保护激活位 N/A N/A N/A N/A* u3 U* L5 K& n1 ^2 y* W
byte25:3 y0 p. K7 }# f. @
endbyte = 0000 0000b (0x00)
$ t2 W( o- h6 Z1 _- s! B/ {( S
2. 硬件设计
/ J+ i( X' B3 ^! o+ p* A2.1 硬件参数
  q8 ~) w% {7 `8 c主控芯片:STM32F103VET6/ x$ b% u/ g; o( k0 b# [3 p& Y
接收端口:USART2(带反相电路)% A" B1 r1 x- J4 }% h7 _
S.BUS设备:walkera RX-SBUS[2](配DEVO 10遥控器)

5 T# m3 h* J. p& ]. l* ?6 M2.2 反相电路6 ~1 i" ^7 \# k4 \* o$ G! i( _
由于此芯片串口不带反相器,我们需要外部搭建反相电路。如果芯片串口内部带反相器,可以省略此步。反相电路设计如下图:
! O8 y% c0 H) s* H4 E0 A
J1为4Pin排针,适配S.BUS接口,可5V输出为SBUS接收机供电。; X3 o  q1 }, k. E% y& P3 y8 u
J1的Pin-4接S.BUS数据发送端,连接一个由NPN三极管构成的反相器,将反相后的信号送入芯片USART2的RXD引脚。

$ c  h5 J5 S  X3.程序设计. M" q3 a. j6 _1 H& P) v* h, [
3.1 数据接收9 z3 r3 E1 f. a7 t+ C
分析一:根据 1.2 的协议解析,开始字节(0x0F)和结束字节(0x00)都是数据字节中很容易出现的字节,所以不能完全作为数据帧接收开始和结束的标志。9 C% w" |) R$ o. f8 f# f+ l5 Z
分析二:每个数据帧之间的间隔至少4ms,则可以利用这个空闲时间来接收数据帧。(需要设计一个系统时钟)- h# v4 D! H4 K4 b* M( A' k7 W
分析三:STM32 USART或UART有空闲中断,即检测到总线空闲(无数据传输),就产生中断。
/ \3 r* A$ B; e: k接收程序设计:综上,利用USART2接收中断(RXNE)来接收每个字节,利用USART2空闲中断(IDLE)来判断数据帧是否接收完毕。
USART2 初始化函数代码如下:
/**
9 N: n' v; a0 K. t9 H# ]& u8 x: H7 ]* @name SBUS_Configuration2 f: D8 ?+ H7 m
* @brief Configure SBUS(Usart2) clock, gpio and nvic:
9 c2 ]) Z) r: e9 ?* a1 W* SBUS_RX USART2_RX PD6
$ ^& ~  ]& {5 y4 A7 s1 |* @param None3 J' k, N% \# L. V- A
* @retval None5 k2 g# @) s1 t  \
*/
) K' H9 ~6 z9 H! L8 [5 t* Z, t8 C  qvoid SBUS_Configuration(void)! _. h/ \/ X# k+ Y
{7 s4 w" B% N/ N* G- G& @
GPIO_InitTypeDef GPIO_InitStructure;
. l; m, ~& G7 x6 J+ f* {" q: JUSART_InitTypeDef USART_InitStructure;
4 c  k  u/ @+ B' n  kNVIC_InitTypeDef NVIC_InitStructure;
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOD | RCC_APB2Periph_AFIO, ENABLE);; @2 e; ]5 \' N0 m
RCC_APB1PeriphClockCmd(RCC_APB1Periph_USART2,ENABLE);1 \& V! f2 P; s+ S, n" @7 _' @& G: v
+ h, }8 t  V! X4 B2 `& ]
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6;# K4 k9 Q+ p( }3 v( s
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;
" D% D. `) g  @& A/ c. Y. }GPIO_Init(GPIOD, &GPIO_InitStructure);/ g" _: P; O9 ]) j6 h+ S: N9 |0 D

# A2 E. G9 t5 K5 ^9 l) `2 UGPIO_PinRemapConfig(GPIO_Remap_USART2, ENABLE);
// 波特率100000 8个数据位 偶校验位 2个停止位) Z0 ?6 E( k' l- i2 A+ z8 R
USART_InitStructure.USART_BaudRate = 100000;$ X4 \8 g9 a5 y2 Q5 i- b
USART_InitStructure.USART_WordLength = USART_WordLength_8b;  //注意这里是9个数据长度(8个数据位+偶校验位)
8 O6 M5 i  S1 y6 ZUSART_InitStructure.USART_StopBits = USART_StopBits_2;
3 N3 t2 b* u% w) ]$ kUSART_InitStructure.USART_Parity = USART_Parity_Even;* y5 L+ k$ M7 g' j% O8 z* F+ N
USART_InitStructure.USART_HardwareFlowControl = USART_HardwareFlowControl_None;
2 `  T4 O7 ]+ g% m* |0 TUSART_InitStructure.USART_Mode = USART_Mode_Rx;
USART_Init(USART2, &USART_InitStructure);
NVIC_InitStructure.NVIC_IRQChannel = USART2_IRQn;) B) I8 y- ~. e, ^/ ~5 M2 T5 B
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 3;' z6 f+ Z' b" F4 |# A/ V3 c
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3;. S$ o& r. N$ H+ U; A" W$ U
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;- a/ w, E& h! C, R2 Z& d5 n) {
NVIC_Init(&NVIC_InitStructure);
USART_ITConfig(USART2, USART_IT_RXNE, ENABLE);
0 f# A" K3 g* |8 `) g- P2 q, p, S0 @USART_ITConfig(USART2, USART_IT_IDLE, ENABLE);
USART_Cmd(USART2, ENABLE);7 o' Y' v' l) J% z5 l2 a4 j
}/ e9 c) a& x, @5 x! J* G5 |
: Z4 D( b& U& Q1 A' g3 j
USART2 中断函数代码如下:

3 j/ T% i& z" s! cuint8_t USART2_RX_BUF[26];
/**
) \) H& A" J" V3 g* _2 Y! Z* @name USART2_IRQHandler" t& r0 N! v9 V  T$ L9 U* ^
* @brief This function handles USART2 Handler0 X/ f+ U8 ]& H' F2 n- F% r5 `
* @param None8 W8 U/ X$ j; }
* @retval None
) e* H% }' ?* m) r# k*/' [2 Q5 C0 t! p: l! |1 _2 X% {
void USART2_IRQHandler(void)
% ]. O7 I; k( y# v( A" h1 f, P1 p5 p{
* o. x4 j3 z/ ]9 s" tuint8_t res;+ E1 i5 J4 ~  s/ W
uint8_t clear = 0;: I: g: {, W3 l: F1 E& o- Y
static uint8_t Rx_Sta = 1;
" m9 R( l6 N; Q; j
$ {2 g9 B3 o$ J8 fif(USART_GetITStatus(USART2, USART_IT_RXNE) != RESET)
  c3 G- I$ m% r. J{
6 y$ R) y8 G3 z3 Rres =USART2->DR;
6 w4 I  }1 W+ Z$ Q4 ?$ @' AUSART2_RX_BUF[Rx_Sta++] = res;8 k: N" n/ G5 b+ e1 N6 [
}
, G' }1 @# ?  S% zelse if(USART_GetITStatus(USART2, USART_IT_IDLE) != RESET)9 D7 ~! v0 t% c: N; @) R3 r  f
{6 J( k& v7 Y' u6 h
clear = USART2->SR;
% a0 z! C6 b- b5 _' }5 Qclear = USART2->DR;; z' D) x( G. K8 d$ R3 ]0 K9 N5 j
USART2_RX_BUF[0] = Rx_Sta - 1;
/ @6 z" T& r6 BRx_Sta = 1;) Y) {" T) q7 [7 L  s
}
8 `1 C! @' U' U! V- h  t4 H. T# l2 q2 Z}
' Q) T) L- f  q6 @2 D: }& |7 w' \
USART2_RX_BUF为接收缓存区,定义为26个字节,第一个字节USART2_RX_BUF[0]为接收到的字节个数,后面为接收到的数据。$ ~& s( M" S6 ^$ T" B% d1 c) O2 W. c
USART2_RX_BUF[0]可以作为数据帧字节长度的判断。# y; R/ y( n: r6 Z
中断服务函数具体解释请参考STM32 串口接收不定长字节数据。

6 t+ L8 n: b9 ?. K, X% A3.2 数据处理
1 N; L5 M  M( e5 g5 V& t直接上代码:
uint16_t CH[18]; // 通道值
  B. N* M5 x8 W8 Ouint8_t rc_flag = 0;
void Sbus_Data_Count(uint8_t *sBusData)
$ R6 Z; p0 n2 ?) S{
tempData[ 0 ] = ( (sBusData[ 2]&0x07) << 8 ) + sBusData[ 1]; //sBus[ 2] low3 + sBus[ 1] low8" b, F! h. T3 B% `
tempData[ 1 ] = ( (sBusData[ 3]&0x3F) << 5 ) + (sBusData[ 2] >> 3 ); //sBus[ 3] low6 + sBus[ 2] high50 u1 ?1 [% v6 Q& a' Y+ ^
tempData[ 2 ] = ( (sBusData[ 5]&0x01) << 10) + (sBusData[ 4] << 2 ) + (sBusData[ 3] >> 6); //sBus[ 5] low1 + sBus[ 4] low8 + sBus[ 3] high2
, N; k; i/ z' I6 M& ]tempData[ 3 ] = ( (sBusData[ 6]&0x0F) << 7 ) + (sBusData[ 5] >> 1 ); //sBus[ 6] low4 + sBus[ 5] high7  |' g" M5 q! E
tempData[ 4 ] = ( (sBusData[ 7]&0x7F) << 4 ) + (sBusData[ 6] >> 4 ); //sBus[ 7] low7 + sBus[ 6] high44 f# M0 _% L. C8 z& l  {
tempData[ 5 ] = ( (sBusData[ 9]&0x03) << 9 ) + (sBusData[ 8] << 1 ) + (sBusData[ 7] >> 7); //sBus[ 9] low2 + sBus[ 8] low8 + sBus[ 7] high16 m5 ^9 ~4 G% N9 j) C! j1 W  y
tempData[ 6 ] = ( (sBusData[10]&0x1F) << 6 ) + (sBusData[ 9] >> 2 ); //sBus[10] low5 + sBus[ 9] high69 K1 q* v/ H4 _. F# E
tempData[ 7 ] = ( (sBusData[11]&0xFF) << 3 ) + (sBusData[10] >> 5 ); //sBus[11] low8 + sBus[10] high3( L- }0 ^# f  Z( y8 `( t" N9 ?
) d/ S$ ~4 u: Y0 h# u2 ?4 e' R! U) G
tempData[ 8 ] = ( (sBusData[13]&0x07) << 8 ) + sBusData[12]; //sBus[13] low3 + sBus[12] low80 `7 V0 l) B  K" }% L
tempData[ 9 ] = ( (sBusData[14]&0x3F) << 5 ) + (sBusData[13] >> 3 ); //sBus[14] low6 + sBus[13] high5( Q$ c. i: g" Z8 s& L! ^
tempData[ 10 ] = ( (sBusData[16]&0x01) << 10) + (sBusData[15] << 2 ) + (sBusData[14] >> 6); //sBus[16] low1 + sBus[15] low8 + sBus[14] high25 T4 I1 [/ S: U: g
tempData[ 11 ] = ( (sBusData[17]&0x0F) << 7 ) + (sBusData[16] >> 1 ); //sBus[17] low4 + sBus[16] high77 v! `0 ^9 H; u& \
tempData[ 12 ] = ( (sBusData[18]&0x7F) << 4 ) + (sBusData[17] >> 4 ); //sBus[18] low7 + sBus[17] high4
1 ^: l' H& p( T: E: n( RtempData[ 13 ] = ( (sBusData[20]&0x03) << 9 ) + (sBusData[19] << 1 ) + (sBusData[18] >> 7); //sBus[20] low2 + sBus[19] low8 + sBus[18] high1
4 [, c! y$ U/ j3 K3 ~" ~tempData[ 14 ] = ( (sBusData[21]&0x1F) << 6 ) + (sBusData[20] >> 2 ); //sBus[21] low5 + sBus[20] high6
* Z- }- m( n) ^3 W6 \tempData[ 15 ] = ( (sBusData[22]&0xFF) << 3 ) + (sBusData[21] >> 5 ); //sBus[22] low8 + sBus[21] high3
: U& b' X0 T9 w/ i  v3 \4 z
}$ u' B( c9 W  {( _9 S! e: L; G. X6 A: G% H
接收到的报文和解析出来的数据如下:! y8 D1 P/ P* D) G
RX:0F E0 03 1F 58 C0 07 16 B0 80 05 2C 60 01 0B F8 C0 07 00 00 00 00 00 03 000 V7 z. v' s2 o" L8 R, d1 H* G
CH: 992 992 352 992 352 352 352 352 352 352 992 992 000 000 000 0008 v- a5 ^. {4 ?3 m' {' ^! q4 H
RX:0F 60 01 0B 58 C0 07 66 30 83 19 7C 60 06 1F F8 C0 07 00 00 00 00 00 03 00
  P! @1 p- e( }! lCH: 352 352 352 992 1632 1632 1632 992 1632 992 992 992 000 000 000 000
接收的byte24数据并非和协议解析中的一样,无论断开遥控器还是连接遥控器,读取的值都是0x03。0 X2 w4 f! _. u( S
接收机只支持12个通道,所以通道13-16没有值。
  m+ Z3 d2 [1 y* B( J" s/ Z& h# Z读取的通道值中间值为992,最大值为1632,最小值为352。
sbus数据转为 PWM数据
RcData = (uint16_t)(sbusData * 1.2504 + 1761.1) / 2;

% S- N2 s- Y2 L" w4 f
4. 最后
7 V2 ^4 d6 _6 |; x" m提供两个应用优化方向:
使用DMA+双缓存器+串口空闲中断读取和解析数据,提升MCU的工作效率。0 ~( Y# F+ n8 Y
将读取的通道值转化成脉宽(0.5-2.5ms)输出,用来控制模拟信号设备。
4 G/ n9 P. q; Q: H8 w8 T, w+ O/ g本协议解析就写到这里。
8 X" w+ M& u/ M) Z) X$ u' d6 H
赞 收藏 1 评论1 发布时间:2022-1-27 22:58

举报

1个回答
cqxhhe 回答时间:2022-8-4 11:11:04
学习
; S& S# ]; |" i" ^6 |

所属标签

相似技术帖

官网相关资源

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