From 387d798a8fc66ec6792851a199fc83c4636fc6d8 Mon Sep 17 00:00:00 2001 From: Abyss777 Date: Tue, 5 Jul 2016 17:16:06 +0500 Subject: Granit protocol implementation --- src/org/traccar/protocol/GranitFrameDecoder.java | 40 ++++ src/org/traccar/protocol/GranitProtocol.java | 51 +++++ .../traccar/protocol/GranitProtocolDecoder.java | 215 +++++++++++++++++++++ .../traccar/protocol/GranitProtocolEncoder.java | 57 ++++++ 4 files changed, 363 insertions(+) create mode 100644 src/org/traccar/protocol/GranitFrameDecoder.java create mode 100644 src/org/traccar/protocol/GranitProtocol.java create mode 100644 src/org/traccar/protocol/GranitProtocolDecoder.java create mode 100644 src/org/traccar/protocol/GranitProtocolEncoder.java (limited to 'src/org/traccar/protocol') diff --git a/src/org/traccar/protocol/GranitFrameDecoder.java b/src/org/traccar/protocol/GranitFrameDecoder.java new file mode 100644 index 000000000..ad6ddc99d --- /dev/null +++ b/src/org/traccar/protocol/GranitFrameDecoder.java @@ -0,0 +1,40 @@ +/* + * Copyright 2016 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.channel.Channel; +import org.jboss.netty.channel.ChannelHandlerContext; +import org.jboss.netty.handler.codec.frame.FrameDecoder; +import org.traccar.helper.StringFinder; + +public class GranitFrameDecoder extends FrameDecoder { + + @Override + protected Object decode( + ChannelHandlerContext ctx, Channel channel, ChannelBuffer buf) throws Exception { + + int index = buf.indexOf(buf.readerIndex(), buf.writerIndex(), new StringFinder("\r\n")); + if (index != -1) { + ChannelBuffer frame = buf.readBytes(index - buf.readerIndex()); + buf.skipBytes(2); + return frame; + } + + return null; + } + +} diff --git a/src/org/traccar/protocol/GranitProtocol.java b/src/org/traccar/protocol/GranitProtocol.java new file mode 100644 index 000000000..fb9d10809 --- /dev/null +++ b/src/org/traccar/protocol/GranitProtocol.java @@ -0,0 +1,51 @@ +/* + * Copyright 2016 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.bootstrap.ServerBootstrap; +import org.jboss.netty.channel.ChannelPipeline; +import org.traccar.BaseProtocol; +import org.traccar.TrackerServer; +import org.traccar.model.Command; + +import java.nio.ByteOrder; +import java.util.List; + +public class GranitProtocol extends BaseProtocol { + + public GranitProtocol() { + super("granit"); + setSupportedCommands( + Command.TYPE_IDENTIFICATION, + Command.TYPE_REBOOT_DEVICE, + Command.TYPE_POSITION_SINGLE); + } + + @Override + public void initTrackerServers(List serverList) { + TrackerServer server = new TrackerServer(new ServerBootstrap(), this.getName()) { + @Override + protected void addSpecificHandlers(ChannelPipeline pipeline) { + pipeline.addLast("frameDecoder", new GranitFrameDecoder()); + pipeline.addLast("objectEncoder", new GranitProtocolEncoder()); + pipeline.addLast("objectDecoder", new GranitProtocolDecoder(GranitProtocol.this)); + } + }; + server.setEndianness(ByteOrder.LITTLE_ENDIAN); + serverList.add(server); + } + +} diff --git a/src/org/traccar/protocol/GranitProtocolDecoder.java b/src/org/traccar/protocol/GranitProtocolDecoder.java new file mode 100644 index 000000000..16229dc18 --- /dev/null +++ b/src/org/traccar/protocol/GranitProtocolDecoder.java @@ -0,0 +1,215 @@ +/* + * Copyright 2016 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.traccar.BaseProtocolDecoder; +import org.traccar.helper.BitUtil; +import org.traccar.helper.Checksum; +import org.traccar.model.Position; + +import java.net.SocketAddress; +import java.nio.ByteOrder; +import java.nio.charset.StandardCharsets; +import java.util.ArrayList; +import java.util.Date; +import java.util.List; + +public class GranitProtocolDecoder extends BaseProtocolDecoder { + + private static final int HEADER_LENGTH = 6; + + public GranitProtocolDecoder(GranitProtocol protocol) { + super(protocol); + } + + public static void appendChecksum(ChannelBuffer buffer, int length) { + buffer.writeByte(0x2a); // asterisk + int checksum = Checksum.xor(buffer.toByteBuffer(0, length)) & 0xFF; + String checksumString = String.format("%02X", checksum); + buffer.writeBytes(checksumString.getBytes(StandardCharsets.US_ASCII)); + buffer.writeByte(0x0D); buffer.writeByte(0x0A); + } + + private static void sendResponseCurrent(Channel channel, int deviceId, long time) { + ChannelBuffer response = ChannelBuffers.directBuffer(ByteOrder.LITTLE_ENDIAN, 21); + response.writeBytes("BB+UGRC~".getBytes(StandardCharsets.US_ASCII)); + response.writeShort(6); //binary length + response.writeInt((int) time); + response.writeShort(deviceId); + appendChecksum(response, 16); + channel.write(response); + } + + private static void sendResponseArchive(Channel channel, int deviceId, int packNum) { + ChannelBuffer response = ChannelBuffers.directBuffer(ByteOrder.LITTLE_ENDIAN, 19); + response.writeBytes("BB+ARCF~".getBytes(StandardCharsets.US_ASCII)); + response.writeShort(4); //binary length + response.writeShort(packNum); + response.writeShort(deviceId); + appendChecksum(response, 14); + channel.write(response); + } + + private static void decodeStructure(ChannelBuffer buf, Position position) { + short flags = buf.readUnsignedByte(); + position.setValid(BitUtil.check(flags, 7)); + position.set(Position.KEY_ALARM, BitUtil.check(flags, 1)); + + short satDel = buf.readUnsignedByte(); + position.set(Position.KEY_SATELLITES, BitUtil.from(satDel, 4)); + + int pdop = BitUtil.to(satDel, 4); + position.set("pdop", pdop); + + int lonDegrees = buf.readUnsignedByte(); + int latDegrees = buf.readUnsignedByte(); + int lonMinutes = buf.readUnsignedShort(); + int latMinutes = buf.readUnsignedShort(); + double latitude = latDegrees + (double) latMinutes / 60000; + double longitude = lonDegrees + (double) lonMinutes / 60000; + if (!BitUtil.check(flags, 4)) { + latitude = -latDegrees; + } + if (!BitUtil.check(flags, 5)) { + longitude = -longitude; + } + position.setLongitude(longitude); + position.setLatitude(latitude); + + position.setSpeed(buf.readUnsignedByte()); + + int course = buf.readUnsignedByte(); + if (BitUtil.check(flags, 6)) { + course = course | 0x100; + } + position.setCourse(course); + + position.set(Position.KEY_DISTANCE, buf.readShort()); + + int analogIn1 = buf.readUnsignedByte(); + int analogIn2 = buf.readUnsignedByte(); + int analogIn3 = buf.readUnsignedByte(); + int analogIn4 = buf.readUnsignedByte(); + + int analogInHi = buf.readUnsignedByte(); + + analogIn1 = analogInHi << 8 & 0x300 | analogIn1; + analogIn2 = analogInHi << 6 & 0x300 | analogIn2; + analogIn3 = analogInHi << 4 & 0x300 | analogIn3; + analogIn4 = analogInHi << 2 & 0x300 | analogIn4; + + position.set(Position.PREFIX_ADC + 1, analogIn1); + position.set(Position.PREFIX_ADC + 2, analogIn2); + position.set(Position.PREFIX_ADC + 3, analogIn3); + position.set(Position.PREFIX_ADC + 4, analogIn4); + + position.setAltitude(buf.readUnsignedByte() * 10); + + short diOut = buf.readUnsignedByte(); + for (int i = 0; i < 8; i++) { + position.set(Position.PREFIX_IO + (i + 1), BitUtil.check(diOut, i)); + } + buf.skipBytes(1); //StatMess + } + + @Override + protected Object decode(Channel channel, SocketAddress remoteAddress, Object msg) throws Exception { + + ChannelBuffer buf = (ChannelBuffer) msg; + + if (hasDeviceId() && buf.toString(StandardCharsets.US_ASCII).contains("OK") + || buf.toString(StandardCharsets.US_ASCII).startsWith("ERROR") + || buf.toString(StandardCharsets.US_ASCII).startsWith("+PR") + || buf.toString(StandardCharsets.US_ASCII).startsWith("+IDNT") + || buf.toString(StandardCharsets.US_ASCII).startsWith("+BBMD")) { + Position position = new Position(); + position.setProtocol(getProtocolName()); + position.setDeviceId(getDeviceId()); + + position.setTime(new Date()); + getLastLocation(position, new Date()); + position.setValid(false); + position.set(Position.KEY_RESULT, buf.toString(StandardCharsets.US_ASCII)); + + return position; + } + + if (buf.readableBytes() < HEADER_LENGTH) { + return null; + } + + String header = buf.readBytes(HEADER_LENGTH).toString(StandardCharsets.US_ASCII); + + if (header.equals("+RRCB~")) { + buf.skipBytes(2); //binary length 26 + int deviceId = buf.readUnsignedShort(); + if (!identify(String.valueOf(deviceId), channel, remoteAddress)) { + return null; + } + long unixTime = buf.readUnsignedInt(); + if (channel != null) { + sendResponseCurrent(channel, deviceId, unixTime); + } + Position position = new Position(); + position.setProtocol(getProtocolName()); + position.setDeviceId(getDeviceId()); + + position.setTime(new Date(unixTime * 1000)); + + decodeStructure(buf, position); + return position; + + } else if (header.equals("+DDAT~")) { + buf.skipBytes(2); //binary length + int deviceId = buf.readUnsignedShort(); + if (!identify(String.valueOf(deviceId), channel, remoteAddress)) { + return null; + } + byte format = buf.readByte(); + if (format != 4) { + return null; + } + byte nblocks = buf.readByte(); + int packNum = buf.readUnsignedShort(); + if (channel != null) { + sendResponseArchive(channel, deviceId, packNum); + } + List positions = new ArrayList<>(); + while (nblocks > 0) { + nblocks--; + long unixTime = buf.readUnsignedInt(); + for (int i = 0; i < 6; i++) { + if (buf.getUnsignedByte(buf.readerIndex()) != 0xFE) { + Position position = new Position(); + position.setProtocol(getProtocolName()); + position.setDeviceId(getDeviceId()); + position.setTime(new Date(unixTime * 1000)); + decodeStructure(buf, position); + positions.add(position); + } else { + buf.skipBytes(20); // skip filled 0xFE structure + } + } + buf.skipBytes(2); // increment + } + return positions; + } + return null; + } +} diff --git a/src/org/traccar/protocol/GranitProtocolEncoder.java b/src/org/traccar/protocol/GranitProtocolEncoder.java new file mode 100644 index 000000000..2f9e0aa10 --- /dev/null +++ b/src/org/traccar/protocol/GranitProtocolEncoder.java @@ -0,0 +1,57 @@ +/* + * Copyright 2016 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.nio.ByteOrder; +import java.nio.charset.StandardCharsets; + +import org.jboss.netty.buffer.ChannelBuffer; +import org.jboss.netty.buffer.ChannelBuffers; +import org.traccar.BaseProtocolEncoder; +import org.traccar.helper.Log; +import org.traccar.model.Command; + +public class GranitProtocolEncoder extends BaseProtocolEncoder { + @Override + protected Object encodeCommand(Command command) { + + ChannelBuffer commandString; + + switch (command.getType()) { + case Command.TYPE_IDENTIFICATION: + commandString = ChannelBuffers.directBuffer(ByteOrder.LITTLE_ENDIAN, 12); + commandString.writeBytes("BB+IDNT".getBytes(StandardCharsets.US_ASCII)); + GranitProtocolDecoder.appendChecksum(commandString, 7); + return commandString; + case Command.TYPE_REBOOT_DEVICE: + commandString = ChannelBuffers.directBuffer(ByteOrder.LITTLE_ENDIAN, 13); + commandString.writeBytes("BB+RESET".getBytes(StandardCharsets.US_ASCII)); + GranitProtocolDecoder.appendChecksum(commandString, 8); + return commandString; + case Command.TYPE_POSITION_SINGLE: + commandString = ChannelBuffers.directBuffer(ByteOrder.LITTLE_ENDIAN, 12); + commandString.writeBytes("BB+RRCD".getBytes(StandardCharsets.US_ASCII)); + GranitProtocolDecoder.appendChecksum(commandString, 7); + return commandString; + default: + Log.warning(new UnsupportedOperationException(command.getType())); + break; + } + + return null; + } + +} -- cgit v1.2.3