if (type == MSG_LOGMSG) {
recordCount = buf.readUnsignedShort();
}
for (int j = 0; j < recordCount; j++) {
Position position = new Position();
ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter(getProtocol());
position.setDeviceId(deviceId);
// Message index
if (type == MSG_LOGMSG) {
extendedInfo.set("archive", true);
int subtype = buf.readUnsignedShort();
if (subtype == MSG_ALARM) {
extendedInfo.set("alarm", true);
}
if (buf.readUnsignedShort() > buf.readableBytes()) {
lastIndex += 1;
break; // workaround for device bug
}
lastIndex = buf.readUnsignedInt();
extendedInfo.set("index", lastIndex);
} else {
newIndex = buf.readUnsignedInt();
}
// Time
Calendar time = Calendar.getInstance(TimeZone.getTimeZone("UTC"));
time.clear();
time.setTimeInMillis(buf.readUnsignedInt() * 1000);
position.setTime(time.getTime());
// Latitude
position.setLatitude(((double) buf.readInt()) / 0x7FFFFFFF * 180.0);
// Longitude
position.setLongitude(((double) buf.readInt()) / 0x7FFFFFFF * 180.0);
// Speed
position.setSpeed(((double) buf.readUnsignedInt()) / 100);
// Course
position.setCourse(((double) buf.readUnsignedShort()) / 100);
// Altitude
position.setAltitude(((double) buf.readUnsignedShort()) / 100);
// Satellites
int satellitesNumber = buf.readUnsignedByte();
extendedInfo.set("satellites", satellitesNumber);
// Validity
position.setValid(satellitesNumber >= 3); // TODO: probably wrong
// Cell signal
extendedInfo.set("gsm", buf.readUnsignedByte());
// Milage
extendedInfo.set("milage", buf.readUnsignedInt());
long extraFlags = buf.readLong();
// Analog inputs
if ((extraFlags & 0x1) == 0x1) {
int count = buf.readUnsignedShort();
for (int i = 1; i <= count; i++) {
extendedInfo.set("adc" + i, buf.readUnsignedShort());
}
}
// CAN adapter
if ((extraFlags & 0x2) == 0x2) {
int size = buf.readUnsignedShort();
extendedInfo.set("can", buf.toString(buf.readerIndex(), size, Charset.defaultCharset()));
buf.skipBytes(size);
}
// Passenger sensor
if ((extraFlags & 0x4) == 0x4) {
int size = buf.readUnsignedShort();
// Convert binary data to hex
StringBuilder hex = new StringBuilder();
for (int i = buf.readerIndex(); i < buf.readerIndex() + size; i++) {
byte b = buf.getByte(i);
hex.append(HEX_CHARS.charAt((b & 0xf0) >> 4));
hex.append(HEX_CHARS.charAt((b & 0x0F)));
}
extendedInfo.set("passenger", hex);
buf.skipBytes(size);
}
// Send response for alarm message
if (type == MSG_ALARM) {
byte[] response = {(byte)0xC9,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
channel.write(ChannelBuffers.wrappedBuffer(response));
extendedInfo.set("alarm", true);
}
// Skip CRC
buf.readUnsignedInt();
// Extended info
position.setExtendedInfo(extendedInfo.toString());
positions.add(position);
}
requestArchive(channel);