/* * 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 (mask.get(51)) { buf.readUnsignedInt(); // partial hours } if (mask.get(52)) { buf.readUnsignedInt(); // accumulated hours } if (position.getDeviceTime() != null && position.getFixTime() != null) { positions.add(position); } } // ACK 0x9C return positions.isEmpty() ? null : positions; } return null; } }