#修改远程遥控控制方式 将左右轮速改成线速度和角速度
This commit is contained in:
@@ -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;
|
||||
|
||||
}
|
||||
Reference in New Issue
Block a user