112 lines
3.5 KiB
Python
112 lines
3.5 KiB
Python
import math
|
|
|
|
class ModeSLocation:
|
|
"""This class does ModeS/ADSB Location calulations"""
|
|
|
|
|
|
|
|
##########################################################################
|
|
|
|
# Copyright 2010, 2012 Nick Foster
|
|
#
|
|
# This file is part of gr-air-modes
|
|
#
|
|
# gr-air-modes 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, or (at your option)
|
|
# any later version.
|
|
#
|
|
# gr-air-modes 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 gr-air-modes; see the file COPYING. If not, write to
|
|
# the Free Software Foundation, Inc., 51 Franklin Street,
|
|
# Boston, MA 02110-1301, USA.
|
|
#
|
|
###############################################################
|
|
# Further work on fork
|
|
# Copyright (C) 2017 David Robinson
|
|
def encode_alt_modes(self, alt, bit13):
|
|
# need to better understand as the >50175 feet not working
|
|
# TODO >50175 feet
|
|
mbit = False
|
|
qbit = True
|
|
# For altitudes -1000<=X<=50175 feet, set bit 8 AKA the Q bit to true which means 25 feet resoulution
|
|
# For >50175 set the qbit to False and use 100 feet resoultion
|
|
if alt > 50175:
|
|
qbit = False
|
|
encalt = int((int(alt) + 1000) / 100)
|
|
else:
|
|
qbit = True
|
|
encalt = int((int(alt) + 1000) / 25)
|
|
|
|
if bit13 is True:
|
|
tmp1 = (encalt & 0xfe0) << 2
|
|
tmp2 = (encalt & 0x010) << 1
|
|
|
|
else:
|
|
tmp1 = (encalt & 0xff8) << 1
|
|
tmp2 = 0
|
|
|
|
return (encalt & 0x0F) | tmp1 | tmp2 | (mbit << 6) | (qbit << 4)
|
|
|
|
latz = 15
|
|
|
|
def nz(self, ctype):
|
|
"""
|
|
Number of geographic latitude zones between equator and a pole. It is set to NZ = 15 for Mode-S CPR encoding
|
|
https://adsb-decode-guide.readthedocs.io/en/latest/content/cpr.html
|
|
"""
|
|
return 4 * self.latz - ctype
|
|
|
|
def dlat(self, ctype, surface):
|
|
if surface == 1:
|
|
tmp = 90.0
|
|
else:
|
|
tmp = 360.0
|
|
|
|
nzcalc = self.nz(ctype)
|
|
if nzcalc == 0:
|
|
return tmp
|
|
else:
|
|
return tmp / nzcalc
|
|
|
|
def nl(self, declat_in):
|
|
if abs(declat_in) >= 87.0:
|
|
return 1.0
|
|
return math.floor( (2.0*math.pi) * math.acos(1.0- (1.0-math.cos(math.pi/(2.0*self.latz))) / math.cos( (math.pi/180.0)*abs(declat_in) )**2 )**-1)
|
|
|
|
def dlon(self, declat_in, ctype, surface):
|
|
if surface:
|
|
tmp = 90.0
|
|
else:
|
|
tmp = 360.0
|
|
nlcalc = max(self.nl(declat_in)-ctype, 1)
|
|
return tmp / nlcalc
|
|
|
|
#encode CPR position
|
|
# https://adsb-decode-guide.readthedocs.io/en/latest/content/cpr.html
|
|
# compact position reporting
|
|
def cpr_encode(self, lat, lon, ctype, surface):
|
|
if surface is True:
|
|
scalar = 2.**19
|
|
else:
|
|
scalar = 2.**17
|
|
|
|
#encode using 360 constant for segment size.
|
|
dlati = self.dlat(ctype, False)
|
|
yz = math.floor(scalar * ((lat % dlati)/dlati) + 0.5)
|
|
rlat = dlati * ((yz / scalar) + math.floor(lat / dlati))
|
|
|
|
#encode using 360 constant for segment size.
|
|
dloni = self.dlon(lat, ctype, False)
|
|
xz = math.floor(scalar * ((lon % dloni)/dloni) + 0.5)
|
|
|
|
yz = int(yz) & (2**17-1)
|
|
xz = int(xz) & (2**17-1)
|
|
|
|
return (yz, xz) #lat, lon
|