基于RT-Thread的RoboMaster电控框架(五)

发布时间:2024-01-11  

背景


使用的开发板为大疆的 RoboMaster-C 型开发板,基础工程为 rt-thread>bsp>stm32f407-robomaster-c



遥控器模块开发


在 C 板上是提供了针对大疆遥控器的 DBUS 接口,但本片文章是基于 SBUS 进行遥控。


DBUS:100k波特率,8位数据位,1位停止位,偶校验(EVEN),无控流,18个字节;

SBUS:100k波特率,8位数据位,2位停止位,偶校验(EVEN),无控流,25个字节。

SBUS 和 DBUS 主要区别就是停止位不同,两者都需要硬件取反电路,因此 SBUS 的接收机也是可以直接插在 C 板提供的 DBUS 接口上进行使用的,只需要在软件层面修改数据解析处理即可。


串口DMA双缓冲


这里使用的是空闲中断 + DMA双缓冲的方案,改方案能够极大限度的提高处理高速数据的效率和稳定性。


但STM32不是所有芯片都支持DMA双缓冲,虽然也可以通过DMA半满中断实现双缓冲的效果,但是这样程序的兼容性是较差的;因此针对遥控器接收机的串口,选择不使用 RT-Thread 的串口驱动框架,也不是对其驱动框架进行改动。而是使用 HAL 库实现,但不会影响其他串口使用 RT-Thread 的串口驱动框架。


代码实现


首先是串口和 DMA 的初始化:


/* DMA controller clock enable */

__HAL_RCC_DMA1_CLK_ENABLE();

/* DMA1_Stream1_IRQn interrupt configuration */

HAL_NVIC_SetPriority(DMA1_Stream1_IRQn, 0, 0);

HAL_NVIC_EnableIRQ(DMA1_Stream1_IRQn);

huart3.Instance = USART3;

huart3.Init.BaudRate = 100000;

huart3.Init.WordLength = UART_WORDLENGTH_9B;

huart3.Init.StopBits = UART_STOPBITS_2;

huart3.Init.Parity = UART_PARITY_EVEN;

huart3.Init.Mode = UART_MODE_TX_RX;

huart3.Init.HwFlowCtl = UART_HWCONTROL_NONE;

huart3.Init.OverSampling = UART_OVERSAMPLING_16;

HAL_UART_Init(&huart3);

以及 DMA 双缓冲功能的配置:


/**


@brief 串口 DMA 双缓冲初始化

@param rx1_buf 缓冲区1

@param rx2_buf 缓冲区2

@param dma_buf_num DMA缓冲区大小

*/

static void rc_doub_dma_init(uint8_t *rx1_buf, uint8_t *rx2_buf, uint16_t dma_buf_num)

{

//使能DMA串口接收

SET_BIT(huart3.Instance->CR3, USART_CR3_DMAR);

//使能空闲中断

__HAL_UART_ENABLE_IT(&huart3, UART_IT_IDLE);

//失效DMA

__HAL_DMA_DISABLE(&hdma_usart3_rx);

while(hdma_usart3_rx.Instance->CR & DMA_SxCR_EN)

{

__HAL_DMA_DISABLE(&hdma_usart3_rx);

}

hdma_usart3_rx.Instance->PAR = (uint32_t) & (USART3->DR);

//内存缓冲区1

hdma_usart3_rx.Instance->M0AR = (uint32_t)(rx1_buf);

//内存缓冲区2

hdma_usart3_rx.Instance->M1AR = (uint32_t)(rx2_buf);

//数据长度

hdma_usart3_rx.Instance->NDTR = dma_buf_num;

//使能双缓冲区

SET_BIT(hdma_usart3_rx.Instance->CR, DMA_SxCR_DBM);

//使能DMA

__HAL_DMA_ENABLE(&hdma_usart3_rx);

}


以及 CubeMX 的一些基本配置,这里就不细说了,设置完这些,串口空闲中断 + DMA双缓冲就开起来了,接下来就是要到串口中断处理函数里进行 DMA 双缓冲的接收和数据的解析处理了:


void USART3_IRQHandler(void)

{

if(huart3.Instance->SR & UART_FLAG_RXNE)

{

__HAL_UART_CLEAR_PEFLAG(&huart3);

}

else if(USART3->SR & UART_FLAG_IDLE)

{

static uint16_t this_time_rx_len = 0;

__HAL_UART_CLEAR_PEFLAG(&huart3);

if ((hdma_usart3_rx.Instance->CR & DMA_SxCR_CT) == RESET)

{

/* Current memory buffer used is Memory 0 /

//失效DMA

__HAL_DMA_DISABLE(&hdma_usart3_rx);

//get receive data length, length = set_data_length - remain_length

//获取接收数据长度,长度 = 设定长度 - 剩余长度

this_time_rx_len = SBUS_RX_BUF_NUM - hdma_usart3_rx.Instance->NDTR;

//重新设定数据长度

hdma_usart3_rx.Instance->NDTR = SBUS_RX_BUF_NUM;

//设定缓冲区1

hdma_usart3_rx.Instance->CR |= DMA_SxCR_CT;

//使能DMA

__HAL_DMA_ENABLE(&hdma_usart3_rx);

if(this_time_rx_len == SBUS_FRAME_SIZE)

{

//处理遥控器数据

sbus_rc_decode(sbus_rx_buf[0]);

rt_timer_start(rc_timer);

}

}

else

{

/ Current memory buffer used is Memory 1 */

//失效DMA

__HAL_DMA_DISABLE(&hdma_usart3_rx);

//get receive data length, length = set_data_length - remain_length

//获取接收数据长度,长度 = 设定长度 - 剩余长度

this_time_rx_len = SBUS_RX_BUF_NUM - hdma_usart3_rx.Instance->NDTR;

//重新设定数据长度

hdma_usart3_rx.Instance->NDTR = SBUS_RX_BUF_NUM;

//设定缓冲区0

DMA1_Stream1->CR &= ~(DMA_SxCR_CT);

//使能DMA

__HAL_DMA_ENABLE(&hdma_usart3_rx);

if(this_time_rx_len == SBUS_FRAME_SIZE)

{

//处理遥控器数据

sbus_rc_decode(sbus_rx_buf[1]);

rt_timer_start(rc_timer);

}

}

}

}


到这一步,已经可以顺利的接收并解析处理 SBUS 遥控数据了。


通过空闲中断我们可以确保完整的接收数据帧,而且使用 DMA 双缓冲以后,相较于普通的 DMA 接收处理高速数据更加高效快速,在处理一个缓冲区的数据之前,先将 DMA 切换到另外一个缓冲区,这样在处理数据的时候就不会影响到 DMA 数据的接收,而且针对遥控器这种实时要求高且解析简单的数据,就可以在中断处理函数中 DMA 缓冲区切换后直接进行解析处理。


STM32F4 系列是支持 DMA 双缓冲功能的,但是对于其他一些不支持双缓冲的芯片,也想要使用 pingpong 缓冲的话,就可以通过 DMA 半满中断实现。


抽象设备


这里将遥控器数据就简单的抽象为遥控器设备:


typedef struct

{

int16_t ch1; //右侧左右

int16_t ch2; //右侧上下

int16_t ch3; //左侧上下

int16_t ch4; //左侧左右

int16_t ch5; //左侧非线性旋钮

int16_t ch6; //右侧非线性旋钮

uint8_t sw1; //右侧长拨杆

uint8_t sw2; //左侧长拨杆

uint8_t sw3; //右侧短拨杆

uint8_t sw4; //左侧短拨杆

} rc_obj_t;


接收到数据存储在 rc_sbus.c 的 rc_data[2] 中:


rc_obj_t rc_data[2]; // [0]:当前数据NOW,[1]:上一次的数据LAST

通过调用 sbus_rc_init() 即可获得遥控器数据的地址,使用示例如下:


rc_obj_t rc_data[2]; // [0]:当前数据NOW,[1]:上一次的数据LAST

rc_data = sbus_rc_init();


文章来源于:电子工程世界    原文链接
本站所有转载文章系出于传递更多信息之目的,且明确注明来源,不希望被转载的媒体或个人可与我们联系,我们将立即进行删除处理。

相关文章

    动部件分类分为: a. 步进电动机伺服系统。 b. 直流电动机伺服系统。 c. 交流电动机伺服系统。 03 工作原理 伺服电机内部的转子是永磁铁,驱动器控制的U/V/W三相电形成电磁场,转子在此磁场的作用下转动,同时电机......
    伺服控制、步进控制的知识要点;1、交流伺服电机的工作原理 伺服电机内部的转子是永磁铁,驱动器控制的U/V/W三相电形成电磁场,转子在此磁场的作用下转动,同时电机自带的编码器反馈信号给驱动器,驱动......
    伺服控制、步进控制、变频控制的知识要点;伺服控制  1 、交流伺服电机的工作原理 伺服电机内部的转子是永磁铁,驱动器控制的U/V/W三相电形成电磁场,转子在此磁场的作用下转动,同时电机......
    浅析基于模糊PID的永磁同步电机矢量控制;永磁同步电机由于其转动惯量低、效率高、控制方式便捷等优点,已成为当今伺服系统中最佳的执行结构之一。速度、位置和电流组成了永磁同步电机伺服控制系统。实际控制......
    伺服、步进、变频三大控制要点详解;伺服控制 1、交流伺服电机的工作原理 伺服电机内部的转子是永磁铁,驱动器控制的U/V/W三相电形成电磁场,转子在此磁场的作用下转动,同时电机......
    驱动器。以前,电机驱动的典型架构是一个驱动器控制一个电机。因此,当设备厂商需要控制多个电机时,必须增加伺服驱动器,结果元器件数量翻倍,物料成本(BOM)上升,故障点增加。ST全新双电机伺服......
    的信息链接包括: RC伺服控制 RC飞机伺服系统使用指南 遥控伺服器101 R / C Servos用于: 在遥控模型中(汽车,飞机…)。 在机器人技术中。 电气连接和PWM脉冲 伺服系统有3条线: 黑色......
    传感器反馈实时信号与设定值进行比较,实现高精度控制;而PLC控制系统则采用开环控制方式,根据预设的程序执行控制指令。 3. 硬件结构:伺服控制系统需要配合伺服驱动器和电机使用,通常需要单独的控制器,包括编码器、运动控制卡、减速器等;而......
    快、动作平稳,可实现定位伺服控制;易与计算机(CPU)连接。 设备难于小型化;液压源和液压油要求严格;易产生泄露而污染环境。 2、常用的控制用电机   控制用电机是电气伺服控制系统的动力部件。它是......
    每个工位上的内框纸长度保持一致的同时每张内框纸上图案偏差在要求的±0.5 mm 以内。 2   控制策略 2.1 伺服电机控制策略 单电机伺服控制采用电流、速度、位置的三环控制[3]。电流环为三环控制......

我们与500+贴片厂合作,完美满足客户的定制需求。为品牌提供定制化的推广方案、专属产品特色页,多渠道推广,SEM/SEO精准营销以及与公众号的联合推广...详细>>

利用葫芦芯平台的卓越技术服务和新产品推广能力,原厂代理能轻松打入消费物联网(IOT)、信息与通信(ICT)、汽车及新能源汽车、工业自动化及工业物联网、装备及功率电子...详细>>

充分利用其强大的电子元器件采购流量,创新性地为这些物料提供了一个全新的窗口。我们的高效数字营销技术,不仅可以助你轻松识别与连接到需求方,更能够极大地提高“闲置物料”的处理能力,通过葫芦芯平台...详细>>

我们的目标很明确:构建一个全方位的半导体产业生态系统。成为一家全球领先的半导体互联网生态公司。目前,我们已成功打造了智能汽车、智能家居、大健康医疗、机器人和材料等五大生态领域。更为重要的是...详细>>

我们深知加工与定制类服务商的价值和重要性,因此,我们倾力为您提供最顶尖的营销资源。在我们的平台上,您可以直接接触到100万的研发工程师和采购工程师,以及10万的活跃客户群体...详细>>

凭借我们强大的专业流量和尖端的互联网数字营销技术,我们承诺为原厂提供免费的产品资料推广服务。无论是最新的资讯、技术动态还是创新产品,都可以通过我们的平台迅速传达给目标客户...详细>>

我们不止于将线索转化为潜在客户。葫芦芯平台致力于形成业务闭环,从引流、宣传到最终销售,全程跟进,确保每一个potential lead都得到妥善处理,从而大幅提高转化率。不仅如此...详细>>