欢迎来到尧图网

客户服务 关于我们

您的位置:首页 > 文旅 > 艺术 > STM32读取LX-224总线舵机信息

STM32读取LX-224总线舵机信息

2024/10/23 21:36:22 来源:https://blog.csdn.net/weixin_69414084/article/details/140342186  浏览:    关键词:STM32读取LX-224总线舵机信息

一、舵机指令包格式

帧头: 连续收到两个 0x55 ,表示有数据包到达。
ID: 每个舵机都有一个 ID 号。ID 号范围 0~253,转换为十六进制 0x00~0xFD。广播 ID: ID 号 254(0xFE) 为广播 ID,若控制器发出的 ID 号为 254(0xFE),所有的舵机均接收指令,但都不返回应答信息,(读取舵机 ID 号除外,具体说明参见下面指令介绍)以防总线冲突。
数据长度: 等于待发送的数据(包含本身一个字节)长度,即数据长度 Length加 3 等于这一包指令的长度,从帧头到校验和。
指令: 控制舵机的各种指令,如位置、速度控制等。
参数: 除指令外需要补充的控制信息。
校验和: 校验和 Checksum,计算方法如下:
Checksum = ~ (ID + Length + Cmd+ Prm1 + … Prm N)若括号内的计算和超出 255,则取最低的一个字节,“~”表示取反。

 二、74HC126D芯片介绍

1、定义:

        74HC126D是一款四缓冲器/线路驱动器集成电路(IC),属于74系列芯片。该芯片具有四个独立的缓冲器/线路驱动器,可以同时处理四个信号输入,并将其转换为输出信号。采用SOP-14封装,具有较小的体积和较低的功耗,适合高密度集成和小型化设计。此外,该芯片具有高速度、低噪声和低功耗等优良性能,可以保证信号传输的稳定性和可靠性。因此,74HC126D芯片在各种电子设备和系统中得到广泛应用。

控制 TX_CON(控制发送):

  1. 将 TX_CON 拉低

    • 使用微控制器的GPIO输出功能,将一个引脚输出低电平(例如0V或接地)。
    • 这将导致74HC126D芯片上对应的 TX_CON 输入端被拉低,使得输出端 Y1 处于激活状态。
    • 微控制器通过串口 TX 发送数据时,数据信号将被74HC126D内部的放大器放大并传输到 Y1 输出端,驱动外部设备或传输线。

控制 RX_CON(控制接收):

  1. 将 RX_CON 拉高
    • 使用微控制器的GPIO输出功能,将一个引脚输出高电平(例如Vcc或逻辑高电平)。
    • 这将使得74HC126D芯片上对应的 RX_CON 输入端被拉高,导致输出端 Y2 进入高阻态。
    • 当外部设备通过串口 RX 发送数据时,数据信号能够直接进入微控制器的串口接收引脚,而不受74HC126D的影响或干扰。

硬件原理图:

2、74HC126D

74HC126D介绍:
功能描述:

可以看出,当OE输出高电平时 输入是高电平那么输出就是高电平,输入是低电平输出就是低电平。

当OE为低电平时,不管输入状态是什么,输出都是高阻抗关断状态(抽象理解为悬空)。

高阻输出一般是指数字电路输出时不为高电平或低电平,而是相当于断开的一种状态,输出点的电位由后面的电路决定。

这个芯片的作用就是,当需要写入的时候,拉低TX_CON,这样,串口TX发送什么,输出就是什么。拉高RX_CON,这样,串口接收RX就相当于悬空,什么也不干。接收数据也是如此.

三、程序解读

 STM32串口1发送指令,另一个串口3打印接收的数据

串口1发送指令:

void Serial_SendArray(uint8_t *Array, uint16_t Length)
{uint16_t i;GPIO_ResetBits(GPIOA, GPIO_Pin_11);      //TX_COn  GPIO_SetBits(GPIOA, GPIO_Pin_12);		 //RX_COn	74HC126D接收状态for (i = 0; i < Length; i ++){Serial_SendByte(Array[i]);}if(i == Length){GPIO_SetBits(GPIOA, GPIO_Pin_11);    //74HC126D发送状态GPIO_SetBits(GPIOA, GPIO_Pin_12);}
}
//读取舵机信息
uint16_t LobotSerialServoRead(uint8_t id, uint8_t value)
{uint16_t ret;buf[0] = buf[1] = LOBOT_SERVO_FRAME_HEADER;buf[2] = id;buf[3] = 3;buf[4] = value;buf[5] = LobotCheckSum(buf);LobotSerialWrite(buf, 6);  //发送获取位置的命令ret = LobotSerialMsgHandle(); //获取接收到的数据//	USART2_Send_Data(ret);
//	USART2_Send_Data(LobotRxBuf[LobotRxBuf[3]+2]);return ret;
}

接收中断:

#define BUFFER_SIZE 20  // 假设缓冲区大小为20字节
#define FRAME_START_BYTE 0x55 // 帧起始字节uint8_t rxBuf;;  // 定义接收数据的缓冲变量
static uint8_t frameHeaderCount = 0; 
static uint8_t dataLength = 0;  // 数据长度,默认为2
static uint8_t dataCount = 0;  // 数据计数器
static uint8_t RxState = 0;
static uint8_t pRxPacket = 0;
uint8_t frameHeaderBit = 0;uint8_t rxBuffer[BUFFER_SIZE];
int rxIndex = 0;  // 缓冲区索引void USART1_IRQHandler(void)
{if (USART_GetITStatus(USART1, USART_IT_RXNE) == SET){USART_ClearITPendingBit(USART1, USART_IT_RXNE);rxBuf = USART_ReceiveData(USART1);if (!frameHeaderBit) {                    //判断连续两个帧头是否为0x55if (rxBuf == FRAME_START_BYTE) {frameHeaderCount++;rxBuffer[rxIndex++] = rxBuf;if(frameHeaderCount == 2){frameHeaderCount = 0;frameHeaderBit = 1;  //接收到完整的帧头rxIndex = 2;    //从第三个开始存数据}}}else{// 已经处于帧内rxBuffer[rxIndex++] = rxBuf;  //从索引3开始// 假设帧长度固定为7字节if (rxIndex >= 7) {// 检查帧头是否正确if (rxBuffer[0] == FRAME_START_BYTE && rxBuffer[1] == FRAME_START_BYTE) {// 打印整个接收到的数据帧printf("Received frame: ");for (int i = 0; i < rxIndex; i++) {printf("%02X ", rxBuffer[i]);   //十六进制打印}printf("\n");// 复位缓冲区和状态标志,准备接收下一个帧rxIndex = 0;frameHeaderBit = 0;frameHeaderCount=0;} else {// 如果帧头不正确,丢弃整个缓冲区rxIndex = 0;frameHeaderBit = 0;frameHeaderCount=0;}}	}}
}

 校验和计算:

  1. 循环计算累加和:从buf数组的第三个元素开始累加,累加的长度由buf[3]决定,直到累加到指定长度。

  2. 取反操作:对累加和进行按位取反。

  3. 类型转换:将取反后的结果转换为uint8_t类型。

  4. 返回校验和:将转换后的结果作为函数的返回值,即为计算得到的校验和。

  5. 延时操作:调用延时函数Delay_ms(10),用于稳定处理过程。

//校验和
uint8_t checksum;//缓冲区
extern uint8_t rxBuffer[BUFFER_SIZE];uint8_t buf[6];
//校验计算
uint8_t LobotCheckSum(uint8_t buf[])
{uint8_t i;uint8_t temp = 0;for (i = 2; i < buf[3] + 2; i++) {temp += buf[i];}temp = ~temp;i = (uint8_t)temp;Delay_ms(10);return i;
}

调用校验和计算函数,获取校验和。通过判断校验和是否与 rxBuffer[3] + 2 位置的数据是否相等,来进行下一步的命令判断。

命令cmd位于 rxBuffer数组的索引5

uint16_t LobotSerialMsgHandle(void)
{uint8_t cmd;uint16_t ret;checksum = LobotCheckSum(rxBuffer);// 校验和验证if (checksum == rxBuffer[rxBuffer[3] + 2]) {uint8_t cmd;uint16_t ret;
//		printf("Checksum valid:%d\n\r",checksum);Delay_ms(1000);// 进一步处理数据cmd = rxBuffer[4]; //14
//	printf("cmd :%d\n",cmd);switch(cmd){break;case LOBOT_SERVO_ID_READ:ret = rxBuffer[2];			//读取ID   return ret;break;default:break;}} else {printf("Checksum invalid\n\r");}return 0;
}

串口打印情况:

前面两个0x55是帧头,第一个和第二个01都是舵机的id,04是数据的长度(从第一个01到第二个01,总共4个数据),OE是命令指令的十六进制(十进制为14),EB是校验和。

计算过程:

十六进制转十进制

01  ---- >  01

 04 ---- >  04

OE ---- >  14

EB ----->  235

从第三位累加到倒数第二位,即第一个01  --- > 第二个01

校验和 = ~(1+ 4 + 14 + 1 )=~(20)= 255 - 20 =235

由此可以验证数据正确 

版权声明:

本网仅为发布的内容提供存储空间,不对发表、转载的内容提供任何形式的保证。凡本网注明“来源:XXX网络”的作品,均转载自其它媒体,著作权归作者所有,商业转载请联系作者获得授权,非商业转载请注明出处。

我们尊重并感谢每一位作者,均已注明文章来源和作者。如因作品内容、版权或其它问题,请及时与我们联系,联系邮箱:809451989@qq.com,投稿邮箱:809451989@qq.com