From e8ef6067bafeb051aac6272a457d269684c4b8f3 Mon Sep 17 00:00:00 2001 From: Anton Tananaev Date: Thu, 27 May 2021 22:20:53 -0700 Subject: Implement ThinkPower protocol --- setup/default.xml | 1 + .../org/traccar/protocol/ThinkPowerProtocol.java | 35 ++++ .../protocol/ThinkPowerProtocolDecoder.java | 182 +++++++++++++++++++++ .../protocol/ThinkPowerProtocolDecoderTest.java | 27 +++ 4 files changed, 245 insertions(+) create mode 100644 src/main/java/org/traccar/protocol/ThinkPowerProtocol.java create mode 100644 src/main/java/org/traccar/protocol/ThinkPowerProtocolDecoder.java create mode 100644 src/test/java/org/traccar/protocol/ThinkPowerProtocolDecoderTest.java diff --git a/setup/default.xml b/setup/default.xml index 67a1a9f12..0564182c7 100644 --- a/setup/default.xml +++ b/setup/default.xml @@ -292,5 +292,6 @@ 5225 5226 5227 + 5228 diff --git a/src/main/java/org/traccar/protocol/ThinkPowerProtocol.java b/src/main/java/org/traccar/protocol/ThinkPowerProtocol.java new file mode 100644 index 000000000..ece1b0544 --- /dev/null +++ b/src/main/java/org/traccar/protocol/ThinkPowerProtocol.java @@ -0,0 +1,35 @@ +/* + * 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.handler.codec.LengthFieldBasedFrameDecoder; +import org.traccar.BaseProtocol; +import org.traccar.PipelineBuilder; +import org.traccar.TrackerServer; + +public class ThinkPowerProtocol extends BaseProtocol { + + public ThinkPowerProtocol() { + addServer(new TrackerServer(false, getName()) { + @Override + protected void addProtocolHandlers(PipelineBuilder pipeline) { + pipeline.addLast(new LengthFieldBasedFrameDecoder(1024, 2, 2, 2, 0)); + pipeline.addLast(new ThinkPowerProtocolDecoder(ThinkPowerProtocol.this)); + } + }); + } + +} diff --git a/src/main/java/org/traccar/protocol/ThinkPowerProtocolDecoder.java b/src/main/java/org/traccar/protocol/ThinkPowerProtocolDecoder.java new file mode 100644 index 000000000..b3f943078 --- /dev/null +++ b/src/main/java/org/traccar/protocol/ThinkPowerProtocolDecoder.java @@ -0,0 +1,182 @@ +/* + * 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.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.Checksum; +import org.traccar.helper.UnitsConverter; +import org.traccar.model.Position; + +import java.net.SocketAddress; +import java.nio.charset.StandardCharsets; +import java.util.Date; + +public class ThinkPowerProtocolDecoder extends BaseProtocolDecoder { + + public ThinkPowerProtocolDecoder(Protocol protocol) { + super(protocol); + } + + public static final int MSG_LOGIN_REQUEST = 0x01; + public static final int MSG_LOGIN_RESPONSE = 0x02; + public static final int MSG_HEARTBEAT_REQUEST = 0x03; + public static final int MSG_HEARTBEAT_RESPONSE = 0x04; + public static final int MSG_RECORD_REPORT = 0x05; + public static final int MSG_RECORD_RESPONSE = 0x06; + + private void sendResponse(Channel channel, int type, int index, ByteBuf content) { + if (channel != null) { + ByteBuf response = Unpooled.buffer(); + response.writeByte(type); + response.writeByte(index); + if (content != null) { + response.writeShort(content.readableBytes()); + response.writeBytes(content); + content.release(); + } else { + response.writeShort(0); + } + response.writeShort(Checksum.crc16(Checksum.CRC16_CCITT_FALSE, response.nioBuffer())); + channel.writeAndFlush(new NetworkMessage(response, channel.remoteAddress())); + } + } + + private void decodeValue(Position position, int type, ByteBuf buf) { + switch (type) { + case 0x01: + position.setValid(true); + position.setLatitude(buf.readInt() * 0.0000001); + position.setLongitude(buf.readInt() * 0.0000001); + position.setSpeed(UnitsConverter.knotsFromKph(buf.readUnsignedShort() * 0.1)); + position.setCourse(buf.readUnsignedShort() * 0.01); + break; + case 0x02: + position.setValid(buf.readUnsignedByte() > 0); + break; + case 0x03: + buf.skipBytes(3); // geofence + break; + case 0x06: + case 0x07: + case 0x08: + buf.skipBytes(2); // g-sensor x/y/z + break; + case 0x09: + buf.readUnsignedByte(); // collision alarm + break; + case 0x0A: + buf.readUnsignedByte(); // drop alarm + break; + case 0x10: + if (buf.readUnsignedByte() > 0) { + position.set(Position.KEY_ALARM, Position.ALARM_SOS); + } + break; + case 0x12: + position.set(Position.KEY_BATTERY, buf.readUnsignedShort() * 0.1); + break; + case 0x13: + if (buf.readUnsignedByte() > 0) { + position.set(Position.KEY_ALARM, Position.ALARM_LOW_BATTERY); + } + break; + case 0x16: + buf.readUnsignedShort(); // temperature + break; + case 0x17: + buf.readUnsignedByte(); // humidity + break; + case 0x18: + buf.readUnsignedShort(); // high temperature + break; + case 0x19: + buf.readUnsignedByte(); // high humidity + break; + case 0x50: + if (buf.readUnsignedByte() > 0) { + position.set(Position.KEY_ALARM, Position.ALARM_REMOVING); + } + break; + case 0x51: + if (buf.readUnsignedByte() > 0) { + position.set(Position.KEY_ALARM, Position.ALARM_TAMPERING); + } + break; + default: + break; + } + } + + @Override + protected Object decode( + Channel channel, SocketAddress remoteAddress, Object msg) throws Exception { + + ByteBuf buf = (ByteBuf) msg; + + int type = buf.readUnsignedByte(); + int index = buf.readUnsignedByte(); + buf.readUnsignedShort(); // length + + if (type == MSG_LOGIN_REQUEST) { + + buf.readUnsignedByte(); // protocol major version + buf.readUnsignedByte(); // protocol minor version + + String id = buf.readCharSequence(buf.readUnsignedByte(), StandardCharsets.US_ASCII).toString(); + DeviceSession deviceSession = getDeviceSession(channel, remoteAddress, id); + + ByteBuf content = Unpooled.buffer(); + content.writeByte(deviceSession != null ? 0 : 4); + sendResponse(channel, MSG_LOGIN_RESPONSE, index, content); + + } else if (type == MSG_HEARTBEAT_REQUEST) { + + sendResponse(channel, MSG_HEARTBEAT_RESPONSE, index, null); + + } else if (type == MSG_RECORD_REPORT) { + + DeviceSession deviceSession = getDeviceSession(channel, remoteAddress); + if (deviceSession == null) { + return null; + } + + buf.readUnsignedByte(); // count + + Position position = new Position(getProtocolName()); + position.setDeviceId(deviceSession.getDeviceId()); + + position.setTime(new Date(buf.readUnsignedInt() * 1000)); + + while (buf.readableBytes() > 2) { + decodeValue(position, buf.readUnsignedByte(), buf); + } + + sendResponse(channel, MSG_RECORD_RESPONSE, index, null); + + return position; + + } + + return null; + } + +} diff --git a/src/test/java/org/traccar/protocol/ThinkPowerProtocolDecoderTest.java b/src/test/java/org/traccar/protocol/ThinkPowerProtocolDecoderTest.java new file mode 100644 index 000000000..ff808e667 --- /dev/null +++ b/src/test/java/org/traccar/protocol/ThinkPowerProtocolDecoderTest.java @@ -0,0 +1,27 @@ +package org.traccar.protocol; + +import org.junit.Test; +import org.traccar.ProtocolTest; + +public class ThinkPowerProtocolDecoderTest extends ProtocolTest { + + @Test + public void testDecode() throws Exception { + + var decoder = new ThinkPowerProtocolDecoder(null); + + verifyNull(decoder, binary( + "0103002C01020F38363737333030353038323030343606544C3930344111522D312E302E31372E32303231303431300011C3")); + + verifyPosition(decoder, binary( + "05300012016099E995010D743CC943EB481500000000EED4")); + + verifyPosition(decoder, binary( + "05000007016099E768020162D8")); + + verifyNull(decoder, binary( + "03040000C3DC")); + + } + +} -- cgit v1.2.3