From d492aeec2ab8ba53725d91e99140dc2774f7e3f1 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Sun, 11 Apr 2021 12:31:58 -0700 Subject: Implement GS100 protocol --- setup/default.xml | 1 + .../java/org/traccar/protocol/Gs100Protocol.java | 33 +++++ .../org/traccar/protocol/Gs100ProtocolDecoder.java | 133 +++++++++++++++++++++ .../traccar/protocol/Gs100ProtocolDecoderTest.java | 21 ++++ 4 files changed, 188 insertions(+) create mode 100644 src/main/java/org/traccar/protocol/Gs100Protocol.java create mode 100644 src/main/java/org/traccar/protocol/Gs100ProtocolDecoder.java create mode 100644 src/test/java/org/traccar/protocol/Gs100ProtocolDecoderTest.java diff --git a/setup/default.xml b/setup/default.xml index 36b01f867..8206e9973 100644 --- a/setup/default.xml +++ b/setup/default.xml @@ -287,5 +287,6 @@ 5220 5221 5222 + 5223 diff --git a/src/main/java/org/traccar/protocol/Gs100Protocol.java b/src/main/java/org/traccar/protocol/Gs100Protocol.java new file mode 100644 index 000000000..a701815d0 --- /dev/null +++ b/src/main/java/org/traccar/protocol/Gs100Protocol.java @@ -0,0 +1,33 @@ +/* + * Copyright 2021 Anton Tananaev (anton@traccar.org) + * + * 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.traccar.BaseProtocol; +import org.traccar.PipelineBuilder; +import org.traccar.TrackerServer; + +public class Gs100Protocol extends BaseProtocol { + + public Gs100Protocol() { + addServer(new TrackerServer(false, getName()) { + @Override + protected void addProtocolHandlers(PipelineBuilder pipeline) { + pipeline.addLast(new Gs100ProtocolDecoder(Gs100Protocol.this)); + } + }); + } + +} diff --git a/src/main/java/org/traccar/protocol/Gs100ProtocolDecoder.java b/src/main/java/org/traccar/protocol/Gs100ProtocolDecoder.java new file mode 100644 index 000000000..d55773785 --- /dev/null +++ b/src/main/java/org/traccar/protocol/Gs100ProtocolDecoder.java @@ -0,0 +1,133 @@ +/* + * Copyright 2021 Anton Tananaev (anton@traccar.org) + * + * 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 io.netty.buffer.ByteBuf; +import io.netty.buffer.ByteBufUtil; +import io.netty.buffer.Unpooled; +import io.netty.channel.Channel; +import org.traccar.BaseProtocolDecoder; +import org.traccar.DeviceSession; +import org.traccar.NetworkMessage; +import org.traccar.Protocol; +import org.traccar.helper.BcdUtil; +import org.traccar.helper.BitUtil; +import org.traccar.helper.DateBuilder; +import org.traccar.model.Position; + +import java.net.SocketAddress; +import java.nio.charset.StandardCharsets; +import java.util.LinkedList; +import java.util.List; + +public class Gs100ProtocolDecoder extends BaseProtocolDecoder { + + public Gs100ProtocolDecoder(Protocol protocol) { + super(protocol); + } + + @Override + protected Object decode( + Channel channel, SocketAddress remoteAddress, Object msg) throws Exception { + + ByteBuf buf = (ByteBuf) msg; + + String header = buf.readCharSequence(2, StandardCharsets.US_ASCII).toString(); + + if (header.equals("GL")) { + + buf.skipBytes(1); + String imei = buf.readCharSequence(buf.readUnsignedByte(), StandardCharsets.US_ASCII).toString(); + DeviceSession deviceSession = getDeviceSession(channel, remoteAddress, imei); + + if (channel != null && deviceSession != null) { + ByteBuf response = Unpooled.copiedBuffer("GS100", StandardCharsets.US_ASCII); + channel.writeAndFlush(new NetworkMessage(response, remoteAddress)); + } + + return null; + + } else { + + DeviceSession deviceSession = getDeviceSession(channel, remoteAddress); + if (deviceSession == null) { + return null; + } + + List positions = new LinkedList<>(); + + int count = buf.readUnsignedByte(); + for (int i = 0; i < count; i++) { + + int endIndex = buf.readUnsignedByte() + buf.readerIndex(); + + Position position = new Position(getProtocolName()); + position.setDeviceId(deviceSession.getDeviceId()); + + int status = buf.readUnsignedMedium(); + position.set(Position.KEY_STATUS, status); + + if (BitUtil.check(status, 8 + 8 + 7)) { + + DateBuilder dateBuilder = new DateBuilder() + .setHour(BcdUtil.readInteger(buf, 2)) + .setMinute(BcdUtil.readInteger(buf, 2)) + .setSecond(BcdUtil.readInteger(buf, 2)) + .setDay(BcdUtil.readInteger(buf, 2)) + .setMonth(BcdUtil.readInteger(buf, 2)) + .setYear(BcdUtil.readInteger(buf, 2)); + position.setTime(dateBuilder.getDate()); + + position.setValid(true); + + String coordinates = ByteBufUtil.hexDump(buf.readSlice(9)); + position.setLongitude(Integer.parseInt(coordinates.substring(0, 3)) + + Integer.parseInt(coordinates.substring(3, 9)) * 0.0001 / 60); + position.setLatitude(Integer.parseInt(coordinates.substring(10, 12)) + + Integer.parseInt(coordinates.substring(12, 18)) * 0.0001 / 60); + int flags = Integer.parseInt(coordinates.substring(9, 10), 16); + if (!BitUtil.check(flags, 4)) { + position.setLongitude(-position.getLongitude()); + } + if (!BitUtil.check(flags, 3)) { + position.setLatitude(-position.getLatitude()); + } + + String other = ByteBufUtil.hexDump(buf.readSlice(4)); + position.setSpeed(Integer.parseInt(other.substring(0, 5))); + position.setCourse(Integer.parseInt(other.substring(5, 8))); + + } + + positions.add(position); + + buf.readerIndex(endIndex); + + } + + if (channel != null) { + ByteBuf response = Unpooled.buffer(); + response.writeCharSequence("GS100", StandardCharsets.US_ASCII); + response.writeByte(count); + channel.writeAndFlush(new NetworkMessage(response, remoteAddress)); + } + + return positions.isEmpty() ? null : positions; + + } + } + +} diff --git a/src/test/java/org/traccar/protocol/Gs100ProtocolDecoderTest.java b/src/test/java/org/traccar/protocol/Gs100ProtocolDecoderTest.java new file mode 100644 index 000000000..91bbf386c --- /dev/null +++ b/src/test/java/org/traccar/protocol/Gs100ProtocolDecoderTest.java @@ -0,0 +1,21 @@ +package org.traccar.protocol; + +import org.junit.Test; +import org.traccar.ProtocolTest; + +public class Gs100ProtocolDecoderTest extends ProtocolTest { + + @Test + public void testDecode() throws Exception { + + var decoder = new Gs100ProtocolDecoder(null); + + verifyNull(decoder, binary( + "474C490F383632343632303332353036373030133839333831303131363039313838343837323546084657312E302E3236")); + + verifyPositions(decoder, binary( + "47440216900000064113030417020236402C452286650051929716900000064115030417020236408C4522866800379020")); + + } + +} -- cgit v1.2.3