From 1c668044b7c1ce5b90257cca3cdc21ac0bc6fc90 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Sun, 22 Jun 2014 20:39:49 +1200 Subject: Implement Trackbox protocol --- default.cfg | 4 + src/org/traccar/ServerManager.java | 15 +++ .../traccar/protocol/TrackboxProtocolDecoder.java | 145 +++++++++++++++++++++ .../protocol/TrackboxProtocolDecoderTest.java | 26 ++++ 4 files changed, 190 insertions(+) create mode 100644 src/org/traccar/protocol/TrackboxProtocolDecoder.java create mode 100644 test/org/traccar/protocol/TrackboxProtocolDecoderTest.java diff --git a/default.cfg b/default.cfg index 1b25504a9..d703c9936 100644 --- a/default.cfg +++ b/default.cfg @@ -334,4 +334,8 @@ true 5067 + + true + 5068 + diff --git a/src/org/traccar/ServerManager.java b/src/org/traccar/ServerManager.java index 653d74a73..01f78c515 100644 --- a/src/org/traccar/ServerManager.java +++ b/src/org/traccar/ServerManager.java @@ -171,6 +171,7 @@ public class ServerManager { initBoxServer("box"); initFreedomServer("freedom"); initTelikServer("telik"); + initTrackboxServer("trackbox"); // Initialize web server if (Boolean.valueOf(properties.getProperty("http.enable"))) { @@ -1189,4 +1190,18 @@ public class ServerManager { } } + private void initTrackboxServer(String protocol) throws SQLException { + if (isProtocolEnabled(properties, protocol)) { + serverList.add(new TrackerServer(this, new ServerBootstrap(), protocol) { + @Override + protected void addSpecificHandlers(ChannelPipeline pipeline) { + pipeline.addLast("frameDecoder", new LineBasedFrameDecoder(1024)); + pipeline.addLast("stringDecoder", new StringDecoder()); + pipeline.addLast("stringEncoder", new StringEncoder()); + pipeline.addLast("objectDecoder", new TrackboxProtocolDecoder(ServerManager.this)); + } + }); + } + } + } diff --git a/src/org/traccar/protocol/TrackboxProtocolDecoder.java b/src/org/traccar/protocol/TrackboxProtocolDecoder.java new file mode 100644 index 000000000..865d81e30 --- /dev/null +++ b/src/org/traccar/protocol/TrackboxProtocolDecoder.java @@ -0,0 +1,145 @@ +/* + * 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 java.util.regex.Matcher; +import java.util.regex.Pattern; +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.ExtendedInfoFormatter; +import org.traccar.model.Position; + +public class TrackboxProtocolDecoder extends BaseProtocolDecoder { + + private Long deviceId; + + public TrackboxProtocolDecoder(ServerManager serverManager) { + super(serverManager); + } + + private static final Pattern pattern = Pattern.compile( + "(\\d{2})(\\d{2})(\\d{2})\\.(\\d{3})," + // Time + "(\\d{2})(\\d{2}\\.\\d{4})([NS])," + // Latitude (DDMM.MMMM) + "(\\d{3})(\\d{2}\\.\\d{4})([EW])," + // Longitude (DDDMM.MMMM) + "(\\d+\\.\\d)," + // HDOP + "(-?\\d+\\.?\\d*)," + // Altitude + "(\\d)," + // Fix Type + "(\\d+\\.\\d+)," + // Course + "(\\d+\\.\\d+)," + // Speed (kph) + "(\\d+\\.\\d+)," + // Speed (knots) + "(\\d{2})(\\d{2})(\\d{2})," + // Date + "(\\d+)"); // Satellites + + private void sendResponse(Channel channel) { + if (channel != null) { + channel.write("=OK=\r\n"); + } + } + + @Override + protected Object decode( + ChannelHandlerContext ctx, Channel channel, Object msg) + throws Exception { + + String sentence = (String) msg; + + if (sentence.startsWith("a=connect")) { + String id = sentence.substring(sentence.indexOf("i=") + 2); + try { + deviceId = getDataManager().getDeviceByImei(id).getId(); + sendResponse(channel); + } catch(Exception error) { + Log.warning("Unknown device - " + id); + } + } + + else { + // Parse message + Matcher parser = pattern.matcher(sentence); + if (!parser.matches()) { + return null; + } + sendResponse(channel); + + // Create new position + Position position = new Position(); + position.setDeviceId(deviceId); + ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter("trackbox"); + + Integer index = 1; + + // Time + Calendar time = Calendar.getInstance(TimeZone.getTimeZone("UTC")); + time.clear(); + time.set(Calendar.HOUR_OF_DAY, Integer.valueOf(parser.group(index++))); + time.set(Calendar.MINUTE, Integer.valueOf(parser.group(index++))); + time.set(Calendar.SECOND, Integer.valueOf(parser.group(index++))); + time.set(Calendar.MILLISECOND, Integer.valueOf(parser.group(index++))); + + // Latitude + Double latitude = Double.valueOf(parser.group(index++)); + latitude += Double.valueOf(parser.group(index++)) / 60; + if (parser.group(index++).compareTo("S") == 0) latitude = -latitude; + position.setLatitude(latitude); + + // Longitude + Double longitude = Double.valueOf(parser.group(index++)); + longitude += Double.valueOf(parser.group(index++)) / 60; + if (parser.group(index++).compareTo("W") == 0) longitude = -longitude; + position.setLongitude(longitude); + + // HDOP + extendedInfo.set("hdop", parser.group(index++)); + + // Altitude + position.setAltitude(Double.valueOf(parser.group(index++))); + + // Validity + int fix = Integer.valueOf(parser.group(index++)); + extendedInfo.set("fix", fix); + position.setValid(fix > 0); + + // Course + position.setCourse(Double.valueOf(parser.group(index++))); + + // Speed + index += 1; // speed in kph + position.setSpeed(Double.valueOf(parser.group(index++))); + + // Date + time.set(Calendar.DAY_OF_MONTH, Integer.valueOf(parser.group(index++))); + time.set(Calendar.MONTH, Integer.valueOf(parser.group(index++)) - 1); + time.set(Calendar.YEAR, 2000 + Integer.valueOf(parser.group(index++))); + position.setTime(time.getTime()); + + // Satellites + extendedInfo.set("satellites", parser.group(index++)); + + // Extended info + position.setExtendedInfo(extendedInfo.toString()); + + return position; + } + + return null; + } + +} diff --git a/test/org/traccar/protocol/TrackboxProtocolDecoderTest.java b/test/org/traccar/protocol/TrackboxProtocolDecoderTest.java new file mode 100644 index 000000000..7319bb329 --- /dev/null +++ b/test/org/traccar/protocol/TrackboxProtocolDecoderTest.java @@ -0,0 +1,26 @@ +package org.traccar.protocol; + +import org.traccar.helper.TestDataManager; +import static org.traccar.helper.DecoderVerifier.verify; +import static org.junit.Assert.assertNull; +import org.junit.Test; + +public class TrackboxProtocolDecoderTest { + + @Test + public void testDecode() throws Exception { + + TrackboxProtocolDecoder decoder = new TrackboxProtocolDecoder(null); + decoder.setDataManager(new TestDataManager()); + + assertNull(decoder.decode(null, null, "a=connect&v=11&i=111111111111111")); + + verify(decoder.decode(null, null, + "183457.999,5126.0247N,00002.8686E,5.2,70.4,3,57.63,32.11,17.32,150507,05")); + + verify(decoder.decode(null, null, + "183558.999,5126.3979N,00003.0745E,5.2,70.4,3,57.63,32.11,17.32,150507,05")); + + } + +} -- cgit v1.2.3