kopia lustrzana https://github.com/projecthorus/chasemapper
Add initial log playback code.
rodzic
9b8964739f
commit
5f611d7750
|
@ -0,0 +1,169 @@
|
|||
#!/usr/bin/env python
|
||||
#
|
||||
# ChaseMapper - Log File Playback
|
||||
#
|
||||
# Copyright (C) 2019 Mark Jessop <vk5qi@rfhead.net>
|
||||
# Released under GNU GPL v3 or later
|
||||
#
|
||||
import json
|
||||
import socket
|
||||
import sys
|
||||
import time
|
||||
import datetime
|
||||
import traceback
|
||||
from dateutil.parser import *
|
||||
|
||||
|
||||
def send_bearing(json_data, udp_port=55672):
|
||||
"""
|
||||
Grab bearing data out of a json log entry and send it via UDP.
|
||||
|
||||
Example bearing line:
|
||||
{"bearing": 112.0,
|
||||
"confidence": 47.24745556875042,
|
||||
"power": 25.694795608520508,
|
||||
"raw_bearing_angles": [0.0, 1.0, ... 359.0, 360.0],
|
||||
"raw_doa": [-4.722, -4.719, ... -4.724, -4.722],
|
||||
"source": "kerberos-sdr",
|
||||
"bearing_type": "relative",
|
||||
"log_time": "2019-08-19T11:21:51.714657+00:00",
|
||||
"type": "BEARING",
|
||||
"log_type": "BEARING"}
|
||||
"""
|
||||
packet = {
|
||||
'type' : 'BEARING',
|
||||
'bearing' : json_data['bearing'],
|
||||
'confidence': json_data['confidence'],
|
||||
'power': json_data['power'],
|
||||
'raw_bearing_angles': json_data['raw_bearing_angles'],
|
||||
'raw_doa': json_data['raw_doa'],
|
||||
'bearing_type': 'relative',
|
||||
'source': 'playback'
|
||||
}
|
||||
|
||||
# Set up our UDP socket
|
||||
s = socket.socket(socket.AF_INET,socket.SOCK_DGRAM)
|
||||
s.settimeout(1)
|
||||
# Set up socket for broadcast, and allow re-use of the address
|
||||
s.setsockopt(socket.SOL_SOCKET,socket.SO_BROADCAST,1)
|
||||
s.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1)
|
||||
try:
|
||||
s.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEPORT, 1)
|
||||
except:
|
||||
pass
|
||||
s.bind(('',udp_port))
|
||||
try:
|
||||
s.sendto(json.dumps(packet), ('<broadcast>', udp_port))
|
||||
except socket.error:
|
||||
s.sendto(json.dumps(packet), ('127.0.0.1', udp_port))
|
||||
|
||||
|
||||
def send_car_position(json_data, udp_port=55672):
|
||||
"""
|
||||
Grab car position data from a json log entry and emit it
|
||||
|
||||
{"comment": "CAR",
|
||||
"log_time": "2019-08-19T11:21:52.303204+00:00",
|
||||
"lon": 138.68833,
|
||||
"log_type": "CAR POSITION",
|
||||
"time": "2019-08-19T11:21:52.300687+00:00",
|
||||
"lat": -34.71413666666667,
|
||||
"alt": 69.3,
|
||||
"speed": 17.118923473141397,
|
||||
"heading": 27.53170956683383}
|
||||
"""
|
||||
|
||||
packet = {
|
||||
'type' : 'GPS',
|
||||
'latitude' : json_data['lat'],
|
||||
'longitude' : json_data['lon'],
|
||||
'altitude': json_data['alt'],
|
||||
'speed': json_data['speed'],
|
||||
'valid': True
|
||||
}
|
||||
|
||||
# Set up our UDP socket
|
||||
s = socket.socket(socket.AF_INET,socket.SOCK_DGRAM)
|
||||
s.settimeout(1)
|
||||
# Set up socket for broadcast, and allow re-use of the address
|
||||
s.setsockopt(socket.SOL_SOCKET,socket.SO_BROADCAST,1)
|
||||
s.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1)
|
||||
try:
|
||||
s.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEPORT, 1)
|
||||
except:
|
||||
pass
|
||||
s.bind(('',udp_port))
|
||||
try:
|
||||
s.sendto(json.dumps(packet), ('<broadcast>', udp_port))
|
||||
except socket.error:
|
||||
s.sendto(json.dumps(packet), ('127.0.0.1', udp_port))
|
||||
|
||||
|
||||
def playback_json(filename, udp_port=55672, speed=1.0):
|
||||
""" Read in a JSON log file and play it back in real-time, or with a speed factor """
|
||||
|
||||
with open(filename, 'r') as _log_file:
|
||||
|
||||
try:
|
||||
_first_line = _log_file.readline()
|
||||
_log_data = json.loads(_first_line)
|
||||
_previous_time = parse(_log_data['log_time'])
|
||||
_first_time = _previous_time
|
||||
except Exception as e:
|
||||
print("First line of file must be a valid log entry - %s" % str(e))
|
||||
return
|
||||
|
||||
for _line in _log_file:
|
||||
try:
|
||||
_log_data = json.loads(_line)
|
||||
|
||||
_new_time = parse(_log_data['log_time'])
|
||||
|
||||
_time_delta = (_new_time - _previous_time).total_seconds()
|
||||
_previous_time = _new_time
|
||||
|
||||
# Running timer
|
||||
_run_time = (_new_time - _first_time).total_seconds()
|
||||
|
||||
_time_min = int(_run_time)//60
|
||||
_time_sec = _run_time%60.0
|
||||
|
||||
time.sleep(_time_delta/speed)
|
||||
|
||||
if _log_data['log_type'] == 'CAR POSITION':
|
||||
send_car_position(_log_data, udp_port)
|
||||
print("%02d:%.2f - CAR POSITION" % (_time_min, _time_sec))
|
||||
|
||||
|
||||
elif _log_data['log_type'] == 'BEARING':
|
||||
send_bearing(_log_data, udp_port)
|
||||
print("%02d:%.2f - BEARING" % (_time_min, _time_sec))
|
||||
|
||||
elif _log_data['log_type'] == 'BALLOON TELEMETRY':
|
||||
print("%02d:%.2f - BALLOON TELEMETRY" % (_time_min, _time_sec))
|
||||
|
||||
else:
|
||||
print("%02d:%.2f - UNKNOWN" % (_time_min, _time_sec))
|
||||
|
||||
except Exception as e:
|
||||
print("Invalid log entry: %s" % str(e))
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
if __name__ == '__main__':
|
||||
|
||||
filename = ""
|
||||
speed = 1.0
|
||||
hostname = 'localhost'
|
||||
udp_port = 55672
|
||||
|
||||
if len(sys.argv) == 2:
|
||||
filename = sys.argv[1]
|
||||
elif len(sys.argv) == 3:
|
||||
filename = sys.argv[1]
|
||||
speed = float(sys.argv[2])
|
||||
|
||||
playback_json(filename, udp_port, speed)
|
||||
|
|
@ -572,7 +572,7 @@
|
|||
dataType: 'json',
|
||||
async: true,
|
||||
success: function(data) {
|
||||
latest_server_time = data;
|
||||
latest_server_timestamp = data;
|
||||
restyleBearings();
|
||||
}
|
||||
});
|
||||
|
|
Ładowanie…
Reference in New Issue