/* * Copyright 2012 Anton Tananaev (anton.tananaev@gmail.com) * * 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 java.nio.ByteOrder; import java.nio.charset.Charset; import java.util.Calendar; import java.util.LinkedList; import java.util.List; import java.util.Properties; import java.util.TimeZone; import org.jboss.netty.buffer.ChannelBuffer; import org.jboss.netty.buffer.ChannelBuffers; import org.jboss.netty.channel.Channel; import org.jboss.netty.channel.ChannelHandlerContext; import org.traccar.BaseProtocolDecoder; import org.traccar.database.DataManager; import org.traccar.helper.Log; import org.traccar.model.ExtendedInfoFormatter; import org.traccar.model.Position; public class NavisProtocolDecoder extends BaseProtocolDecoder { private String prefix; private long deviceId, serverId; private static final Charset charset = Charset.defaultCharset(); private String imei; private Long databaseDeviceId; public NavisProtocolDecoder(DataManager dataManager, String protocol, Properties properties) { super(dataManager, protocol, properties); } // Format types public static final int F10 = 0x01; public static final int F20 = 0x02; public static final int F30 = 0x03; public static final int F40 = 0x04; public static final int F50 = 0x05; public static final int F51 = 0x15; public static final int F52 = 0x25; private static boolean isFormat(int type, int... types) { for (int i : types) { if (type == i) { return true; } } return false; } private class ParseResult { private long id; private Position position; public ParseResult(long id, Position position) { this.id = id; this.position = position; } public long getId() { return id; } public Position getPosition() { return position; } } private ParseResult parsePosition(ChannelBuffer buf) { Position position = new Position(); ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter(getProtocol()); position.setDeviceId(databaseDeviceId); position.setAltitude(0.0); // Format type int format; if (buf.getUnsignedByte(buf.readerIndex()) == 0) { format = buf.readUnsignedShort(); } else { format = buf.readUnsignedByte(); } extendedInfo.set("format", format); long index = buf.readUnsignedInt(); extendedInfo.set("index", index); // Event type extendedInfo.set("event", buf.readUnsignedShort()); // Event time Calendar time = Calendar.getInstance(TimeZone.getTimeZone("UTC")); time.clear(); time.set(Calendar.HOUR_OF_DAY, buf.readUnsignedByte()); time.set(Calendar.MINUTE, buf.readUnsignedByte()); time.set(Calendar.SECOND, buf.readUnsignedByte()); time.set(Calendar.DAY_OF_MONTH, buf.readUnsignedByte()); time.set(Calendar.MONTH, buf.readUnsignedByte()); time.set(Calendar.YEAR, 2000 + buf.readUnsignedByte()); extendedInfo.set("time", time.getTimeInMillis()); // Alarm status extendedInfo.set("alarm", buf.readUnsignedByte()); // Modules status extendedInfo.set("status", buf.readUnsignedByte()); // GSM signal extendedInfo.set("gsm", buf.readUnsignedByte()); // Output if (isFormat(format, F10, F20, F30)) { extendedInfo.set("output", buf.readUnsignedShort()); } else if (isFormat(format, F40, F50, F51, F52)) { extendedInfo.set("output", buf.readUnsignedByte()); } // Input if (isFormat(format, F10, F20, F30, F40)) { extendedInfo.set("input", buf.readUnsignedShort()); } else if (isFormat(format, F50, F51, F52)) { extendedInfo.set("input", buf.readUnsignedByte()); } extendedInfo.set("power", buf.readUnsignedShort() / 1000.0); // Battery power extendedInfo.set("battery", buf.readUnsignedShort()); // Temperature if (isFormat(format, F10, F20, F30)) { extendedInfo.set("temperature", buf.readShort()); } if (isFormat(format, F10, F20, F50, F52)) { extendedInfo.set("adc1", buf.readUnsignedShort()); extendedInfo.set("adc2", buf.readUnsignedShort()); } if (isFormat(format, F20, F50, F51, F52)) { // Impulse counters buf.readUnsignedInt(); buf.readUnsignedInt(); } if (isFormat(format, F20, F50, F51, F52)) { // Validity int locationStatus = buf.readUnsignedByte(); position.setValid((locationStatus & 0x02) == 0x02); // Location time time.clear(); time.set(Calendar.HOUR_OF_DAY, buf.readUnsignedByte()); time.set(Calendar.MINUTE, buf.readUnsignedByte()); time.set(Calendar.SECOND, buf.readUnsignedByte()); time.set(Calendar.DAY_OF_MONTH, buf.readUnsignedByte()); time.set(Calendar.MONTH, buf.readUnsignedByte()); time.set(Calendar.YEAR, 2000 + buf.readUnsignedByte()); position.setTime(time.getTime()); // Location data position.setLatitude(buf.readFloat() / Math.PI * 180); position.setLongitude(buf.readFloat() / Math.PI * 180); position.setSpeed((double) buf.readFloat()); position.setCourse((double) buf.readUnsignedShort()); // Milage extendedInfo.set("milage", buf.readFloat()); // Last segment extendedInfo.set("segment", buf.readFloat()); // Segment times buf.readUnsignedShort(); buf.readUnsignedShort(); } if (isFormat(format, F51, F52)) { // Other stuff buf.readUnsignedShort(); buf.readByte(); buf.readUnsignedShort(); buf.readUnsignedShort(); buf.readByte(); buf.readUnsignedShort(); buf.readUnsignedShort(); buf.readByte(); buf.readUnsignedShort(); } if (isFormat(format, F40, F52)) { // Four temperature sensors buf.readByte(); buf.readByte(); buf.readByte(); buf.readByte(); } // Extended info position.setExtendedInfo(extendedInfo.toString()); return new ParseResult(index, position); } private Object processSingle(Channel channel, ChannelBuffer buf) { ParseResult result = parsePosition(buf); ChannelBuffer response = ChannelBuffers.dynamicBuffer(ByteOrder.LITTLE_ENDIAN, 8); response.writeBytes(ChannelBuffers.copiedBuffer(ByteOrder.LITTLE_ENDIAN, "*<T", charset)); response.writeInt((int) result.getId()); sendReply(channel, response); // No location data if (result.getPosition().getValid() == null) { return null; } return result.getPosition(); } private Object processArray(Channel channel, ChannelBuffer buf) { List<Position> positions = new LinkedList<Position>(); int count = buf.readUnsignedByte(); for (int i = 0; i < count; i++) { Position position = parsePosition(buf).getPosition(); if (position.getValid() != null) { positions.add(position); } } ChannelBuffer response = ChannelBuffers.dynamicBuffer(ByteOrder.LITTLE_ENDIAN, 8); response.writeBytes(ChannelBuffers.copiedBuffer(ByteOrder.LITTLE_ENDIAN, "*<A", charset)); response.writeByte(count); sendReply(channel, response); // No location data if (positions.isEmpty()) { return null; } return positions; } private Object processHandshake(Channel channel, ChannelBuffer buf) { buf.readByte(); // semicolon symbol imei = buf.toString(Charset.defaultCharset()); try { databaseDeviceId = getDataManager().getDeviceByImei(imei).getId(); sendReply(channel, ChannelBuffers.copiedBuffer(ByteOrder.LITTLE_ENDIAN, "*<S", charset)); } catch(Exception error) { Log.warning("Unknown device - " + imei); } return null; } private static short checksum(ChannelBuffer buf) { short sum = 0; for (int i = 0; i < buf.readableBytes(); i++) { sum ^= buf.getUnsignedByte(i); } return sum; } private void sendReply(Channel channel, ChannelBuffer data) { ChannelBuffer header = ChannelBuffers.directBuffer(ByteOrder.LITTLE_ENDIAN, 16); header.writeBytes(ChannelBuffers.copiedBuffer(ByteOrder.LITTLE_ENDIAN, prefix, charset)); header.writeInt((int) deviceId); header.writeInt((int) serverId); header.writeShort(data.readableBytes()); header.writeByte(checksum(data)); header.writeByte(checksum(header)); if (channel != null) { channel.write(ChannelBuffers.copiedBuffer(header, data)); } } @Override protected Object decode( ChannelHandlerContext ctx, Channel channel, Object msg) throws Exception { ChannelBuffer buf = (ChannelBuffer) msg; // Read header prefix = buf.toString(buf.readerIndex(), 4, charset); buf.skipBytes(prefix.length()); // prefix @NTC by default serverId = buf.readUnsignedInt(); deviceId = buf.readUnsignedInt(); int length = buf.readUnsignedShort(); buf.skipBytes(2); // header and data XOR checksum if (length == 0) { return null; // keep alive message } // Read message type String type = buf.toString(buf.readerIndex(), 3, charset); buf.skipBytes(type.length()); if (type.equals("*>T")) { return processSingle(channel, buf); } else if (type.equals("*>A")) { return processArray(channel, buf); } else if (type.equals("*>S")) { return processHandshake(channel, buf); } return null; } }