From 662b552ba75c874ca1f1d67310f7004eb5da1991 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Sat, 11 Apr 2015 09:56:59 +1200 Subject: Add support for CalAmp protocol --- .../traccar/protocol/CalAmpProtocolDecoder.java | 240 +++++++++++++++++++++ 1 file changed, 240 insertions(+) create mode 100644 src/org/traccar/protocol/CalAmpProtocolDecoder.java (limited to 'src/org/traccar/protocol') diff --git a/src/org/traccar/protocol/CalAmpProtocolDecoder.java b/src/org/traccar/protocol/CalAmpProtocolDecoder.java new file mode 100644 index 000000000..7850de1ca --- /dev/null +++ b/src/org/traccar/protocol/CalAmpProtocolDecoder.java @@ -0,0 +1,240 @@ +package org.traccar.protocol; + +import java.net.SocketAddress; +import java.util.Date; +import java.util.Properties; +import org.jboss.netty.buffer.ChannelBuffer; +import org.jboss.netty.buffer.ChannelBuffers; +import org.jboss.netty.channel.Channel; +import org.jboss.netty.channel.ChannelEvent; +import org.jboss.netty.channel.ChannelHandlerContext; +import org.jboss.netty.channel.Channels; +import org.jboss.netty.channel.MessageEvent; +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 CalAmpProtocolDecoder extends BaseProtocolDecoder { + + public CalAmpProtocolDecoder(DataManager dataManager, String protocol, Properties properties) { + super(dataManager, protocol, properties); + } + + private static final int MSG_NULL = 0; + private static final int MSG_ACK = 1; + private static final int MSG_EVENT_REPORT = 2; + private static final int MSG_ID_REPORT = 3; + private static final int MSG_USER_DATA = 4; + private static final int MSG_APP_DATA = 5; + private static final int MSG_CONFIG = 6; + private static final int MSG_UNIT_REQUEST = 7; + private static final int MSG_LOCATE_REPORT = 8; + private static final int MSG_USER_DATA_ACC = 9; + private static final int MSG_MINI_EVENT_REPORT = 10; + private static final int MSG_MINI_USER_DATA = 11; + + private static final int SERVICE_UNACKNOWLEDGED = 0; + private static final int SERVICE_ACKNOWLEDGED = 1; + private static final int SERVICE_RESPONSE = 2; + + @Override + public void handleUpstream( + ChannelHandlerContext ctx, ChannelEvent evt) + throws Exception { + + if (!(evt instanceof MessageEvent)) { + ctx.sendUpstream(evt); + return; + } + + MessageEvent e = (MessageEvent) evt; + Object decodedMessage = decode(ctx, e.getChannel(), e.getMessage(), e.getRemoteAddress()); + if (decodedMessage != null) { + Channels.fireMessageReceived(ctx, decodedMessage, e.getRemoteAddress()); + } + } + + private void sendResponse(Channel channel, SocketAddress remoteAddress, int type, int index, int result) { + if (channel != null) { + ChannelBuffer response = ChannelBuffers.directBuffer(10); + response.writeByte(SERVICE_RESPONSE); + response.writeByte(MSG_ACK); + response.writeShort(index); + response.writeByte(type); + response.writeByte(result); + response.writeByte(0); + response.writeMedium(0); + channel.write(response, remoteAddress); + } + } + + protected Object decode( + ChannelHandlerContext ctx, Channel channel, Object msg, SocketAddress remoteAddress) + throws Exception { + + ChannelBuffer buf = (ChannelBuffer) msg; + + Long deviceId = null; + + // Check options header + if ((buf.getByte(buf.readerIndex()) & 0x80) != 0) { + + int content = buf.readUnsignedByte(); + + // Identifier + if ((content & 0x01) != 0) { + + // Read identifier + int length = buf.readUnsignedByte(); + long id = 0; + for (int i = 0; i < length; i++) { + int b = buf.readUnsignedByte(); + id = id * 10 + (b >> 4); + if ((b & 0xf) != 0xf) { + id = id * 10 + (b & 0xf); + } + } + + // Find device in database + String stringId = String.valueOf(id); + try { + deviceId = getDataManager().getDeviceByImei(stringId).getId(); + } catch(Exception error) { + Log.warning("Unknown device - " + stringId); + } + + } + + // Identifier type + if ((content & 0x02) != 0) { + buf.skipBytes(buf.readUnsignedByte()); + } + + // Authentication + if ((content & 0x04) != 0) { + buf.skipBytes(buf.readUnsignedByte()); + } + + // Routing + if ((content & 0x08) != 0) { + buf.skipBytes(buf.readUnsignedByte()); + } + + // Forwarding + if ((content & 0x10) != 0) { + buf.skipBytes(buf.readUnsignedByte()); + } + + // Responce redirection + if ((content & 0x20) != 0) { + buf.skipBytes(buf.readUnsignedByte()); + } + + } + + // Unidentified device + if (deviceId == null) { + Log.warning("Unknown device"); + return null; + } + + int service = buf.readUnsignedByte(); + int type = buf.readUnsignedByte(); + int index = buf.readUnsignedShort(); + + // Send acknowledgement + if (service == SERVICE_ACKNOWLEDGED) { + sendResponse(channel, remoteAddress, type, index, 0); + } + + if (type == MSG_EVENT_REPORT || + type == MSG_LOCATE_REPORT || + type == MSG_MINI_EVENT_REPORT) { + + // Create new position + Position position = new Position(); + position.setDeviceId(deviceId); + ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter("calamp"); + + // Location data + position.setTime(new Date(buf.readUnsignedInt() * 1000)); + if (type != MSG_MINI_EVENT_REPORT) { + buf.readUnsignedInt(); // fix time + } + position.setLatitude(buf.readInt() * 0.0000001); + position.setLongitude(buf.readInt() * 0.0000001); + if (type != MSG_MINI_EVENT_REPORT) { + position.setAltitude(buf.readInt() * 0.01); + position.setSpeed(buf.readUnsignedInt() * 0.0194384449); // cm/s + } + position.setCourse((double) buf.readShort()); + if (type == MSG_MINI_EVENT_REPORT) { + position.setAltitude(0.0); + position.setSpeed(buf.readUnsignedByte() * 0.539957); // km/h + } + + // Fix status + if (type == MSG_MINI_EVENT_REPORT) { + extendedInfo.set("satellites", buf.getUnsignedByte(buf.readerIndex()) & 0xf); + position.setValid((buf.readUnsignedByte() & 0x20) == 0); + } else { + extendedInfo.set("satellites", buf.readUnsignedByte()); + position.setValid((buf.readUnsignedByte() & 0x08) == 0); + } + + if (type != MSG_MINI_EVENT_REPORT) { + + // Carrier + extendedInfo.set("carrier", buf.readUnsignedShort()); + + // Cell signal + extendedInfo.set("gsm", buf.readShort()); + + } + + // Modem state + extendedInfo.set("modem", buf.readUnsignedByte()); + + // HDOP + if (type != MSG_MINI_EVENT_REPORT) { + extendedInfo.set("hdop", buf.readUnsignedByte()); + } + + // Inputs + extendedInfo.set("input", buf.readUnsignedByte()); + + // Unit status + if (type != MSG_MINI_EVENT_REPORT) { + extendedInfo.set("status", buf.readUnsignedByte()); + } + + // Event code and status + if (type == MSG_EVENT_REPORT || type == MSG_MINI_EVENT_REPORT) { + extendedInfo.set("event", buf.readUnsignedByte()); + } + + // Accumulators + /*int accCount = buf.readUnsignedByte(); + int accType = accCount >> 6; + accCount &= 0x3f; + + if (accType == 1) { + buf.readUnsignedInt(); // threshold + buf.readUnsignedInt(); // mask + } + + for (int i = 0; i < accCount; i++) { + extendedInfo.set("acc" + i, buf.readUnsignedInt()); + }*/ + + position.setExtendedInfo(extendedInfo.toString()); + return position; + + } + + return null; + } + +} -- cgit v1.2.3