#1113 Updates LRRP protocol to correctly identify geo-fence positions and to add support for packet type identification. Corrects issue with N/S and E/W hemisphere calculations. (#1114)

Co-authored-by: Dennis Sheirer <dsheirer@github.com>
This commit is contained in:
Denny Sheirer
2021-11-25 05:58:42 -05:00
committed by GitHub
parent 31b9ee5910
commit aa89079e28
16 changed files with 659 additions and 72 deletions

View File

@@ -1,6 +1,6 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2020 Dennis Sheirer
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
@@ -53,6 +53,22 @@ public class LRRPHeader extends Header
setValid(getMessage().size() >= (getOffset() + getLength() + getPayloadLength()));
}
/**
* Integer value of the LRRP Packet type
*/
public int getLrrpPacketTypeValue()
{
return getMessage().getInt(TYPE, getOffset());
}
/**
* LRRP Packet Type
*/
public LRRPPacketType getLRRPPacketType()
{
return LRRPPacketType.fromValue(getLrrpPacketTypeValue());
}
/**
* Length of the payload in 8-bit characters
*

View File

@@ -1,6 +1,6 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2020 Dennis Sheirer
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
@@ -56,7 +56,16 @@ public class LRRPPacket extends Packet
public String toString()
{
StringBuilder sb = new StringBuilder();
sb.append("LRRP");
LRRPPacketType type = getHeader().getLRRPPacketType();
if(type == LRRPPacketType.UNKNOWN)
{
sb.append("LRRP TYPE:UNKNOWN [").append(getHeader().getLrrpPacketTypeValue()).append("]");
}
else
{
sb.append("LRRP ").append(type);
}
for(Token token: getTokens())
{
@@ -100,7 +109,6 @@ public class LRRPPacket extends Packet
String tokenId = getTokenIdentifier(offset);
Token token = TokenFactory.createToken(tokenId, getMessage(), offset, characterCount);
mTokens.add(token);
int length = token.getByteLength();
characterCount -= token.getByteLength();
offset += (8 * token.getByteLength());
}

View File

@@ -0,0 +1,79 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>
* ****************************************************************************
*/
package io.github.dsheirer.module.decode.ip.lrrp;
/**
* LRRP Packet Type enumeration
*/
public enum LRRPPacketType
{
IMMEDIATE_LOCATION_REQUEST(0x05, "IMMEDIATE LOCATION REQUEST"),
IMMEDIATE_LOCATION_RESPONSE(0x07, "IMMEDIATE LOCATION RESPONSE"),
TRIGGERED_LOCATION_START_REQUEST(0x09, "TRIGGERED LOCATION START REQUEST"),
TRIGGERED_LOCATION_START_RESPONSE(0x0B, "TRIGGERED LOCATION START RESPONSE"),
TRIGGERED_LOCATION(0x0D, "TRIGGERED LOCATION"),
TRIGGERED_LOCATION_STOP_REQUEST(0x0F, "TRIGGERED LOCATION STOP REQUEST"),
TRIGGERED_LOCATION_STOP_RESPONSE(0x11, "TRIGGERED LOCATION STOP RESPONSE"),
PROTOCOL_VERSION_REQUEST(0x14, "PROTOCOL VERSION REQUEST"),
PROTOCOL_VERSION_RESPONSE(0x15, "PROTOCOL VERSION RESPONSE"),
UNKNOWN(-1, "UNKNOWN");
private int mValue;
private String mLabel;
LRRPPacketType(int value, String label)
{
mValue = value;
mLabel = label;
}
/**
* Numeric value of the type.
*/
public int getValue()
{
return mValue;
}
@Override
public String toString()
{
return mLabel;
}
/**
* Lookup the LRRP packet type from the value.
* @param value to lookup
* @return entry or UNKNOWN
*/
public static LRRPPacketType fromValue(int value)
{
for(LRRPPacketType lrrpPacketType: LRRPPacketType.values())
{
if(lrrpPacketType.getValue() == value)
{
return lrrpPacketType;
}
}
return UNKNOWN;
}
}

View File

@@ -0,0 +1,65 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>
* ****************************************************************************
*/
package io.github.dsheirer.module.decode.ip.lrrp.token;
import io.github.dsheirer.bits.CorrectedBinaryMessage;
/**
* LRRP Geo-Fence Position with latitude, longitude and radius
*/
public class GeoFencePosition extends Position
{
private static final int[] RADIUS_WHOLE = new int[]{72, 73, 74, 75, 76, 77, 78, 79};
private static final int[] RADIUS_FRACTIONAL = new int[]{80, 81, 82, 83, 84, 85, 86, 87};
/**
* Constructs an instance of an approximate position token.
*
* @param message containing the heading
* @param offset to the start of the token
*/
public GeoFencePosition(CorrectedBinaryMessage message, int offset)
{
super(message, offset);
}
@Override
public TokenType getTokenType()
{
return TokenType.POSITION_GEO_FENCE;
}
/**
* Radius of position
*
* @return radius in meters
*/
public float getRadius()
{
return getFloat(RADIUS_WHOLE, RADIUS_FRACTIONAL);
}
@Override
public String toString()
{
CorrectedBinaryMessage sub = getMessage().getSubMessage(getOffset(), getOffset() + 87);
return "GEO-FENCE POSITION:" + getPosition() + " RADIUS:" + getRadius() + " KM";
}
}

View File

@@ -0,0 +1,81 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>
* ****************************************************************************
*/
package io.github.dsheirer.module.decode.ip.lrrp.token;
import io.github.dsheirer.bits.CorrectedBinaryMessage;
/**
* LRRP 3D Position with latitude, longitude, altitude and radius
*/
public class GeoFencePosition3D extends GeoFencePosition
{
private static final int[] ALTITUDE_WHOLE = new int[]{88, 89, 90, 91, 92, 93, 94, 95};
private static final int[] ALTITUDE_FRACTIONAL = new int[]{96, 97, 98, 99, 100, 101, 102, 103};
private static final int[] ALTITUDE_ACCURACY_WHOLE = new int[]{104, 105, 106, 107, 108, 109, 110, 111};
private static final int[] ALTITUDE_ACCURACY_FRACTIONAL = new int[]{112, 113, 114, 115, 116, 117, 118, 119};
/**
* Constructs an instance of a 3D position token.
*
* @param message containing the heading
* @param offset to the start of the token
*/
public GeoFencePosition3D(CorrectedBinaryMessage message, int offset)
{
super(message, offset);
}
@Override
public TokenType getTokenType()
{
return TokenType.POSITION_GEO_FENCE_3D;
}
/**
* Altitude
*
* @return altitude in meters
*/
public float getAltitude()
{
return getFloat(ALTITUDE_WHOLE, ALTITUDE_FRACTIONAL);
}
/**
* Altitude accuracy
* @return accuracy in meters
*/
public float getAltitudeAccuracy()
{
return getFloat(ALTITUDE_ACCURACY_WHOLE, ALTITUDE_ACCURACY_FRACTIONAL);
}
@Override
public String toString()
{
StringBuilder sb = new StringBuilder();
sb.append("GEO-FENCE POSITION:").append(getPosition());
sb.append(" RADIUS:").append(getRadius());
sb.append("KM ALTITUDE:").append(getAltitude());
sb.append(" ALT ACCURACY:").append(getAltitudeAccuracy());
return sb.toString();
}
}

View File

@@ -1,6 +1,6 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2020 Dennis Sheirer
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
@@ -30,6 +30,7 @@ import io.github.dsheirer.bits.CorrectedBinaryMessage;
public class Heading extends Token
{
private static final int[] HEADING = new int[]{8, 9, 10, 11, 12, 13, 14, 15};
private static final float HEADING_MULTIPLIER = 360.0f / 256.0f;
/**
* Constructs an instance of a heading token.
@@ -51,9 +52,9 @@ public class Heading extends Token
/**
* Heading degrees relative to true North
*/
public long getHeading()
public float getHeading()
{
return getMessage().getInt(HEADING, getOffset());
return getMessage().getInt(HEADING, getOffset()) * HEADING_MULTIPLIER;
}
@Override

View File

@@ -1,6 +1,6 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2020 Dennis Sheirer
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
@@ -29,18 +29,21 @@ import io.github.dsheirer.bits.CorrectedBinaryMessage;
*/
public class Position extends Token
{
private static final int[] LATITUDE = new int[]{8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24,
private static final int LATITUDE_HEMISPHERE_FLAG = 8;
private static final int[] LATITUDE = new int[]{9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24,
25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39};
private static final int[] LONGITUDE = new int[]{40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56,
private static final int LONGITUDE_HEMISPHERE_FLAG = 40;
private static final int[] LONGITUDE = new int[]{41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56,
57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71};
private static final double LATITUDE_MULTIPLIER = 180.0 / 4294967295.0d;
private static final double LONGITUDE_MULTIPLIER = 360.0 / 4294967295.0d;
protected static final float FRACTIONAL_MULTIPLIER = 0.01f;
private LRRPPosition mPosition;
/**
* Constructs an instance of a heading token.
* Constructs an instance of a position token.
*
* @param message containing the heading
* @param offset to the start of the token
@@ -74,7 +77,7 @@ public class Position extends Token
*/
public double getLatitude()
{
return getMessage().getInt(LATITUDE, getOffset()) * LATITUDE_MULTIPLIER;
return getMessage().getInt(LATITUDE, getOffset()) * LATITUDE_MULTIPLIER * (getMessage().get(LATITUDE_HEMISPHERE_FLAG) ? -1 : 1);
}
/**
@@ -82,7 +85,19 @@ public class Position extends Token
*/
public double getLongitude()
{
return getMessage().getInt(LONGITUDE, getOffset()) * LONGITUDE_MULTIPLIER;
return getMessage().getInt(LONGITUDE, getOffset()) * LONGITUDE_MULTIPLIER * (getMessage().get(LONGITUDE_HEMISPHERE_FLAG) ? -1 : 1);
}
/**
* Calculates the floating point value specified by the message index arrays.
* @param whole units indexes
* @param fractional one-hundredth units indexes
* @return full value
*/
protected float getFloat(int[] whole, int[] fractional)
{
return getMessage().getInt(whole, getOffset()) +
(getMessage().getInt(fractional, getOffset()) * FRACTIONAL_MULTIPLIER);
}
@Override

View File

@@ -1,6 +1,6 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2020 Dennis Sheirer
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
@@ -22,14 +22,16 @@ package io.github.dsheirer.module.decode.ip.lrrp.token;
import io.github.dsheirer.bits.CorrectedBinaryMessage;
/**
* LRRP 3-D Position with latitude, longitude and altitude
* LRRP 3D Position with latitude, longitude and altitude
*/
public class Position3D extends Position
{
private static final int[] ALTITUDE = new int[]{72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87};
//Note: these may not be correct ... there may be 3 bytes available for altitude
private static final int[] ALTITUDE_WHOLE = new int[]{72, 73, 74, 75, 76, 77, 78, 79};
private static final int[] ALTITUDE_FRACTIONAL = new int[]{80, 81, 82, 83, 84, 85, 86, 87};
/**
* Constructs an instance of a heading token.
* Constructs an instance of an approximate position token.
*
* @param message containing the heading
* @param offset to the start of the token
@@ -50,15 +52,15 @@ public class Position3D extends Position
*
* @return altitude in meters
*/
public int getAltitude()
public float getAltitude()
{
return getMessage().getInt(ALTITUDE, getOffset());
return getFloat(ALTITUDE_WHOLE, ALTITUDE_FRACTIONAL);
}
@Override
public String toString()
{
return "POSITION:" + getPosition() + " ALT:" + getAltitude() + " MTRS";
CorrectedBinaryMessage sub = getMessage().getSubMessage(getOffset(), getOffset() + 87);
return "POSITION:" + getPosition() + " ALTITUDE:" + getAltitude() + " MTRS";
}
}

View File

@@ -0,0 +1,102 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>
* ****************************************************************************
*/
package io.github.dsheirer.module.decode.ip.lrrp.token;
import io.github.dsheirer.bits.CorrectedBinaryMessage;
/**
* LRRP Response Code Token
* <p>
* Start Token: 0x37
* Total Length: 2 or 3 bytes
*/
public class Response extends Token
{
private static final int CODE_LENGTH_FLAG = 16;
private static final int[] ONE_BYTE_CODE = new int[]{17, 18, 19, 20, 21, 22, 23};
private static final int[] TWO_BYTE_CODE = new int[]{17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31};
/**
* Constructs an instance of a response code token.
*
* @param message containing the heading
* @param offset to the start of the token
*/
public Response(CorrectedBinaryMessage message, int offset)
{
super(message, offset);
}
@Override
public TokenType getTokenType()
{
return TokenType.RESPONSE;
}
/**
* Indicates if this is an extended (ie 2-byte) code.
*/
private boolean isExtendedCode()
{
return getMessage().get(CODE_LENGTH_FLAG);
}
/**
* Response code. This value is either one byte or two bytes long.
*/
public int getCodeValue()
{
if(isExtendedCode())
{
return getMessage().getInt(TWO_BYTE_CODE);
}
else
{
return getMessage().getInt(ONE_BYTE_CODE);
}
}
/**
* Response code
*/
public ResponseCode getResponseCode()
{
return ResponseCode.fromValue(getCodeValue());
}
@Override
public int getByteLength()
{
return isExtendedCode() ? 3 : 2;
}
@Override
public String toString()
{
ResponseCode responseCode = getResponseCode();
if(responseCode == ResponseCode.UNKNOWN)
{
return "RESPONSE CODE: UNKNOWN[" + getCodeValue() + "]";
}
return "RESPONSE CODE:" + responseCode;
}
}

View File

@@ -0,0 +1,80 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>
* ****************************************************************************
*/
package io.github.dsheirer.module.decode.ip.lrrp.token;
/**
* LRRP Response codes.
*
* From: https://github.com/pboyd04/Moto.Net/blob/master/Moto.Net/Mototrbo/LRRP/LRRPResponseCodes.cs
*/
public enum ResponseCode
{
SUCCESS(0x0, "SUCCESS"),
INVALID_COMMAND(0x0A, "INVALID COMMAND"),
NO_GPS(0x10, "NO GPS"),
GPS_INITIALIZING(0x200, "GPS INITIALIZING"),
UNKNOWN(-1, "UNKNOWN");
private int mValue;
private String mLabel;
/**
* Constructs an instance
* @param value of the code
* @param label for pretty printing
*/
ResponseCode(int value, String label)
{
mValue = value;
mLabel = label;
}
/**
* Numeric value of the response code
*/
public int getValue()
{
return mValue;
}
/**
* Lookup a response code from a value
* @param value to lookup
* @return matching response code or UNKNOWN
*/
public static ResponseCode fromValue(int value)
{
for(ResponseCode responseCode: ResponseCode.values())
{
if(responseCode.getValue() == value)
{
return responseCode;
}
}
return UNKNOWN;
}
@Override
public String toString()
{
return mLabel;
}
}

View File

@@ -1,6 +1,6 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2020 Dennis Sheirer
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
@@ -34,16 +34,24 @@ public class TokenFactory
{
case HEADING:
return new Heading(message, offset);
case IDENTITY:
return new Identity(message, offset);
case POSITION:
return new Position(message, offset);
case POSITION_GEO_FENCE:
return new GeoFencePosition(message, offset);
case POSITION_3D:
return new Position3D(message, offset);
case POSITION_GEO_FENCE_3D:
return new GeoFencePosition3D(message, offset);
case RESPONSE:
return new Response(message, offset);
case SPEED:
return new Speed(message, offset);
case TIMESTAMP:
return new Timestamp(message, offset);
case IDENTITY:
return new Identity(message, offset);
case VERSION:
return new Version(message, offset);
case UNKNOWN_23:
return new Unknown23(message, offset);
case UNKNOWN:

View File

@@ -1,6 +1,6 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2020 Dennis Sheirer
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
@@ -30,13 +30,18 @@ import java.util.Map;
*/
public enum TokenType
{
POSITION("66", 8),
POSITION_3D("51", 10),
HEADING("56", 1),
SPEED("6C", 2),
TIMESTAMP("34", 5),
IDENTITY("22", -1),
UNKNOWN_23("23", 1),
TIMESTAMP("34", 5),
VERSION("36", 1),
RESPONSE("37", -1),
// SUCCESS_RESPONSE_CODE( "38", 0), //Maybe: https://github.com/pboyd04/Moto.Net/blob/master/Moto.Net/Mototrbo/LRRP/TriggeredLocationStartResponsePacket.cs
POSITION_GEO_FENCE("51", 10),
POSITION_GEO_FENCE_3D("55", 15),
HEADING("56", 1),
POSITION("66", 8),
POSITION_3D("69", 11),
SPEED("6C", 2),
UNKNOWN("0",0);
private String mValue;

View File

@@ -0,0 +1,61 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>
* ****************************************************************************
*/
package io.github.dsheirer.module.decode.ip.lrrp.token;
import io.github.dsheirer.bits.CorrectedBinaryMessage;
/**
* LRRP Version Token
*/
public class Version extends Token
{
private static final int[] VERSION = new int[]{8, 9, 10, 11, 12, 13, 14, 15};
/**
* Constructs an instance of a heading token.
*
* @param message containing the heading
* @param offset to the start of the token
*/
public Version(CorrectedBinaryMessage message, int offset)
{
super(message, offset);
}
@Override
public TokenType getTokenType()
{
return TokenType.VERSION;
}
/**
* LRRP Version
*/
public int getVersion()
{
return getMessage().getInt(VERSION, getOffset());
}
@Override
public String toString()
{
return "VERSION:" + getVersion();
}
}

View File

@@ -1,23 +1,20 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2021 Dennis Sheirer
*
* * ******************************************************************************
* * Copyright (C) 2014-2020 Dennis Sheirer
* *
* * This program is free software: you can redistribute it and/or modify
* * it under the terms of the GNU General Public License as published by
* * the Free Software Foundation, either version 3 of the License, or
* * (at your option) any later version.
* *
* * This program is distributed in the hope that it will be useful,
* * but WITHOUT ANY WARRANTY; without even the implied warranty of
* * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* * GNU General Public License for more details.
* *
* * You should have received a copy of the GNU General Public License
* * along with this program. If not, see <http://www.gnu.org/licenses/>
* * *****************************************************************************
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>
* ****************************************************************************
*/
package io.github.dsheirer.module.decode.p25.phase1;
@@ -41,10 +38,12 @@ import io.github.dsheirer.message.IMessage;
import io.github.dsheirer.module.decode.DecoderType;
import io.github.dsheirer.module.decode.event.DecodeEvent;
import io.github.dsheirer.module.decode.event.DecodeEventType;
import io.github.dsheirer.module.decode.event.PlottableDecodeEvent;
import io.github.dsheirer.module.decode.ip.IPacket;
import io.github.dsheirer.module.decode.ip.ars.ARSPacket;
import io.github.dsheirer.module.decode.ip.cellocator.MCGPPacket;
import io.github.dsheirer.module.decode.ip.ipv4.IPV4Packet;
import io.github.dsheirer.module.decode.ip.lrrp.LRRPPacket;
import io.github.dsheirer.module.decode.ip.udp.UDPPacket;
import io.github.dsheirer.module.decode.p25.P25DecodeEvent;
import io.github.dsheirer.module.decode.p25.P25TrafficChannelManager;
@@ -134,7 +133,10 @@ import io.github.dsheirer.module.decode.p25.phase1.message.tsbk.standard.osp.Uni
import io.github.dsheirer.module.decode.p25.phase1.message.tsbk.standard.osp.UnitToUnitVoiceChannelGrantUpdate;
import io.github.dsheirer.module.decode.p25.reference.Encryption;
import io.github.dsheirer.module.decode.p25.reference.ServiceOptions;
import io.github.dsheirer.protocol.Protocol;
import io.github.dsheirer.sample.Listener;
import io.github.dsheirer.util.PacketUtil;
import org.jdesktop.swingx.mapviewer.GeoPosition;
import org.slf4j.Logger;
import org.slf4j.LoggerFactory;
@@ -974,6 +976,35 @@ public class P25P1DecoderState extends DecoderState implements IChannelEventList
broadcast(cellocatorEvent);
}
else if(udpPayload instanceof LRRPPacket lrrpPacket)
{
MutableIdentifierCollection ic = new MutableIdentifierCollection(packet.getIdentifiers());
DecodeEvent lrrpEvent = P25DecodeEvent.builder(message.getTimestamp())
.channel(getCurrentChannel())
.details(lrrpPacket + " " + ipv4)
.eventDescription("LRRP")
.identifiers(ic)
.protocol(Protocol.LRRP)
.build();
broadcast(lrrpEvent);
GeoPosition geoPosition = PacketUtil.extractGeoPosition(lrrpPacket);
if (geoPosition != null)
{
PlottableDecodeEvent plottableDecodeEvent = PlottableDecodeEvent.plottableBuilder(message.getTimestamp())
.channel(getCurrentChannel())
.eventDescription(DecodeEventType.GPS.toString())
.identifiers(ic)
.protocol(Protocol.LRRP)
.location(geoPosition)
.build();
broadcast(plottableDecodeEvent);
}
}
else
{
MutableIdentifierCollection ic = new MutableIdentifierCollection(getIdentifierCollection().getIdentifiers());

View File

@@ -1,23 +1,20 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2021 Dennis Sheirer
*
* * ******************************************************************************
* * Copyright (C) 2014-2020 Dennis Sheirer
* *
* * This program is free software: you can redistribute it and/or modify
* * it under the terms of the GNU General Public License as published by
* * the Free Software Foundation, either version 3 of the License, or
* * (at your option) any later version.
* *
* * This program is distributed in the hope that it will be useful,
* * but WITHOUT ANY WARRANTY; without even the implied warranty of
* * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* * GNU General Public License for more details.
* *
* * You should have received a copy of the GNU General Public License
* * along with this program. If not, see <http://www.gnu.org/licenses/>
* * *****************************************************************************
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>
* ****************************************************************************
*/
package io.github.dsheirer.module.decode.p25.phase1;
@@ -449,7 +446,7 @@ public class P25P1MessageFramer implements Listener<Dibit>, IP25P1DataUnitDetect
public static void main(String[] args)
{
Path directory = Paths.get("/media/denny/500G1EXT4/RadioRecordings/APCO25/Ken Noffsinger");
Path directory = Paths.get("/home/denny/SDRTrunk/recordings/LRRP P25");
// Path directory = Paths.get("/media/denny/500G1EXT4/PBITRecordings");
UserPreferences userPreferences = new UserPreferences();

View File

@@ -1,19 +1,51 @@
/*
* *****************************************************************************
* Copyright (C) 2014-2021 Dennis Sheirer
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>
* ****************************************************************************
*/
package io.github.dsheirer.util;
import io.github.dsheirer.module.decode.ip.IPacket;
import io.github.dsheirer.module.decode.ip.ipv4.IPV4Packet;
import io.github.dsheirer.module.decode.ip.lrrp.LRRPPacket;
import io.github.dsheirer.module.decode.ip.lrrp.token.GeoFencePosition;
import io.github.dsheirer.module.decode.ip.lrrp.token.Position;
import io.github.dsheirer.module.decode.ip.lrrp.token.Token;
import io.github.dsheirer.module.decode.ip.udp.UDPPacket;
import org.jdesktop.swingx.mapviewer.GeoPosition;
public class PacketUtil {
public static GeoPosition extractGeoPosition(IPacket packet) {
if (packet instanceof IPV4Packet) {
/**
* Packet utility methods.
*/
public class PacketUtil
{
/**
* Extracts a plottable position from a packet.
* @param packet to inspect and process
* @return geo position
*/
public static GeoPosition extractGeoPosition(IPacket packet)
{
if(packet instanceof IPV4Packet)
{
IPV4Packet ipPacket = (IPV4Packet) packet;
if (ipPacket.getPayload() instanceof UDPPacket) {
if(ipPacket.getPayload() instanceof UDPPacket)
{
UDPPacket udpPacket = (UDPPacket) ipPacket.getPayload();
return extractGeoPosition(udpPacket);
}
@@ -21,10 +53,12 @@ public class PacketUtil {
return null;
}
if (packet instanceof UDPPacket) {
if(packet instanceof UDPPacket)
{
UDPPacket udpPacket = (UDPPacket) packet;
if (udpPacket.getPayload() instanceof LRRPPacket) {
if(udpPacket.getPayload() instanceof LRRPPacket)
{
LRRPPacket lrrpPacket = (LRRPPacket) udpPacket.getPayload();
return extractGeoPosition(lrrpPacket);
}
@@ -32,12 +66,14 @@ public class PacketUtil {
return null;
}
if (packet instanceof LRRPPacket) {
if(packet instanceof LRRPPacket)
{
LRRPPacket lrrpPacket = (LRRPPacket) packet;
for (Token token: lrrpPacket.getTokens())
for(Token token : lrrpPacket.getTokens())
{
if (token instanceof Position) {
if(token instanceof Position)
{
Position position = (Position) token;
return new GeoPosition(position.getLatitude(), position.getLongitude());
}