From d4f33f724b82154e3dd6f8fb8546cbc37b164ba5 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Mon, 18 Mar 2013 22:47:15 +1300 Subject: Add Cellocator protocol --- .../protocol/CellocatorProtocolDecoder.java | 172 +++++++++++++++++++++ 1 file changed, 172 insertions(+) create mode 100644 src/org/traccar/protocol/CellocatorProtocolDecoder.java (limited to 'src/org/traccar/protocol/CellocatorProtocolDecoder.java') diff --git a/src/org/traccar/protocol/CellocatorProtocolDecoder.java b/src/org/traccar/protocol/CellocatorProtocolDecoder.java new file mode 100644 index 000000000..aabda6f51 --- /dev/null +++ b/src/org/traccar/protocol/CellocatorProtocolDecoder.java @@ -0,0 +1,172 @@ +/* + * Copyright 2013 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.Calendar; +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.ServerManager; +import org.traccar.helper.Log; +import org.traccar.model.Position; + +public class CellocatorProtocolDecoder extends BaseProtocolDecoder { + + public CellocatorProtocolDecoder(ServerManager serverManager) { + super(serverManager); + } + + private String readImei(ChannelBuffer buf) { + int b = buf.readUnsignedByte(); + StringBuilder imei = new StringBuilder(); + imei.append(b & 0x0F); + for (int i = 0; i < 7; i++) { + b = buf.readUnsignedByte(); + imei.append((b & 0xF0) >> 4); + imei.append(b & 0x0F); + } + return imei.toString(); + } + + static final int MSG_CLIENT_STATUS = 0; + static final int MSG_CLIENT_PROGRAMMING = 3; + static final int MSG_CLIENT_SERIAL_LOG = 7; + static final int MSG_CLIENT_SERIAL = 8; + static final int MSG_CLIENT_MODULAR = 9; + + private static final int MSG_SERVER_ACKNOWLEDGE = 4; + + private byte commandCount; + + private void sendReply(Channel channel, long deviceId, byte packetNumber) { + ChannelBuffer reply = ChannelBuffers.directBuffer(ByteOrder.LITTLE_ENDIAN, 28); + reply.writeByte('M'); + reply.writeByte('C'); + reply.writeByte('G'); + reply.writeByte('P'); + reply.writeByte(MSG_SERVER_ACKNOWLEDGE); + reply.writeInt((int) deviceId); + reply.writeByte(commandCount++); + reply.writeInt(0); // authentication code + reply.writeByte(0); + reply.writeByte(packetNumber); + reply.writeZero(10); + + byte checksum = 0; + for (int i = 4; i < 27; i++) { + checksum += reply.getByte(i); + } + reply.writeByte(checksum); + + if (channel != null) { + channel.write(reply); + } + } + + @Override + protected Object decode( + ChannelHandlerContext ctx, Channel channel, Object msg) + throws Exception { + + ChannelBuffer buf = (ChannelBuffer) msg; + + buf.skipBytes(4); // system code + int type = buf.readUnsignedByte(); + long deviceId = buf.readUnsignedInt(); + + if (type != MSG_CLIENT_SERIAL) { + buf.readUnsignedShort(); // communication control + } + byte packetNumber = buf.readByte(); + + // Send reply + sendReply(channel, deviceId, packetNumber); + + // Parse location + if (type == MSG_CLIENT_STATUS) { + Position position = new Position(); + StringBuilder extendedInfo = new StringBuilder("cellocator"); + + // Device identifier + try { + position.setDeviceId(getDataManager().getDeviceByImei(String.valueOf(deviceId)).getId()); + } catch(Exception error) { + Log.warning("Unknown device - " + deviceId); + return null; + } + + buf.readUnsignedByte(); // hardware version + buf.readUnsignedByte(); // software version + buf.readUnsignedByte(); // protocol version + + // Status + extendedInfo.append(""); + extendedInfo.append(buf.getUnsignedByte(buf.readerIndex()) & 0x0f); + extendedInfo.append(""); + + int operator = (buf.readUnsignedByte() & 0xf0) << 4; + operator += buf.readUnsignedByte(); + + buf.readUnsignedByte(); // reason data + buf.readUnsignedByte(); // reason + buf.readUnsignedByte(); // mode + buf.readUnsignedInt(); // IO + + operator <<= 8; + operator += buf.readUnsignedByte(); + extendedInfo.append("").append(operator).append(""); + + buf.readUnsignedInt(); // ADC + buf.readUnsignedMedium(); // milage + buf.skipBytes(6); // multi-purpose data + + buf.readUnsignedShort(); // gps fix + buf.readUnsignedByte(); // location status + buf.readUnsignedByte(); // mode 1 + buf.readUnsignedByte(); // mode 2 + + position.setValid(buf.readUnsignedByte() >= 3); // satellites + + // Location data + position.setLongitude(buf.readInt() / Math.PI * 180 / 100000000); + position.setLatitude(buf.readInt() / Math.PI * 180 / 100000000.0); + position.setAltitude(buf.readInt() * 0.01); + position.setSpeed(buf.readInt() * 0.01 * 1.943844); + position.setCourse(buf.readUnsignedShort() / Math.PI * 180.0 / 1000.0); + + // Time + Calendar time = Calendar.getInstance(TimeZone.getTimeZone("UTC")); + time.clear(); + time.set(Calendar.SECOND, buf.readUnsignedByte()); + time.set(Calendar.MINUTE, buf.readUnsignedByte()); + time.set(Calendar.HOUR, buf.readUnsignedByte()); + time.set(Calendar.DAY_OF_MONTH, buf.readUnsignedByte()); + time.set(Calendar.MONTH, buf.readUnsignedByte() - 1); + time.set(Calendar.YEAR, buf.readUnsignedShort()); + position.setTime(time.getTime()); + + position.setExtendedInfo(extendedInfo.toString()); + return position; + } + + return null; + } + +} -- cgit v1.2.3