首次提交AOA自动跟随

826220679@qq.com

5 天以前 352da282b6c21700eb454407b92cabcf169a448e

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
package home;
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 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 boolean buttonPressed2;
        public void reset() {
            sequenceNum = 0;
            tagId = "";
            anchorId = "";
            distance = 0;
            power = 0;
            buttonPressed = 0;
            buttonPressed2=false;
        }
    }
 
    /**
     * ½âÎö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)
        if (!new String(cleanedMessage, 0, 6).equals(EXPECTED_HEADER)) {
            return null;
        }
 
        ParseResult result = RESULT_CACHE.get();
        result.reset();
 
        try {
            if (cleanedMessage.length < 30) { // È·±£ÓÐ×ã¹»³¤¶È·ÃÎÊcharAt(28)
                return null;
            }
 
            // ½âÎöÐòÁкŠ(λÖÃ8-9)
            result.sequenceNum = HexUtils.fastHexToByte(cleanedMessage[8], cleanedMessage[9]);
 
            // ½âÎö±êÇ©ID (λÖÃ10-13, Ð¡¶ËÐò)
            result.tagId = new String(new char[]{
                    cleanedMessage[12], cleanedMessage[13], // ¸ßλ
                    cleanedMessage[10], cleanedMessage[11]  // µÍλ
            });
 
            // ½âÎöêµãID (λÖÃ14-17, Ð¡¶ËÐò)
            result.anchorId = new String(new char[]{
                    cleanedMessage[16], cleanedMessage[17], // ¸ßλ
                    cleanedMessage[14], cleanedMessage[15]  // µÍλ
            });
 
            // ½âÎö¾àÀë (λÖÃ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 raw = (b3 << 24) | (b2 << 16) | (b1 << 8) | b0;
            result.distance = raw; // ±£³ÖԭʼÕûÊýÖµ
 
            // ½âÎöµçÁ¿ (λÖÃ26-27)
            result.power = HexUtils.fastHexToByte(cleanedMessage[26], cleanedMessage[27]);
 
            // ½âÎö°´Å¥×´Ì¬ (λÖÃ28-29)
            result.buttonPressed = HexUtils.fastHexToByte(cleanedMessage[28], cleanedMessage[29]);
            result.buttonPressed2 =result.buttonPressed==1;            
 
        } catch (IndexOutOfBoundsException | NumberFormatException e) {
            System.err.println("Parsing error in packet from " + ip + ":" + port);
            return null;
        }
 
        return result;
    }
 
    private static char[] cleanMessage(String message) {
        char[] cleaned = new char[message.length()];
        int j = 0;
        for (char c : message.toCharArray()) {
            if (Character.isDigit(c) || (c >= 'A' && c <= 'F') || (c >= 'a' && c <= 'f')) {
                cleaned[j++] = Character.toUpperCase(c);
            }
        }
        if (j == 0) return null;
        return Arrays.copyOf(cleaned, j);
    }
    
}