You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
46 lines
1.9 KiB
46 lines
1.9 KiB
""" simplest implementation of a trajectory simulation where the simulated
|
|
aircraft is randomly distributed inside a circle
|
|
|
|
mutex protection occurs when calling replace_message
|
|
|
|
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/>.
|
|
"""
|
|
|
|
import random
|
|
import datetime, math
|
|
from AbstractTrajectorySimulatorBase import AbstractTrajectorySimulatorBase
|
|
|
|
class RandomTrajectorySimulator(AbstractTrajectorySimulatorBase):
|
|
def __init__(self,mutex,broadcast_thread,aircrafinfos):
|
|
super().__init__(mutex,broadcast_thread,aircrafinfos)
|
|
self._starttime = datetime.datetime.now(datetime.timezone.utc)
|
|
|
|
self._lat0 = aircrafinfos.lat_deg
|
|
self._lon0 = aircrafinfos.lon_deg
|
|
|
|
self._max_alt_m = aircrafinfos.alt_msl_m
|
|
self._max_speed_mps = aircrafinfos.speed_mps
|
|
|
|
def refresh_delay(self):
|
|
return 0.005
|
|
|
|
def update_aircraftinfos(self):
|
|
|
|
d0 = self._max_speed_mps * 30.0
|
|
Rlat = (d0/6371000.0)*(180.0/math.pi)
|
|
Rlon = Rlat/math.cos(self._lat0*math.pi/180.0)
|
|
self._aircraftinfos.track_angle_deg = random.uniform(0,360.0)
|
|
self._aircraftinfos.lat_deg = self._lat0 - random.uniform(-Rlat,Rlat)
|
|
self._aircraftinfos.lon_deg = self._lon0 + random.uniform(-Rlon,Rlon)
|
|
|
|
self._aircraftinfos.alt_msl_m = random.uniform(1.0,self._max_alt_m)
|
|
self._aircraftinfos.speed_mps = random.uniform(0.0,self._max_speed_mps)
|