| | |
| | | package jiexi; |
| | | import java.util.Arrays; |
| | | public class Dell55AA01Parser { |
| | | // 常量定义 |
| | | private static final String EXPECTED_HEADER = "55AA01"; // 协议头 |
| | | private static final int MIN_LENGTH = 42; // 最小长度(21字节*2字符) |
| | | // 常量定义 |
| | | private static final String EXPECTED_HEADER = "55AA01"; // 协议头 |
| | | private static final int MIN_LENGTH = 42; // 最小长度(21字节*2字符) |
| | | private static final ThreadLocal<ParseResult> RESULT_CACHE = |
| | | ThreadLocal.withInitial(ParseResult::new); |
| | | |
| | | // 解析结果类 |
| | | // 解析结果类 |
| | | public static class ParseResult { |
| | | public int sequenceNum; // 序列号 |
| | | public String tagId; // 标签ID(4字节小端序) |
| | | public String anchorId; // 锚点ID(4字节小端序) |
| | | public int distance; // 距离(毫米) |
| | | public int power; // 电量(0-100) |
| | | public int buttonPressed; // 按钮状态 |
| | | public int sequenceNum; // 序列号 |
| | | public String tagId; // 标签ID(4字节小端序) |
| | | public String anchorId; // 锚点ID(4字节小端序) |
| | | public int distance; // 距离(毫米) |
| | | public int power; // 电量(0-100) |
| | | public int buttonPressed; // 按钮状态 |
| | | public boolean buttonPressed2; |
| | | public void reset() { |
| | | sequenceNum = 0; |
| | |
| | | } |
| | | |
| | | /** |
| | | * 解析55AA01协议数据 |
| | | * @param message 十六进制字符串 |
| | | * @return 解析结果(错误时返回null) |
| | | * 解析55AA01协议数据 |
| | | * @param message 十六进制字符串 |
| | | * @return 解析结果(错误时返回null) |
| | | */ |
| | | public static ParseResult parse(String message, String ip, int port) { |
| | | if (message == null || message.isEmpty()) { |
| | | return null; |
| | | } |
| | | |
| | | // 清洗数据:移除所有非十六进制字符 |
| | | // 清洗数据:移除所有非十六进制字符 |
| | | char[] cleanedMessage = cleanMessage(message); |
| | | |
| | | // 数据校验 |
| | | // 数据校验 |
| | | if (cleanedMessage == null || cleanedMessage.length < MIN_LENGTH) { |
| | | return null; |
| | | } |
| | | |
| | | // 协议头校验 (55AA01) |
| | | // 协议头校验 (55AA01) |
| | | if (!new String(cleanedMessage, 0, 6).equals(EXPECTED_HEADER)) { |
| | | return null; |
| | | } |
| | |
| | | result.reset(); |
| | | |
| | | try { |
| | | if (cleanedMessage.length < 30) { // 确保有足够长度访问charAt(28) |
| | | if (cleanedMessage.length < 30) { // 确保有足够长度访问charAt(28) |
| | | return null; |
| | | } |
| | | |
| | | // 解析序列号 (位置8-9) |
| | | // 解析序列号 (位置8-9) |
| | | result.sequenceNum = HexUtils.fastHexToByte(cleanedMessage[8], cleanedMessage[9]); |
| | | |
| | | // 解析标签ID (位置10-13, 小端序) |
| | | // 解析标签ID (位置10-13, 小端序) |
| | | result.tagId = new String(new char[]{ |
| | | cleanedMessage[12], cleanedMessage[13], // 高位 |
| | | cleanedMessage[10], cleanedMessage[11] // 低位 |
| | | cleanedMessage[12], cleanedMessage[13], // 高位 |
| | | cleanedMessage[10], cleanedMessage[11] // 低位 |
| | | }); |
| | | |
| | | // 解析锚点ID (位置14-17, 小端序) |
| | | // 解析锚点ID (位置14-17, 小端序) |
| | | result.anchorId = new String(new char[]{ |
| | | cleanedMessage[16], cleanedMessage[17], // 高位 |
| | | cleanedMessage[14], cleanedMessage[15] // 低位 |
| | | cleanedMessage[16], cleanedMessage[17], // 高位 |
| | | cleanedMessage[14], cleanedMessage[15] // 低位 |
| | | }); |
| | | |
| | | // 解析距离 (位置18-25, 4字节小端整数) |
| | | int b0 = HexUtils.fastHexToByte(cleanedMessage[18], cleanedMessage[19]); // 最低位 |
| | | // 解析距离 (位置18-25, 4字节小端整数) |
| | | int b0 = HexUtils.fastHexToByte(cleanedMessage[18], cleanedMessage[19]); // 最低位 |
| | | int b1 = HexUtils.fastHexToByte(cleanedMessage[20], cleanedMessage[21]); |
| | | int b2 = HexUtils.fastHexToByte(cleanedMessage[22], cleanedMessage[23]); |
| | | int b3 = HexUtils.fastHexToByte(cleanedMessage[24], cleanedMessage[25]); // 最高位 |
| | | int b3 = HexUtils.fastHexToByte(cleanedMessage[24], cleanedMessage[25]); // 最高位 |
| | | int raw = (b3 << 24) | (b2 << 16) | (b1 << 8) | b0; |
| | | result.distance = raw; // 保持原始整数值 |
| | | result.distance = raw; // 保持原始整数值 |
| | | |
| | | // 解析电量 (位置26-27) |
| | | // 解析电量 (位置26-27) |
| | | result.power = HexUtils.fastHexToByte(cleanedMessage[26], cleanedMessage[27]); |
| | | |
| | | // 解析按钮状态 (位置28-29) |
| | | // 解析按钮状态 (位置28-29) |
| | | result.buttonPressed = HexUtils.fastHexToByte(cleanedMessage[28], cleanedMessage[29]); |
| | | result.buttonPressed2 =result.buttonPressed==1; |
| | | |