aboutsummaryrefslogtreecommitdiff
path: root/src/main/java/org/traccar/protocol/RadarProtocolDecoder.java
diff options
context:
space:
mode:
Diffstat (limited to 'src/main/java/org/traccar/protocol/RadarProtocolDecoder.java')
-rw-r--r--src/main/java/org/traccar/protocol/RadarProtocolDecoder.java191
1 files changed, 191 insertions, 0 deletions
diff --git a/src/main/java/org/traccar/protocol/RadarProtocolDecoder.java b/src/main/java/org/traccar/protocol/RadarProtocolDecoder.java
new file mode 100644
index 000000000..765171e9c
--- /dev/null
+++ b/src/main/java/org/traccar/protocol/RadarProtocolDecoder.java
@@ -0,0 +1,191 @@
+/*
+ * Copyright 2019 Anton Tananaev (anton@traccar.org)
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+package org.traccar.protocol;
+
+import io.netty.buffer.ByteBuf;
+import io.netty.channel.Channel;
+import org.traccar.BaseProtocolDecoder;
+import org.traccar.DeviceSession;
+import org.traccar.Protocol;
+import org.traccar.helper.BitUtil;
+import org.traccar.helper.UnitsConverter;
+import org.traccar.model.Position;
+
+import java.net.SocketAddress;
+import java.util.BitSet;
+import java.util.Date;
+import java.util.LinkedList;
+import java.util.List;
+
+public class RadarProtocolDecoder extends BaseProtocolDecoder {
+
+ public RadarProtocolDecoder(Protocol protocol) {
+ super(protocol);
+ }
+
+ public static final int MSG_TRACKING = 0x4C;
+
+ @Override
+ protected Object decode(
+ Channel channel, SocketAddress remoteAddress, Object msg) throws Exception {
+
+ ByteBuf buf = (ByteBuf) msg;
+
+ buf.readUnsignedByte(); // product id
+ buf.readUnsignedByte(); // product version
+
+ String serialNumber = String.valueOf(buf.readUnsignedInt());
+ DeviceSession deviceSession = getDeviceSession(channel, remoteAddress, serialNumber);
+ if (deviceSession == null) {
+ return null;
+ }
+
+ buf.readUnsignedByte(); // index
+ buf.readUnsignedInt(); // timestamp
+ int type = buf.readUnsignedByte();
+ buf.readUnsignedShort(); // length
+
+ if (type == MSG_TRACKING) {
+
+ buf.readUnsignedShort(); // memory count
+ buf.readUnsignedShort(); // memory index
+ int count = buf.readUnsignedShort();
+ buf.readUnsignedShort(); // first index
+
+ List<Position> positions = new LinkedList<>();
+
+ for (int index = 0; index < count; index++) {
+
+ Position position = new Position(getProtocolName());
+
+ position.set(Position.KEY_EVENT, buf.readUnsignedShort());
+
+ int maskLength = buf.readUnsignedByte();
+ BitSet mask = BitSet.valueOf(buf.nioBuffer(buf.readerIndex(), maskLength));
+ buf.skipBytes(maskLength);
+
+ buf.readUnsignedShort(); // length
+
+ if (mask.get(0)) {
+ position.setDeviceTime(new Date(buf.readUnsignedInt() * 1000));
+ }
+ if (mask.get(1)) {
+ position.setFixTime(new Date(buf.readUnsignedInt() * 1000));
+ }
+ if (mask.get(2)) {
+ position.setLatitude(buf.readInt() / 360000.0);
+ }
+ if (mask.get(3)) {
+ position.setLongitude(buf.readInt() / 360000.0);
+ }
+ if (mask.get(4)) {
+ position.setSpeed(UnitsConverter.knotsFromKph(buf.readUnsignedShort()));
+ }
+ if (mask.get(5)) {
+ position.setCourse(buf.readUnsignedShort() * 0.1);
+ }
+ if (mask.get(6)) {
+ position.setAltitude(buf.readShort());
+ }
+ if (mask.get(7)) {
+ int flags = buf.readUnsignedByte();
+ position.setValid(BitUtil.check(flags, 0));
+ position.set(Position.KEY_SATELLITES, BitUtil.from(flags, 4));
+ }
+ if (mask.get(8)) {
+ long flags = buf.readUnsignedInt();
+ position.set(Position.KEY_IGNITION, BitUtil.check(flags, 0));
+ position.set(Position.KEY_CHARGE, BitUtil.check(flags, 1));
+ position.set(Position.KEY_MOTION, BitUtil.check(flags, 2));
+ for (int i = 0; i < 3; i++) {
+ position.set(Position.PREFIX_IN + i, BitUtil.check(flags, 4 + i));
+ }
+ }
+ if (mask.get(9)) {
+ int flags = buf.readUnsignedShort();
+ position.set(Position.KEY_BLOCKED, BitUtil.check(flags, 0));
+ position.set(Position.PREFIX_IN + 0, BitUtil.check(flags, 4));
+ }
+ for (int i = 10; i <= 14; i++) {
+ if (mask.get(i)) {
+ buf.readUnsignedShort(); // reserved
+ }
+ }
+ if (mask.get(15)) {
+ position.set(Position.KEY_ODOMETER, buf.readUnsignedInt() * 100);
+ }
+ if (mask.get(16)) {
+ buf.readUnsignedInt(); // reserved
+ }
+ for (int i = 17; i <= 27; i++) {
+ if (mask.get(i)) {
+ buf.readUnsignedByte(); // reserved
+ }
+ }
+ for (int i = 28; i <= 37; i += 2) {
+ if (mask.get(i)) {
+ buf.skipBytes(12); // reserved
+ }
+ if (mask.get(i + 1)) {
+ buf.readUnsignedByte(); // reserved
+ }
+ }
+ if (mask.get(38)) {
+ buf.skipBytes(6); // driver id
+ }
+ if (mask.get(39)) {
+ buf.readUnsignedShort(); // hardware problems
+ }
+ if (mask.get(40)) {
+ buf.readShort(); // acceleration x
+ }
+ if (mask.get(41)) {
+ buf.readShort(); // acceleration y
+ }
+ if (mask.get(42)) {
+ buf.readShort(); // acceleration z
+ }
+ if (mask.get(43)) {
+ buf.skipBytes(10); // operator
+ }
+ if (mask.get(44)) {
+ buf.readUnsignedShort(); // power
+ }
+ for (int i = 45; i <= 49; i++) {
+ if (mask.get(i)) {
+ buf.readUnsignedByte(); // reserved
+ }
+ }
+ if (mask.get(50)) {
+ buf.readShort(); // tilt
+ }
+
+ if (position.getDeviceTime() != null && position.getFixTime() != null) {
+ positions.add(position);
+ }
+
+ }
+
+ // ACK 0x9C
+
+ return positions.isEmpty() ? null : positions;
+
+ }
+
+ return null;
+ }
+
+}