2026-04-17 10:32:57 +08:00
|
|
|
package com.maibu.utils;
|
|
|
|
|
|
2026-04-17 17:12:41 +08:00
|
|
|
|
|
|
|
|
import com.maibu.common.MiddleCommandConstant;
|
|
|
|
|
import com.maibu.control.DiffSteer;
|
|
|
|
|
import com.maibu.dto.LawnMoverProtocolEntity;
|
2026-04-17 10:32:57 +08:00
|
|
|
|
|
|
|
|
import java.nio.ByteBuffer;
|
|
|
|
|
import java.nio.ByteOrder;
|
|
|
|
|
import java.util.List;
|
|
|
|
|
|
|
|
|
|
public class ControlUtils {
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
public static LawnMoverProtocolEntity getCarControlMessage(DiffSteer diffSteer, int originX, int originY, List<Boolean> buttons) {
|
|
|
|
|
LawnMoverProtocolEntity state = new LawnMoverProtocolEntity();
|
|
|
|
|
diffSteer.calcWheelSpeed(originX, originY);
|
|
|
|
|
state.setCommandType(MiddleCommandConstant.remoteControl);
|
|
|
|
|
state.setLeftWheelSpeed((short) diffSteer.getLeftWheelSpeed());
|
|
|
|
|
state.setRightWheelSpeed((short) diffSteer.getRightWheelSpeed());
|
|
|
|
|
|
|
|
|
|
//对应的 button数组 L1 button【4】 R1 button【5】 A对应的button【0】 B对应button【1】 X对应button【2】 Y对应button【3】 button[7]急停
|
|
|
|
|
//A升B降底盘 X割刀加速Y减速 L1点火 R1熄火
|
|
|
|
|
Boolean A = buttons.get(0);
|
|
|
|
|
Boolean B = buttons.get(1);
|
|
|
|
|
Boolean X = buttons.get(2);
|
|
|
|
|
Boolean Y = buttons.get(3);
|
|
|
|
|
Boolean L1 = buttons.get(4);
|
|
|
|
|
Boolean R1 = buttons.get(5);
|
|
|
|
|
Boolean eStop = buttons.get(8); //急停
|
|
|
|
|
//底盘升降
|
|
|
|
|
int chassisLiftFlag = 0;
|
|
|
|
|
if (A & !B) {
|
|
|
|
|
chassisLiftFlag = 1;
|
|
|
|
|
} else if (!A & B) {
|
|
|
|
|
chassisLiftFlag = 2;
|
|
|
|
|
}
|
|
|
|
|
state.setChassisLiftFlag((byte) chassisLiftFlag);
|
|
|
|
|
//割刀加减速
|
|
|
|
|
int mowerSpeedFlag = 0;
|
|
|
|
|
if (X & !Y) {
|
|
|
|
|
mowerSpeedFlag = 1;
|
|
|
|
|
} else if (!X & Y) {
|
|
|
|
|
mowerSpeedFlag = 2;
|
|
|
|
|
}
|
|
|
|
|
state.setMowerSpeedFlag((byte) mowerSpeedFlag);
|
|
|
|
|
//点火熄火
|
|
|
|
|
int ignitionFlag = 0;
|
|
|
|
|
if (L1 & !R1) {
|
|
|
|
|
ignitionFlag = 1;
|
|
|
|
|
} else if (!L1 & R1) {
|
|
|
|
|
ignitionFlag = 2;
|
|
|
|
|
}
|
|
|
|
|
state.setIgnitionFlag((byte) ignitionFlag);
|
|
|
|
|
|
|
|
|
|
int emergencyStopFlag = eStop ? 1 : 0;
|
|
|
|
|
state.setEmergencyStopFlag((byte) emergencyStopFlag);
|
|
|
|
|
// val toBytes = state.toBytes()
|
|
|
|
|
// println("toBytes==" + LawnMoverProtocolEntity.printBytesToHex(toBytes))
|
|
|
|
|
return state;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
public static byte[] buildControlCommand(LawnMoverProtocolEntity entity) {
|
|
|
|
|
ByteBuffer buffer = ByteBuffer.allocate(15);
|
|
|
|
|
buffer.order(ByteOrder.LITTLE_ENDIAN);
|
|
|
|
|
|
|
|
|
|
buffer.put(entity.getHeader1());
|
|
|
|
|
buffer.put(entity.getHeader2());
|
|
|
|
|
buffer.put(entity.getCommandType());
|
|
|
|
|
|
|
|
|
|
buffer.putShort(entity.getLeftWheelSpeed());//左轮速度
|
|
|
|
|
buffer.putShort(entity.getRightWheelSpeed());//右轮速度
|
|
|
|
|
|
|
|
|
|
buffer.put(entity.getChassisLiftFlag());//底盘升降
|
|
|
|
|
buffer.put(entity.getMowerSpeedFlag());//割刀加减速
|
|
|
|
|
buffer.put(entity.getIgnitionFlag());//点火状态
|
|
|
|
|
buffer.put(entity.getEmergencyStopFlag());//急停
|
|
|
|
|
|
|
|
|
|
buffer.put((byte) 0x00);
|
|
|
|
|
buffer.put((byte) 0x00);
|
|
|
|
|
buffer.put(entity.getEndFlag1());
|
|
|
|
|
buffer.put(entity.getEndFlag2());
|
|
|
|
|
return buffer.array();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
}
|