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 --- src/org/traccar/protocol/Stl060FrameDecoder.java | 57 +++++++++ .../traccar/protocol/Stl060ProtocolDecoder.java | 135 +++++++++++++++++++++ 2 files changed, 192 insertions(+) create mode 100644 src/org/traccar/protocol/Stl060FrameDecoder.java create mode 100644 src/org/traccar/protocol/Stl060ProtocolDecoder.java (limited to 'src/org/traccar/protocol') 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; + } + +} -- cgit v1.2.3