/* * 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.net.SocketAddress; import java.nio.ByteOrder; import java.nio.charset.Charset; import java.util.LinkedList; import java.util.List; 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.helper.BitUtil; import org.traccar.helper.DateBuilder; import org.traccar.helper.Log; import org.traccar.model.Event; import org.traccar.model.Position; public class NavisProtocolDecoder extends BaseProtocolDecoder { private String prefix; private long deviceUniqueId, serverId; private static final Charset CHARSET = Charset.defaultCharset(); public NavisProtocolDecoder(NavisProtocol protocol) { super(protocol); } // 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 static final class ParseResult { private final long id; private final Position position; private 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(); position.setProtocol(getProtocolName()); position.setDeviceId(getDeviceId()); int format; if (buf.getUnsignedByte(buf.readerIndex()) == 0) { format = buf.readUnsignedShort(); } else { format = buf.readUnsignedByte(); } position.set("format", format); long index = buf.readUnsignedInt(); position.set(Event.KEY_INDEX, index); position.set(Event.KEY_EVENT, buf.readUnsignedShort()); buf.skipBytes(6); // event time position.set(Event.KEY_ALARM, buf.readUnsignedByte()); position.set(Event.KEY_STATUS, buf.readUnsignedByte()); position.set(Event.KEY_GSM, buf.readUnsignedByte()); if (isFormat(format, F10, F20, F30)) { position.set(Event.KEY_OUTPUT, buf.readUnsignedShort()); } else if (isFormat(format, F40, F50, F51, F52)) { position.set(Event.KEY_OUTPUT, buf.readUnsignedByte()); } if (isFormat(format, F10, F20, F30, F40)) { position.set(Event.KEY_INPUT, buf.readUnsignedShort()); } else if (isFormat(format, F50, F51, F52)) { position.set(Event.KEY_INPUT, buf.readUnsignedByte()); } position.set(Event.KEY_POWER, buf.readUnsignedShort() * 0.001); position.set(Event.KEY_BATTERY, buf.readUnsignedShort()); if (isFormat(format, F10, F20, F30)) { position.set(Event.PREFIX_TEMP + 1, buf.readShort()); } if (isFormat(format, F10, F20, F50, F52)) { position.set(Event.PREFIX_ADC + 1, buf.readUnsignedShort()); position.set(Event.PREFIX_ADC + 2, buf.readUnsignedShort()); } // Impulse counters if (isFormat(format, F20, F50, F51, F52)) { buf.readUnsignedInt(); buf.readUnsignedInt(); } if (isFormat(format, F20, F50, F51, F52)) { int locationStatus = buf.readUnsignedByte(); position.setValid(BitUtil.check(locationStatus, 1)); DateBuilder dateBuilder = new DateBuilder() .setTime(buf.readUnsignedByte(), buf.readUnsignedByte(), buf.readUnsignedByte()) .setDateReverse(buf.readUnsignedByte(), buf.readUnsignedByte(), buf.readUnsignedByte()); position.setTime(dateBuilder.getDate()); position.setLatitude(buf.readFloat() / Math.PI * 180); position.setLongitude(buf.readFloat() / Math.PI * 180); position.setSpeed(buf.readFloat()); position.setCourse(buf.readUnsignedShort()); position.set(Event.KEY_ODOMETER, buf.readFloat()); position.set("segment", buf.readFloat()); // last segment // Segment times buf.readUnsignedShort(); buf.readUnsignedShort(); } // Other if (isFormat(format, F51, F52)) { buf.readUnsignedShort(); buf.readByte(); buf.readUnsignedShort(); buf.readUnsignedShort(); buf.readByte(); buf.readUnsignedShort(); buf.readUnsignedShort(); buf.readByte(); buf.readUnsignedShort(); } // Four temperature sensors if (isFormat(format, F40, F52)) { buf.readByte(); buf.readByte(); buf.readByte(); buf.readByte(); } 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, "* positions = new LinkedList<>(); int count = buf.readUnsignedByte(); for (int i = 0; i < count; i++) { Position position = parsePosition(buf).getPosition(); if (position.getFixTime() != null) { positions.add(position); } } ChannelBuffer response = ChannelBuffers.dynamicBuffer(ByteOrder.LITTLE_ENDIAN, 8); response.writeBytes(ChannelBuffers.copiedBuffer(ByteOrder.LITTLE_ENDIAN, "*T": return processSingle(channel, buf); case "*>A": return processArray(channel, buf); case "*>S": return processHandshake(channel, remoteAddress, buf); default: Log.warning(new UnsupportedOperationException(type)); break; } return null; } }