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

news2024/9/27 7:16:42

一、舵机指令包格式

帧头: 连续收到两个 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) {                    //判断连续两个帧头是否为0x55
			if (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

由此可以验证数据正确 

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.coloradmin.cn/o/1920148.html

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈,一经查实,立即删除!

相关文章

DockerFile文件解析

DockerFile 要研究自己如何做一个镜像&#xff0c;而且微服务项目打包上云部署&#xff0c;Docker就是最方便的。 微服务打包成镜像&#xff0c;任何装了Docker的地方&#xff0c;都可以下载使用&#xff0c;极其的方便。 流程&#xff1a;开发应用>DockerFile>打包为…

c++ 建造者模式

文章目录 建造者模式为什么使用建造者模式建造者模式实现步骤实现示例建造者模式优缺点 建造者模式 建造者模式&#xff08;Builder Pattern&#xff09;是面向对象设计模式中的一种&#xff0c;主要用于创建复杂对象。这种模式将对象的构建过程与其表示分离&#xff0c;允许用…

Qt+ESP32+SQLite 智能大棚

环境简介 硬件环境 ESP32、光照传感器、温湿度传感器、继电器、蜂鸣器 基本工作流程 上位机先运行&#xff0c;下位机启动后尝试连接上位机连接成功后定时上报传感器数据到上位机&#xff0c;上位机将信息进行处理展示判断下位机传感器数据&#xff0c;如果超过设置的阈值&a…

电商出海第一步,云手机或成重要因素

电商出海第一步并非易事&#xff0c;挑战和机遇并存&#xff0c;出海企业或个人或将借助云手机从而达成商业部署全球化的目的&#xff1b; 下面我们从网络稳定、数据安全、成本、以及多平台适配方面来看&#xff0c;究竟为什么说云手机会成为出海的重要因素&#xff1b; 首先…

图谱动态240709

本期将分享近期全球知识图谱相关 行业动态、会议资讯、论文推荐 —--| 行业动态 |--— 微软开源GraphRAG 7月2日&#xff0c;微软开源了GraphRAG&#xff0c;一种基于图的检索增强生成(RAG) 方法&#xff0c;可以对私有或以前未见过的数据集进行问答&#xff08;开源地址&…

ENSP防火墙

实验拓扑图 需求&#xff1a; ENSP的配置&#xff1a; 防火墙&#xff1a; 交换机&#xff1a; 华为防火墙的配置&#xff1a; 接口配置&#xff1a; 安全区域&#xff1a; 安全策略&#xff1a; 办公区访问DMZ&#xff1a; 生产区访问DMZ&#xff1a; 游客区只能访问门户网…

USB转RS485+RS232+TTL串口电路

USB转RS485RS232TTL电路 USB转RS485RS232TTL电路如下图所示&#xff0c;可实现USB转RS485RS232TTL串口&#xff0c;一个电路模块即可实现电路调试过程中用到常用接口。 电路模块上留有2.54MM单排针接口和接线端子两种接线方式&#xff0c;可接线和跳线。电路模块同时有5V和3.3V…

Vulkan入门系列0- Vulkan与OpenGL的区别

一:概述 Vulkan 是新一代图形和计算API,是由科纳斯组织(Khronos Group)维护的一套跨平台的、开放标准的、现代GPU 的编程接口,它仅仅是规定了一套编程接口,并没有接口的具体实现,实现是由硬件厂商适配实现的,市面上像NVIDIA、AMD和Intel等国际大厂基本提供了完整的…

C++ enum class转常量

当使用 enum class 时&#xff0c;它具有更强的类型安全性和隔离性&#xff0c;因此需要显式转换才能访问其底层整数值。 std::underlying_type_t 是一个类型别名&#xff0c;它返回枚举类型的底层类型。 to_underlying 函数提供了一种方便的方式来执行这种转换&#xff0c;特别…

vb.netcad二开自学笔记8:界面之任务窗格

使用net可以创建一个类似属性面板的自定义的任务窗格&#xff0c;从而实现应用程序更丰富的人机交互。 1、添加一个自定义控件 2、在前面创建的代码框架内增加一个命令函数ShowMyPalette Imports System.Windows.Media.Imaging Imports Autodesk.AutoCAD.ApplicationServices …

python的简单爬取

需要的第三方模块 requests winr打开命令行输入cmd 简单爬取的基本格式&#xff08;爬取百度logo为例&#xff09; import requests url"http://www.baidu.com/img/PCtm_d9c8750bed0b3c7d089fa7d55720d6cf.png" resprequests.get(url)#回应 #保存到本地 with open(&…

5G中的RedCap

5G中的RedCap&#xff1a;降低能力的重要性和实现方式 随着5G技术的推广和普及&#xff0c;设备和终端的多样化使得网络能力的管理变得更加复杂和关键。RedCap&#xff08;Reduced Capability&#xff09;作为一个重要的概念&#xff0c;旨在解决设备能力差异对网络服务和用户…

基于PID控制器的双容控制系统matlab仿真

目录 1.课题概述 2.系统仿真结果 3.核心程序与模型 4.系统原理简介 4.1PID控制器的基本原理 4.2双容水箱系统的数学模型 5.完整工程文件 1.课题概述 基于PID控制器的双容控制系统matlab仿真&#xff0c;仿真输出PID控制下的水位和流量两个指标。 2.系统仿真结果 &…

部署YUM仓库及NFS共享功能

目录 一、YUM仓库服务 1、YUM仓库概述 2、准备安装源 2.1、软件仓库的提供方式 2.2、 RPM软件包的来源 3、YUM主配置文件 4、软件卸载 5、YUM源的提供方式 5.1、配置本地YUM源仓库 5.2、配置ftp源 5.2.1、服务端配置 5.2.2、客户端配置 二、NFS共享存储 1、NFS基…

Element UI 添加自定义图标

Element UI 自带的默认图标 随着项目的越来越大&#xff0c;图标总是不够用&#xff0c;接下来就给大家说明下如何添加自定义图标 首页给大家介绍一个图标网站&#xff1a;iconfont-阿里巴巴矢量图标库 网站上有很多设计好的图标&#xff0c;基本都有你想要的了&#xff0c…

【RHCE】系统服务综合实验

一、实验内容 现有主机 node01 和 node02&#xff0c;完成如下需求&#xff1a; 1、在 node01 主机上提供 DNS 和 WEB 服务 2、dns 服务提供本实验所有主机名解析 3、web服务提供 www.rhce.com 虚拟主机 4、该虚拟主机的documentroot目录在 /nfs/rhce 目录 5、该目录由 node02…

【机器学习实战】Datawhale夏令营2:音视频攻防(deepfake)Baseline句解

# Datawhale # AI夏令营 # 夏令营 文章目录 1. 赛题简要介绍2. 赛题数据集3. 评价指标4. Baseline整体4.1 计算样本数4.2 创建video对象4.3 下载需要的库&&补充知识4.4 设置pytorch随机种子&&CUDNN配置4.5 音视频预处理4.6 创建训练数据文件夹4.7 生成梅尔频谱…

Windows下查看某个端口被某个应用占用

1、打开命令窗口(以管理员身份运行) ​​​​​​​​​​ 2、查找所有运行的端口 输入所有命令&#xff1a;当前命令可以查看当前电脑的全部端口使用情况 netstat -ano3、查看被占用端口对应的 PID&#xff08;这里以8000端口为例&#xff09; netstat -ano|findstr &qu…