From a960f770f1c8d52b2c9f6b63cf947f69d7d7e761 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Sun, 23 Feb 2014 19:55:15 +1300 Subject: Implement STL060 protocol --- default.cfg | 4 + src/org/traccar/ServerManager.java | 14 +++ src/org/traccar/protocol/Stl060FrameDecoder.java | 57 +++++++++ .../traccar/protocol/Stl060ProtocolDecoder.java | 135 +++++++++++++++++++++ .../protocol/Stl060ProtocolDecoderTest.java | 20 +++ 5 files changed, 230 insertions(+) create mode 100644 src/org/traccar/protocol/Stl060FrameDecoder.java create mode 100644 src/org/traccar/protocol/Stl060ProtocolDecoder.java create mode 100644 test/org/traccar/protocol/Stl060ProtocolDecoderTest.java diff --git a/default.cfg b/default.cfg index 383d90609..bb34e0f0d 100644 --- a/default.cfg +++ b/default.cfg @@ -302,4 +302,8 @@ true 5059 + + true + 5060 + diff --git a/src/org/traccar/ServerManager.java b/src/org/traccar/ServerManager.java index 052a79eab..7505561e9 100644 --- a/src/org/traccar/ServerManager.java +++ b/src/org/traccar/ServerManager.java @@ -162,6 +162,7 @@ public class ServerManager { initTaipServer("taip"); initKhdServer("khd"); initPiligrimServer("piligrim"); + initStl060Server("stl060"); // Initialize web server if (Boolean.valueOf(properties.getProperty("http.enable"))) { @@ -1060,4 +1061,17 @@ public class ServerManager { } } + private void initStl060Server(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 Stl060FrameDecoder(1024)); + pipeline.addLast("stringDecoder", new StringDecoder()); + pipeline.addLast("objectDecoder", new Stl060ProtocolDecoder(ServerManager.this)); + } + }); + } + } + } diff --git a/src/org/traccar/protocol/Stl060FrameDecoder.java b/src/org/traccar/protocol/Stl060FrameDecoder.java new file mode 100644 index 000000000..eb0894fb7 --- /dev/null +++ b/src/org/traccar/protocol/Stl060FrameDecoder.java @@ -0,0 +1,57 @@ +/* + * 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.buffer.ChannelBuffers; +import org.jboss.netty.channel.Channel; +import org.jboss.netty.channel.ChannelHandlerContext; +import org.jboss.netty.handler.codec.frame.DelimiterBasedFrameDecoder; +import org.traccar.helper.ChannelBufferTools; + +public class Stl060FrameDecoder extends DelimiterBasedFrameDecoder { + + private static final byte delimiter[] = { (byte) '#' }; + + public Stl060FrameDecoder(int maxFrameLength) { + super(maxFrameLength, ChannelBuffers.wrappedBuffer(delimiter)); + } + + @Override + protected Object decode( + ChannelHandlerContext ctx, + Channel channel, + ChannelBuffer buf) throws Exception { + + ChannelBuffer result = (ChannelBuffer) super.decode(ctx, channel, buf); + + if (result != null) { + + Integer beginIndex = ChannelBufferTools.find( + result, 0, result.readableBytes(), "$"); + if (beginIndex == null) { + return result; + } else { + result.skipBytes(beginIndex); + return result.readBytes(result.readableBytes()); + } + + } + + return null; + } + +} diff --git a/src/org/traccar/protocol/Stl060ProtocolDecoder.java b/src/org/traccar/protocol/Stl060ProtocolDecoder.java new file mode 100644 index 000000000..29bc558da --- /dev/null +++ b/src/org/traccar/protocol/Stl060ProtocolDecoder.java @@ -0,0 +1,135 @@ +/* + * 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 Stl060ProtocolDecoder extends BaseProtocolDecoder { + + public Stl060ProtocolDecoder(ServerManager serverManager) { + super(serverManager); + } + + private static final Pattern pattern = Pattern.compile( + "\\$1," + + "(\\d+)," + // IMEI + "D001," + // Type + "[^,]*," + // Vehicle + "(\\d{2})/(\\d{2})/(\\d{2})," + // Date + "(\\d{2}):(\\d{2}):(\\d{2})," + // Time + "(\\d+)(\\d{2}\\.\\d+)" + // Latitude + "([NS])," + + "(\\d+)(\\d{2}\\.\\d+)" + // Longitude + "([EW])," + + "(\\d+)," + // Speed + "(\\d+)," + // Course + "(\\d+)," + // Milage + "(\\d+)," + // Ignition + "(\\d+)," + // DIP1 + "(\\d+)," + // DIP2 + "(\\d+)," + // Fuel + "([AV])," + // Validity + ".*"); + + @Override + protected Object decode( + ChannelHandlerContext ctx, Channel channel, Object msg) + throws Exception { + + String sentence = (String) msg; + + // Parse message + Matcher parser = pattern.matcher(sentence); + if (!parser.matches()) { + return null; + } + + // Create new position + Position position = new Position(); + ExtendedInfoFormatter extendedInfo = new ExtendedInfoFormatter("stl060"); + + Integer index = 1; + + // Device identification + String imei = parser.group(index++); + try { + position.setDeviceId(getDataManager().getDeviceByImei(imei).getId()); + } catch(Exception error) { + Log.warning("Unknown device - " + imei); + return null; + } + + // Date + Calendar time = Calendar.getInstance(TimeZone.getTimeZone("UTC")); + time.clear(); + 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++))); + + // Time + time.set(Calendar.HOUR, Integer.valueOf(parser.group(index++))); + time.set(Calendar.MINUTE, Integer.valueOf(parser.group(index++))); + time.set(Calendar.SECOND, Integer.valueOf(parser.group(index++))); + position.setTime(time.getTime()); + + // 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); + + // Altitude + position.setAltitude(0.0); + + // Speed + position.setSpeed(Double.valueOf(parser.group(index++))); + + // Course + position.setCourse(Double.valueOf(parser.group(index++))); + + // Other + extendedInfo.set("milage", Integer.valueOf(parser.group(index++))); + extendedInfo.set("ignition", Integer.valueOf(parser.group(index++))); + extendedInfo.set("dip1", Integer.valueOf(parser.group(index++))); + extendedInfo.set("dip2", Integer.valueOf(parser.group(index++))); + extendedInfo.set("fuel", Integer.valueOf(parser.group(index++))); + + // Validity + position.setValid(parser.group(index++).compareTo("A") == 0); + + // Extended info + position.setExtendedInfo(extendedInfo.toString()); + + return position; + } + +} diff --git a/test/org/traccar/protocol/Stl060ProtocolDecoderTest.java b/test/org/traccar/protocol/Stl060ProtocolDecoderTest.java new file mode 100644 index 000000000..536049293 --- /dev/null +++ b/test/org/traccar/protocol/Stl060ProtocolDecoderTest.java @@ -0,0 +1,20 @@ +package org.traccar.protocol; + +import org.traccar.helper.TestDataManager; +import static org.traccar.helper.DecoderVerifier.verify; +import org.junit.Test; + +public class Stl060ProtocolDecoderTest { + + @Test + public void testDecode() throws Exception { + + Stl060ProtocolDecoder decoder = new Stl060ProtocolDecoder(null); + decoder.setDataManager(new TestDataManager()); + + verify(decoder.decode(null, null, + "$1,357804047969310,D001,AP29AW0963,01/01/13,13:24:47,1723.9582N,07834.0945E,00100,010,0,0,0,0,0,A,")); + + } + +} -- cgit v1.2.3