mirror of
https://github.com/traccar/traccar.git
synced 2025-01-09 04:07:38 +08:00
Start Orion implementation
This commit is contained in:
Anton Tananaev
parent
6522fd1027
commit
2ba8c52185
@ -342,4 +342,8 @@
|
||||
<entry key='visiontek.enable'>true</entry>
|
||||
<entry key='visiontek.port'>5069</entry>
|
||||
|
||||
<!-- Orion server configuration -->
|
||||
<entry key='orion.enable'>true</entry>
|
||||
<entry key='orion.port'>5070</entry>
|
||||
|
||||
</properties>
|
||||
|
||||
@ -173,6 +173,7 @@ public class ServerManager {
|
||||
initTelikServer("telik");
|
||||
initTrackboxServer("trackbox");
|
||||
initVisiontekServer("visiontek");
|
||||
initOrionServer("orion");
|
||||
|
||||
// Initialize web server
|
||||
if (Boolean.valueOf(properties.getProperty("http.enable"))) {
|
||||
@ -1220,4 +1221,18 @@ public class ServerManager {
|
||||
}
|
||||
}
|
||||
|
||||
private void initOrionServer(String protocol) throws SQLException {
|
||||
if (isProtocolEnabled(properties, protocol)) {
|
||||
TrackerServer server = new TrackerServer(this, new ConnectionlessBootstrap(), protocol) {
|
||||
@Override
|
||||
protected void addSpecificHandlers(ChannelPipeline pipeline) {
|
||||
pipeline.addLast("frameDecoder", new OrionFrameDecoder());
|
||||
pipeline.addLast("objectDecoder", new OrionProtocolDecoder(ServerManager.this));
|
||||
}
|
||||
};
|
||||
server.setEndianness(ByteOrder.LITTLE_ENDIAN);
|
||||
serverList.add(server);
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
52
src/org/traccar/protocol/OrionFrameDecoder.java
Normal file
52
src/org/traccar/protocol/OrionFrameDecoder.java
Normal file
@ -0,0 +1,52 @@
|
||||
/*
|
||||
* Copyright 2014 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 org.jboss.netty.buffer.ChannelBuffer;
|
||||
import org.jboss.netty.channel.Channel;
|
||||
import org.jboss.netty.channel.ChannelHandlerContext;
|
||||
import org.jboss.netty.handler.codec.frame.FrameDecoder;
|
||||
|
||||
public class OrionFrameDecoder extends FrameDecoder {
|
||||
|
||||
@Override
|
||||
protected Object decode(
|
||||
ChannelHandlerContext ctx,
|
||||
Channel channel,
|
||||
ChannelBuffer buf) throws Exception {
|
||||
|
||||
// Check minimum length
|
||||
if (buf.readableBytes() < 5) {
|
||||
return null;
|
||||
}
|
||||
|
||||
int length = 2 + 2; // head and tail
|
||||
|
||||
if (buf.getByte(buf.readerIndex()) == 0x78) {
|
||||
length += 1 + buf.getByte(buf.readerIndex() + 2);
|
||||
} else {
|
||||
length += 2 + buf.getShort(buf.readerIndex() + 2);
|
||||
}
|
||||
|
||||
// Check length and return buffer
|
||||
if (buf.readableBytes() >= length) {
|
||||
return buf.readBytes(length);
|
||||
}
|
||||
|
||||
return null;
|
||||
}
|
||||
|
||||
}
|
||||
225
src/org/traccar/protocol/OrionProtocolDecoder.java
Normal file
225
src/org/traccar/protocol/OrionProtocolDecoder.java
Normal file
@ -0,0 +1,225 @@
|
||||
/*
|
||||
* Copyright 2014 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.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.Crc;
|
||||
import org.traccar.helper.Log;
|
||||
import org.traccar.model.ExtendedInfoFormatter;
|
||||
import org.traccar.model.Position;
|
||||
|
||||
public class OrionProtocolDecoder extends BaseProtocolDecoder {
|
||||
|
||||
private Long deviceId;
|
||||
private final TimeZone timeZone = TimeZone.getTimeZone("UTC");
|
||||
|
||||
public OrionProtocolDecoder(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();
|
||||
}
|
||||
|
||||
private static final int MSG_LOGIN = 0x01;
|
||||
private static final int MSG_GPS = 0x10;
|
||||
private static final int MSG_LBS = 0x11;
|
||||
private static final int MSG_GPS_LBS = 0x12;
|
||||
private static final int MSG_STATUS = 0x13;
|
||||
private static final int MSG_SATELLITE = 0x14;
|
||||
private static final int MSG_STRING = 0x15;
|
||||
private static final int MSG_GPS_LBS_STATUS = 0x16;
|
||||
private static final int MSG_LBS_PHONE = 0x17;
|
||||
private static final int MSG_LBS_EXTEND = 0x18;
|
||||
private static final int MSG_LBS_STATUS = 0x19;
|
||||
private static final int MSG_GPS_PHONE = 0x1A;
|
||||
private static final int MSG_GPS_LBS_EXTEND = 0x1E;
|
||||
|
||||
private static void sendResponse(Channel channel, int type, int index) {
|
||||
if (channel != null) {
|
||||
ChannelBuffer response = ChannelBuffers.directBuffer(10);
|
||||
response.writeByte(0x78); response.writeByte(0x78); // header
|
||||
response.writeByte(0x05); // size
|
||||
response.writeByte(type);
|
||||
response.writeShort(index);
|
||||
response.writeShort(Crc.crc16Ccitt(response.toByteBuffer(2, 4)));
|
||||
response.writeByte(0x0D); response.writeByte(0x0A); // ending
|
||||
channel.write(response);
|
||||
}
|
||||
}
|
||||
|
||||
@Override
|
||||
protected Object decode(
|
||||
ChannelHandlerContext ctx, Channel channel, Object msg)
|
||||
throws Exception {
|
||||
|
||||
ChannelBuffer buf = (ChannelBuffer) msg;
|
||||
|
||||
// Check header
|
||||
if (buf.readByte() != 0x78 || buf.readByte() != 0x78) {
|
||||
return null;
|
||||
}
|
||||
|
||||
int length = buf.readByte(); // size
|
||||
int dataLength = length - 5;
|
||||
|
||||
int type = buf.readUnsignedByte();
|
||||
|
||||
if (type == MSG_LOGIN) {
|
||||
|
||||
String imei = readImei(buf);
|
||||
buf.readUnsignedShort(); // type
|
||||
|
||||
// Timezone offset
|
||||
if (dataLength > 10) {
|
||||
int extensionBits = buf.readUnsignedShort();
|
||||
int offset = (extensionBits >> 4) * 36000;
|
||||
if ((extensionBits & 0x8) != 0) {
|
||||
offset = -offset;
|
||||
}
|
||||
timeZone.setRawOffset(offset);
|
||||
}
|
||||
|
||||
try {
|
||||
deviceId = getDataManager().getDeviceByImei(imei).getId();
|
||||
buf.skipBytes(dataLength - 8);
|
||||
sendResponse(channel, type, buf.readUnsignedShort());
|
||||
} catch(Exception error) {
|
||||
Log.warning("Unknown device - " + imei);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
else if (deviceId != null && (
|
||||
type == MSG_GPS ||
|
||||
type == MSG_GPS_LBS ||
|
||||
type == MSG_GPS_LBS_STATUS ||
|
||||
type == MSG_GPS_PHONE ||
|
||||
type == MSG_GPS_LBS_EXTEND)) {
|
||||
|
||||
// Create new position
|
||||
Position position = new Position();
|
||||
position.setDeviceId(deviceId);
|
||||
ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter("gt06");
|
||||
|
||||
// Date and time
|
||||
Calendar time = Calendar.getInstance(timeZone);
|
||||
time.clear();
|
||||
time.set(Calendar.YEAR, 2000 + buf.readUnsignedByte());
|
||||
time.set(Calendar.MONTH, buf.readUnsignedByte() - 1);
|
||||
time.set(Calendar.DAY_OF_MONTH, buf.readUnsignedByte());
|
||||
time.set(Calendar.HOUR_OF_DAY, buf.readUnsignedByte());
|
||||
time.set(Calendar.MINUTE, buf.readUnsignedByte());
|
||||
time.set(Calendar.SECOND, buf.readUnsignedByte());
|
||||
position.setTime(time.getTime());
|
||||
|
||||
// GPS length and Satellites count
|
||||
int gpsLength = buf.readUnsignedByte();
|
||||
extendedInfo.set("satellites", gpsLength & 0xf);
|
||||
gpsLength >>= 4;
|
||||
|
||||
// Latitude
|
||||
double latitude = buf.readUnsignedInt() / (60.0 * 30000.0);
|
||||
|
||||
// Longitude
|
||||
double longitude = buf.readUnsignedInt() / (60.0 * 30000.0);
|
||||
|
||||
// Speed
|
||||
position.setSpeed(buf.readUnsignedByte() * 0.539957);
|
||||
|
||||
// Course and flags
|
||||
int union = buf.readUnsignedShort();
|
||||
position.setCourse((double) (union & 0x03FF));
|
||||
position.setValid((union & 0x1000) != 0);
|
||||
if ((union & 0x0400) == 0) latitude = -latitude;
|
||||
if ((union & 0x0800) != 0) longitude = -longitude;
|
||||
|
||||
position.setLatitude(latitude);
|
||||
position.setLongitude(longitude);
|
||||
position.setAltitude(0.0);
|
||||
|
||||
if ((union & 0x4000) != 0) {
|
||||
extendedInfo.set("acc", (union & 0x8000) != 0);
|
||||
}
|
||||
|
||||
buf.skipBytes(gpsLength - 12); // skip reserved
|
||||
|
||||
if (type == MSG_GPS_LBS || type == MSG_GPS_LBS_STATUS) {
|
||||
|
||||
int lbsLength = 0;
|
||||
if (type == MSG_GPS_LBS_STATUS) {
|
||||
lbsLength = buf.readUnsignedByte();
|
||||
}
|
||||
|
||||
// Cell information
|
||||
extendedInfo.set("mcc", buf.readUnsignedShort());
|
||||
extendedInfo.set("mnc", buf.readUnsignedByte());
|
||||
extendedInfo.set("lac", buf.readUnsignedShort());
|
||||
extendedInfo.set("cell", buf.readUnsignedShort() << 8 + buf.readUnsignedByte());
|
||||
buf.skipBytes(lbsLength - 9);
|
||||
|
||||
// Status
|
||||
if (type == MSG_GPS_LBS_STATUS) {
|
||||
extendedInfo.set("alarm", true);
|
||||
|
||||
int flags = buf.readUnsignedByte();
|
||||
extendedInfo.set("acc", (flags & 0x2) != 0);
|
||||
// TODO parse other flags
|
||||
|
||||
// Voltage
|
||||
extendedInfo.set("power", buf.readUnsignedByte());
|
||||
|
||||
// GSM signal
|
||||
extendedInfo.set("gsm", buf.readUnsignedByte());
|
||||
}
|
||||
}
|
||||
|
||||
// Index
|
||||
if (buf.readableBytes() > 6) {
|
||||
buf.skipBytes(buf.readableBytes() - 6);
|
||||
}
|
||||
int index = buf.readUnsignedShort();
|
||||
extendedInfo.set("index", index);
|
||||
sendResponse(channel, type, index);
|
||||
|
||||
position.setExtendedInfo(extendedInfo.toString());
|
||||
return position;
|
||||
}
|
||||
|
||||
else {
|
||||
buf.skipBytes(dataLength);
|
||||
sendResponse(channel, type, buf.readUnsignedShort());
|
||||
}
|
||||
|
||||
return null;
|
||||
}
|
||||
|
||||
}
|
||||
30
test/org/traccar/protocol/OrionProtocolDecoderTest.java
Normal file
30
test/org/traccar/protocol/OrionProtocolDecoderTest.java
Normal file
@ -0,0 +1,30 @@
|
||||
package org.traccar.protocol;
|
||||
|
||||
import org.traccar.helper.TestDataManager;
|
||||
import java.nio.ByteOrder;
|
||||
import org.jboss.netty.buffer.ChannelBuffers;
|
||||
import static org.junit.Assert.assertNull;
|
||||
import org.junit.Test;
|
||||
import org.traccar.helper.ChannelBufferTools;
|
||||
import static org.traccar.helper.DecoderVerifier.verify;
|
||||
|
||||
public class OrionProtocolDecoderTest {
|
||||
|
||||
@Test
|
||||
public void testDecode() throws Exception {
|
||||
|
||||
OrionProtocolDecoder decoder = new OrionProtocolDecoder(null);
|
||||
decoder.setDataManager(new TestDataManager());
|
||||
/*
|
||||
verify(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ByteOrder.LITTLE_ENDIAN, ChannelBufferTools.convertArray(
|
||||
new int[] {0x50,0x57,0x00,0x41,0x07,0x36,0x7C,0x24,0x2B,0x44,0x09,0x01,0xAD,0xE9,0x7D,0x01,0x63,0x14,0x3B,0x07,0xB0,0x03,0x00,0x00,0x00,0x00,0x0D,0x04,0x19,0x17,0x38,0x2D,0x00,0x0B,0x01,0x01,0x00,0x05,0x11,0x00,0x00,0x00,0x00,0x06,0x82,0x05,0x00,0x00,0x00,0x8E,0x08,0x00,0x00,0x00,0x00,0x00,0x00,0x8C,0x03,0x00,0x84,0x03,0x00,0x85,0x03,0x00,0x09,0x0A,0x00,0x00,0x00,0x00,0x48,0x01,0x00,0x00,0x00,0x8A,0xFC}))));
|
||||
|
||||
verify(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ByteOrder.LITTLE_ENDIAN, ChannelBufferTools.convertArray(
|
||||
new int[] {0x50,0x57,0x00,0x41,0x07,0x36,0x7C,0x24,0x2C,0x44,0x09,0x01,0xAD,0xE9,0x7D,0x01,0x63,0x14,0x3B,0x07,0xB0,0x03,0x00,0x00,0x00,0x00,0x0D,0x04,0x19,0x17,0x38,0x2D,0x00,0x0B,0x01,0x01,0x00,0x05,0x13,0x00,0x00,0x00,0x00,0x06,0x82,0x05,0x00,0x00,0x00,0x8E,0x08,0x00,0x00,0x00,0x00,0x00,0x00,0x8C,0x03,0x00,0x84,0x03,0x00,0x85,0x03,0x00,0x09,0x0A,0x00,0x00,0x00,0x00,0x3B,0xFE,0xFF,0xFF,0x01,0xFA,0xE5}))));
|
||||
|
||||
verify(decoder.decode(null, null, ChannelBuffers.wrappedBuffer(ByteOrder.LITTLE_ENDIAN, ChannelBufferTools.convertArray(
|
||||
new int[] {0x50,0x57,0x00,0x41,0x07,0x36,0x7C,0x24,0x2D,0x44,0x09,0x01,0xAD,0xE9,0x7D,0x01,0x63,0x14,0x3B,0x07,0xB0,0x03,0x00,0x00,0x00,0x00,0x0D,0x04,0x19,0x17,0x38,0x2D,0x00,0x0B,0x01,0x01,0x00,0x05,0x14,0x00,0x00,0x00,0x00,0x06,0x82,0x05,0x00,0x00,0x00,0x8E,0x08,0x00,0x00,0x00,0x00,0x00,0x00,0x8C,0x03,0x00,0x84,0x03,0x00,0x85,0x03,0x00,0x09,0x0A,0x00,0x00,0x00,0x00,0xFD,0xFD,0xFF,0xFF,0x02,0x37,0x21}))));
|
||||
*/
|
||||
}
|
||||
|
||||
}
|
||||
Loading…
Reference in New Issue
Block a user