/* * Copyright 2015 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.util.Date; 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.jboss.netty.channel.ChannelHandlerContext; import org.traccar.BaseProtocolDecoder; import org.traccar.model.Event; import org.traccar.model.Position; public class BceProtocolDecoder extends BaseProtocolDecoder { public BceProtocolDecoder(String protocol) { super(protocol); } private static final int DATA_TYPE = 7; private static final int MSG_ASYNC_STACK = 0xA5; private static final int MSG_STACK_COFIRM = 0x19; private static final int MSG_TIME_TRIGGERED = 0xA0; private static final int MSG_OUTPUT_CONTROL = 0x41; private static final int MSG_OUTPUT_CONTROL_ACK = 0xC1; private static boolean checkBit(int mask, int bit) { return (mask & (1 << bit)) != 0; } @Override protected Object decode( ChannelHandlerContext ctx, Channel channel, Object msg) throws Exception { ChannelBuffer buf = (ChannelBuffer) msg; String imei = String.format("%015d", buf.readLong()); if (!identify(imei)) { return null; } List<Position> positions = new LinkedList<Position>(); while (buf.readableBytes() > 1) { int dataEnd = buf.readUnsignedShort() + buf.readerIndex(); int type = buf.readUnsignedByte(); int confirmKey = buf.readUnsignedByte() & 0x7F; while (buf.readerIndex() < dataEnd) { Position position = new Position(); position.setProtocol(getProtocol()); position.setDeviceId(getDeviceId()); int structEnd = buf.readUnsignedByte() + buf.readerIndex(); long time = buf.readUnsignedInt(); if ((time & 0x0f) == DATA_TYPE) { time = time >> 4 << 1; time += 0x47798280; // 01/01/2008 position.setTime(new Date(time * 1000)); // Read masks int mask; List<Integer> masks = new LinkedList<Integer>(); do { mask = buf.readUnsignedShort(); masks.add(mask); } while (checkBit(mask, 15)); mask = masks.get(0); if (checkBit(mask, 0)) { position.setValid(true); position.setLongitude(buf.readFloat()); position.setLatitude(buf.readFloat()); position.setSpeed(buf.readUnsignedByte()); int gps = buf.readUnsignedByte(); position.set(Event.KEY_SATELLITES, gps & 0xf); position.set(Event.KEY_HDOP, gps >> 4); position.setCourse(buf.readUnsignedByte()); position.setAltitude(buf.readUnsignedShort()); position.set(Event.KEY_ODOMETER, buf.readUnsignedInt()); } if (checkBit(mask, 1)) { position.set(Event.KEY_INPUT, buf.readUnsignedShort()); } for (int i = 1; i <= 8; i++) { if (checkBit(mask, i + 1)) { position.set(Event.PREFIX_ADC + i, buf.readUnsignedShort()); } } if (checkBit(mask, 10)) buf.skipBytes(4); if (checkBit(mask, 11)) buf.skipBytes(4); if (checkBit(mask, 12)) buf.skipBytes(2); if (checkBit(mask, 13)) buf.skipBytes(2); if (checkBit(mask, 14)) { position.set(Event.KEY_MCC, buf.readUnsignedShort()); position.set(Event.KEY_MNC, buf.readUnsignedByte()); position.set(Event.KEY_LAC, buf.readUnsignedShort()); position.set(Event.KEY_CELL, buf.readUnsignedShort()); position.set(Event.KEY_GSM, buf.readUnsignedByte()); buf.readUnsignedByte(); } if (checkBit(mask, 0)) { positions.add(position); } } buf.readerIndex(structEnd); } // Send response if (type == MSG_ASYNC_STACK && channel != null) { ChannelBuffer response = ChannelBuffers.buffer(ByteOrder.LITTLE_ENDIAN, 8 + 2 + 2 + 1); response.writeLong(Long.valueOf(imei)); response.writeShort(2); response.writeByte(MSG_STACK_COFIRM); response.writeByte(confirmKey); int checksum = 0; for (int i = 0; i < response.writerIndex(); i++) { checksum += response.getUnsignedByte(i); } response.writeByte(checksum); channel.write(response); } } return positions; } }