#修改远程遥控控制方式 将左右轮速改成线速度和角速度

This commit is contained in:
2026-10-16 09:19:31 +08:00
parent 11984316d4
commit 9e3ec6a1dd
11 changed files with 249 additions and 89 deletions

View File

@@ -1,97 +0,0 @@
package com.maibu.dto;
import lombok.Data;
import java.nio.ByteBuffer;
import java.nio.ByteOrder;
@Data
public class LawnMoverProtocolEntity {
public LawnMoverProtocolEntity() {
Header1 = (byte) 0xAB;
Header2 = (byte) 0xAA;
CommandType = 0x00;
LeftWheelSpeed = 0x0000;
RightWheelSpeed = 0x0000;
ChassisLiftFlag = 0x00;
MowerSpeedFlag = 0x00;
IgnitionFlag = 0x00;
EmergencyStopFlag = 0x00;
Crc16 = 0x0000;
EndFlag1 = (byte) 0xAA;
EndFlag2 = (byte) 0xAB;
}
@Override
public String toString() {
return "LawnMoverProtocolEntity{" +
"Header1=" + Header1 +
", Header2=" + Header2 +
", CommandType=" + CommandType +
", LeftWheelSpeed=" + LeftWheelSpeed +
", RightWheelSpeed=" + RightWheelSpeed +
", ChassisLiftFlag=" + ChassisLiftFlag +
", MowerSpeedFlag=" + MowerSpeedFlag +
", IgnitionFlag=" + IgnitionFlag +
", EmergencyStopFlag=" + EmergencyStopFlag +
", Crc16=" + Crc16 +
", EndFlag1=" + EndFlag1 +
", EndFlag2=" + EndFlag2 +
'}';
}
public byte[] toBytes() {
ByteBuffer buffer = ByteBuffer.allocate(15);
buffer.order(ByteOrder.LITTLE_ENDIAN); // 根据协议决定字节序
buffer.put(Header1);
buffer.put(Header2);
buffer.put(CommandType);
buffer.putShort(LeftWheelSpeed);
buffer.putShort(RightWheelSpeed);
buffer.put(ChassisLiftFlag);
buffer.put(MowerSpeedFlag);
buffer.put(IgnitionFlag);
buffer.put(EmergencyStopFlag);
buffer.putShort(Crc16); // 如果要计算真实 CRC16 可在此插入计算逻辑
buffer.put(EndFlag1);
buffer.put(EndFlag2);
return buffer.array();
}
public static String printBytesToHex(byte[] bytes) {
StringBuilder sb = new StringBuilder(bytes.length * 3);
for (byte b : bytes) {
sb.append(String.format("%02X ", b));
}
return sb.toString().trim();
}
// 包头起始字节1
private byte Header1;
// 包头起始字节2
private byte Header2;
// 指令类型
private byte CommandType;
// 左轮速度:16位有符号
private short LeftWheelSpeed;
// 右轮速度:16位有符号
private short RightWheelSpeed;
// 底盘升降标志位
private byte ChassisLiftFlag;
// 割刀速度标志位
private byte MowerSpeedFlag;
// 点火标志位
private byte IgnitionFlag;
// 保留位
private byte EmergencyStopFlag;
// Crc校验
private short Crc16;
// 包尾字节1
private byte EndFlag1;
// 包尾字节2
private byte EndFlag2;
}