package com.maibu.utils; import com.maibu.common.MiddleCommandConstant; import com.maibu.control.DiffSteer; import com.maibu.dto.LawnMoverProtocolEntity; 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 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(); } }