/*
* 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.charset.Charset;
import java.util.Calendar;
import java.util.Date;
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.jboss.netty.handler.codec.http.DefaultHttpResponse;
import org.jboss.netty.handler.codec.http.HttpRequest;
import org.jboss.netty.handler.codec.http.HttpResponse;
import org.jboss.netty.handler.codec.http.HttpResponseStatus;
import org.jboss.netty.handler.codec.http.HttpVersion;
import org.traccar.BaseProtocolDecoder;
import org.traccar.database.DataManager;
import org.traccar.helper.ChannelBufferTools;
import org.traccar.helper.Log;
import org.traccar.model.ExtendedInfoFormatter;
import org.traccar.model.Position;
public class Mta6ProtocolDecoder extends BaseProtocolDecoder {
private boolean simple;
public Mta6ProtocolDecoder(DataManager dataManager, String protocol, Properties properties, boolean simple) {
super(dataManager, protocol, properties);
this.simple = simple;
}
private void sendContinue(Channel channel) {
HttpResponse response = new DefaultHttpResponse(
HttpVersion.HTTP_1_1, HttpResponseStatus.CONTINUE);
channel.write(response);
}
private void sendResponse(Channel channel, short packetId, short packetCount) {
HttpResponse response = new DefaultHttpResponse(
HttpVersion.HTTP_1_1, HttpResponseStatus.OK);
ChannelBuffer begin = ChannelBuffers.copiedBuffer("#ACK#", Charset.defaultCharset());
ChannelBuffer end = ChannelBuffers.directBuffer(3);
end.writeByte(packetId);
end.writeByte(packetCount);
end.writeByte(0);
response.setContent(ChannelBuffers.wrappedBuffer(begin, end));
channel.write(response);
}
private static boolean checkBit(long mask, int bit) {
long checkMask = 1 << bit;
return (mask & checkMask) == checkMask;
}
private static class FloatReader {
private int previousFloat;
public float readFloat(ChannelBuffer buf) {
switch (buf.getUnsignedByte(buf.readerIndex()) >> 6)
{
case 0:
previousFloat = buf.readInt() << 2;
break;
case 1:
previousFloat = (previousFloat & 0xffffff00) + ((buf.readUnsignedByte() & 0x3f) << 2);
break;
case 2:
previousFloat = (previousFloat & 0xffff0000) + ((buf.readUnsignedShort() & 0x3fff) << 2);
break;
case 3:
previousFloat = (previousFloat & 0xff000000) + ((buf.readUnsignedMedium() & 0x3fffff) << 2);
break;
}
return Float.intBitsToFloat(previousFloat);
}
}
private static class TimeReader extends FloatReader {
private long weekNumber;
public Date readTime(ChannelBuffer buf) {
long weekTime = (long) (readFloat(buf) * 1000);
if (weekNumber == 0) {
weekNumber = buf.readUnsignedShort();
}
Calendar time = Calendar.getInstance(TimeZone.getTimeZone("UTC"));
time.clear();
time.set(Calendar.YEAR, 1980);
time.set(Calendar.MONTH, 0);
time.set(Calendar.DAY_OF_MONTH, 6);
long offset = time.getTimeInMillis();
return new Date(offset + weekNumber * 7 * 24 * 60 * 60 * 1000 + weekTime);
}
}
private List<Position> parseFormatA(ChannelBuffer buf, long deviceId) {
List<Position> positions = new LinkedList<Position>();
FloatReader latitudeReader = new FloatReader();
FloatReader longitudeReader = new FloatReader();
TimeReader timeReader = new TimeReader();
try {
while (buf.readable()) {
Position position = new Position();
position.setDeviceId(deviceId);
ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter(getProtocol());
short flags = buf.readUnsignedByte();
// Skip events
short event = buf.readUnsignedByte();
if (checkBit(event, 7)) {
if (checkBit(event, 6)) {
buf.skipBytes(8);
} else {
while (checkBit(event, 7)) {
event = buf.readUnsignedByte();
}
}
}
position.setLatitude(latitudeReader.readFloat(buf) / Math.PI * 180);
position.setLongitude(longitudeReader.readFloat(buf) / Math.PI * 180);
position.setTime(timeReader.readTime(buf));
if (checkBit(flags, 0)) {
buf.readUnsignedByte(); // status
}
if (checkBit(flags, 1)) {
position.setAltitude((double) buf.readUnsignedShort());
}
if (checkBit(flags, 2)) {
position.setSpeed((double) (buf.readUnsignedShort() & 0x03ff));
position.setCourse((double) buf.readUnsignedByte());
}
if (checkBit(flags, 3)) {
extendedInfo.set("milage", buf.readUnsignedShort());
}
if (checkBit(flags, 4)) {
extendedInfo.set("fuel1", buf.readUnsignedInt());
extendedInfo.set("fuel2", buf.readUnsignedInt());
extendedInfo.set("hours1", buf.readUnsignedShort());
extendedInfo.set("hours2", buf.readUnsignedShort());
}
if (checkBit(flags, 5)) {
extendedInfo.set("adc1", buf.readUnsignedShort() & 0x03ff);
extendedInfo.set("adc2", buf.readUnsignedShort() & 0x03ff);
extendedInfo.set("adc3", buf.readUnsignedShort() & 0x03ff);
extendedInfo.set("adc4", buf.readUnsignedShort() & 0x03ff);
}
if (checkBit(flags, 6)) {
extendedInfo.set("temperature", buf.readByte());
buf.getUnsignedByte(buf.readerIndex()); // control (>> 4)
extendedInfo.set("sensor", buf.readUnsignedShort() & 0x0fff);
buf.readUnsignedShort(); // old sensor state (& 0x0fff)
}
if (checkBit(flags, 7)) {
extendedInfo.set("battery", buf.getUnsignedByte(buf.readerIndex()) >> 2);
extendedInfo.set("power", buf.readUnsignedShort() & 0x03ff);
buf.readByte(); // microcontroller temperature
extendedInfo.set("gsm", (buf.getUnsignedByte(buf.readerIndex()) >> 4) & 0x07);
int satellites = buf.readUnsignedByte() & 0x0f;
position.setValid(satellites >= 3);
extendedInfo.set("satellites", satellites);
}
position.setExtendedInfo(extendedInfo.toString());
positions.add(position);
}
} catch (IndexOutOfBoundsException error) {
}
return positions;
}
private Position parseFormatA1(ChannelBuffer buf, long deviceId) {
Position position = new Position();
position.setDeviceId(deviceId);
ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter(getProtocol());
short flags = buf.readUnsignedByte();
// Skip events
short event = buf.readUnsignedByte();
if (checkBit(event, 7)) {
if (checkBit(event, 6)) {
buf.skipBytes(8);
} else {
while (checkBit(event, 7)) {
event = buf.readUnsignedByte();
}
}
}
position.setLatitude(new FloatReader().readFloat(buf) / Math.PI * 180);
position.setLongitude(new FloatReader().readFloat(buf) / Math.PI * 180);
position.setTime(new TimeReader().readTime(buf));
buf.readUnsignedByte(); // status
if (checkBit(flags, 0)) {
position.setAltitude((double) buf.readUnsignedShort());
position.setSpeed((double) buf.readUnsignedByte());
position.setCourse((double) buf.readByte());
extendedInfo.set("milage", new FloatReader().readFloat(buf));
}
if (checkBit(flags, 1)) {
new FloatReader().readFloat(buf); // fuel consumtion
extendedInfo.set("hours", new FloatReader().readFloat(buf));
extendedInfo.set("tank", buf.readUnsignedByte() * 0.4);
}
if (checkBit(flags, 2)) {
extendedInfo.set("engine", buf.readUnsignedShort() * 0.125);
extendedInfo.set("pedals", buf.readUnsignedByte());
extendedInfo.set("temperature", buf.readUnsignedByte() - 40);
buf.readUnsignedShort(); // service milage
}
if (checkBit(flags, 3)) {
extendedInfo.set("fuel", buf.readUnsignedShort());
extendedInfo.set("adc2", buf.readUnsignedShort());
extendedInfo.set("adc3", buf.readUnsignedShort());
extendedInfo.set("adc4", buf.readUnsignedShort());
}
if (checkBit(flags, 4)) {
extendedInfo.set("temperature", buf.readByte());
buf.getUnsignedByte(buf.readerIndex()); // control (>> 4)
extendedInfo.set("sensor", buf.readUnsignedShort() & 0x0fff);
buf.readUnsignedShort(); // old sensor state (& 0x0fff)
}
if (checkBit(flags, 5)) {
extendedInfo.set("battery", buf.getUnsignedByte(buf.readerIndex()) >> 2);
extendedInfo.set("power", buf.readUnsignedShort() & 0x03ff);
buf.readByte(); // microcontroller temperature
extendedInfo.set("gsm", buf.getUnsignedByte(buf.readerIndex()) >> 5);
int satellites = buf.readUnsignedByte() & 0x1f;
position.setValid(satellites >= 3);
extendedInfo.set("satellites", satellites);
}
// TODO: process other data
position.setExtendedInfo(extendedInfo.toString());
return position;
}
@Override
protected Object decode(
ChannelHandlerContext ctx, Channel channel, Object msg)
throws Exception {
HttpRequest request = (HttpRequest) msg;
ChannelBuffer buf = request.getContent();
int length = buf.readableBytes();
// Read identifier
buf.skipBytes("id=".length());
int index = ChannelBufferTools.find(buf, buf.readerIndex(), length, "&");
String uniqueId = buf.toString(buf.readerIndex(), index - buf.readerIndex(), Charset.defaultCharset());
long deviceId;
try {
deviceId = getDataManager().getDeviceByImei(uniqueId).getId();
} catch(Exception error) {
Log.warning("Unknown device - " + uniqueId);
return null;
}
buf.skipBytes(uniqueId.length());
buf.skipBytes("&bin=".length());
// Read header
short packetId = buf.readUnsignedByte();
short offset = buf.readUnsignedByte(); // dataOffset
short packetCount = buf.readUnsignedByte();
buf.readUnsignedByte(); // reserved
short parameters = buf.readUnsignedByte(); // TODO: handle timezone
buf.skipBytes(offset - 5);
// Send response
if (channel != null) {
sendContinue(channel);
sendResponse(channel, packetId, packetCount);
}
// Parse data
if (packetId == 0x31 || packetId == 0x32 || packetId == 0x36) {
if (simple) {
return parseFormatA1(buf, deviceId);
} else {
return parseFormatA(buf, deviceId);
}
} //else if (0x34 0x38 0x4F 0x59)
return null;
}
}