aboutsummaryrefslogtreecommitdiff
path: root/src/org/traccar/protocol/Arnavi4ProtocolDecoder.java
blob: caa8dd28fa8af591b7efab80b4f25c0d593ce150 (plain)
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
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
package org.traccar.protocol;

import org.jboss.netty.buffer.ChannelBuffer;
import org.jboss.netty.buffer.ChannelBuffers;
import org.jboss.netty.channel.Channel;
import org.traccar.BaseProtocolDecoder;
import org.traccar.DeviceSession;
import org.traccar.model.Position;

import java.net.SocketAddress;
import java.nio.ByteBuffer;
import java.nio.ByteOrder;
import java.util.Date;
import java.util.LinkedList;
import java.util.List;

import static org.traccar.protocol.Arnavi4FrameDecoder.*;

/**
 * Created by Ivan Muratov @binakot on 11.07.2017.
 */
public class Arnavi4ProtocolDecoder extends BaseProtocolDecoder {

    private static final byte RECORD_PING = 0x00;
    private static final byte RECORD_DATA = 0x01;
    private static final byte RECORD_TEXT = 0x03;
    private static final byte RECORD_FILE = 0x04;
    private static final byte RECORD_BINARY = 0x06;

    private static final byte TAG_LATITUDE = 3;
    private static final byte TAG_LONGITUDE = 4;
    private static final byte TAG_COORD_PARAMS = 5;

    public Arnavi4ProtocolDecoder(Arnavi4Protocol protocol) {
        super(protocol);
    }

    private static int modulo256Checksum(byte[] bytes) {
        int sum = 0;
        for (byte b : bytes) {
            sum = (sum + b) & 0xFF;
        }
        return sum;
    }

    private Position decodePosition(DeviceSession deviceSession, ChannelBuffer buf, long timestamp) {

        final Position position = new Position();
        position.setProtocol(getProtocolName());
        position.setDeviceId(deviceSession.getDeviceId());

        position.setTime(new Date(timestamp));

        while (buf.readableBytes() > 0) {
            short tagId = buf.readUnsignedByte();
            int tagValue = buf.readInt();
            switch (tagId) {
                case TAG_LATITUDE:
                    position.setLatitude(Float.intBitsToFloat(tagValue));
                    position.setValid(true);
                    break;

                case TAG_LONGITUDE:
                    position.setLongitude(Float.intBitsToFloat(tagValue));
                    position.setValid(true);
                    break;

                case TAG_COORD_PARAMS:
                    position.setSpeed((tagValue >> 24) * 1.852);
                    position.set(Position.KEY_SATELLITES, (tagValue >> 16 & 0x0F) + (tagValue >> 20 & 0x0F));
                    position.setAltitude((tagValue >> 8 & 0xFF) * 10.0);
                    position.setCourse((tagValue & 0xFF) * 2.0);
                    break;

                default:
                    break; // Skip other tags
            }
        }

        return position;
    }

    @Override
    protected Object decode(
            Channel channel, SocketAddress remoteAddress, Object msg) throws Exception {

        ChannelBuffer buf = (ChannelBuffer) msg;

        byte startSign = buf.readByte();

        if (startSign == HEADER_START_SIGN) {

            byte version = buf.readByte();

            String imei = String.valueOf(buf.readLong());
            DeviceSession deviceSession = getDeviceSession(channel, remoteAddress, imei);

            if (deviceSession != null && channel != null) {

                final ChannelBuffer response;

                if (version == HEADER_VERSION_1) {
                    response = ChannelBuffers.dynamicBuffer(ByteOrder.LITTLE_ENDIAN, 4);
                    response.writeBytes(new byte[]{0x7B, 0x00, 0x00, 0x7D});

                } else if (version == HEADER_VERSION_2) {
                    response = ChannelBuffers.dynamicBuffer(ByteOrder.LITTLE_ENDIAN, 9);
                    response.writeBytes(new byte[]{0x7B, 0x04, 0x00});
                    byte[] timestampBytes = ByteBuffer.allocate(4).putInt((int) (System.currentTimeMillis() / 1000)).array();
                    response.writeByte(modulo256Checksum(timestampBytes));
                    response.writeBytes(timestampBytes);
                    response.writeByte(0x7D);

                } else {
                    throw new IllegalArgumentException("unsupported header version");
                }

                channel.write(response);
            }

            return null;
        }

        DeviceSession deviceSession = getDeviceSession(channel, remoteAddress);
        if (deviceSession == null) {
            return null;
        }

        if (startSign == PACKAGE_START_SIGN) {

            List<Position> positions = new LinkedList<>();

            int parcelNumber = buf.readUnsignedByte();

            byte recordStartSign = buf.readByte();
            while (recordStartSign != PACKAGE_END_SIGN) {
                switch (recordStartSign) {
                    case RECORD_PING:
                    case RECORD_DATA:
                    case RECORD_TEXT:
                    case RECORD_FILE:
                    case RECORD_BINARY: {
                        int length = buf.readUnsignedShort();
                        long timestamp = buf.readUnsignedInt() * 1000;
                        ChannelBuffer recordBuf = buf.readBytes(length);

                        if (recordStartSign == RECORD_DATA) {
                            positions.add(decodePosition(deviceSession, recordBuf, timestamp));
                        }

                        buf.readUnsignedByte(); // crc

                        break;
                    }

                    default:
                        throw new IllegalArgumentException("unsupported record type");
                }

                recordStartSign = buf.readByte();
            }

            if (channel != null) {
                final ChannelBuffer response = ChannelBuffers.dynamicBuffer(ByteOrder.LITTLE_ENDIAN, 4);
                response.writeBytes(new byte[]{0x7B, 0x00, (byte) parcelNumber, 0x7D});
                channel.write(response);
            }

            return positions;
        }

        return null;
    }

}