2010-10-19 00:59:08 +08:00
|
|
|
#
|
|
|
|
# Copyright 2010 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.
|
|
|
|
#
|
|
|
|
|
2012-10-06 23:44:33 +08:00
|
|
|
import time, os, sys, threading
|
2010-09-15 13:01:56 +08:00
|
|
|
from string import split, join
|
2012-07-17 10:27:09 +08:00
|
|
|
import air_modes
|
2010-10-18 13:17:48 +08:00
|
|
|
import sqlite3
|
2012-07-17 10:27:09 +08:00
|
|
|
from air_modes.exceptions import *
|
2013-05-30 05:18:15 +08:00
|
|
|
import zmq
|
2010-10-18 13:17:48 +08:00
|
|
|
|
2013-05-30 05:18:15 +08:00
|
|
|
class output_sql(air_modes.parse, threading.Thread):
|
2013-06-03 20:38:26 +08:00
|
|
|
def __init__(self, mypos, filename, context, addr=None, port=None):
|
2013-05-30 05:18:15 +08:00
|
|
|
threading.Thread.__init__(self)
|
2012-07-17 10:27:09 +08:00
|
|
|
air_modes.parse.__init__(self, mypos)
|
2012-10-06 23:44:33 +08:00
|
|
|
|
2013-05-30 05:18:15 +08:00
|
|
|
#init socket
|
|
|
|
self._subscriber = context.socket(zmq.SUB)
|
2013-05-30 15:58:03 +08:00
|
|
|
if addr is not None:
|
2013-06-03 20:38:26 +08:00
|
|
|
self._subscriber.connect("tcp://%s:%i" % (addr, port))
|
2013-05-30 15:58:03 +08:00
|
|
|
else:
|
|
|
|
self._subscriber.connect("inproc://modes-radio-pub")
|
2013-05-30 05:18:15 +08:00
|
|
|
self._subscriber.setsockopt(zmq.SUBSCRIBE, "dl_data")
|
|
|
|
|
|
|
|
self._lock = threading.Lock()
|
2013-05-30 15:58:03 +08:00
|
|
|
#create the database
|
|
|
|
self.filename = filename
|
|
|
|
self._db = sqlite3.connect(filename)
|
|
|
|
#now execute a schema to create the tables you need
|
|
|
|
c = self._db.cursor()
|
|
|
|
query = """CREATE TABLE IF NOT EXISTS "positions" (
|
|
|
|
"icao" INTEGER KEY NOT NULL,
|
|
|
|
"seen" TEXT NOT NULL,
|
|
|
|
"alt" INTEGER,
|
|
|
|
"lat" REAL,
|
|
|
|
"lon" REAL
|
|
|
|
);"""
|
|
|
|
c.execute(query)
|
|
|
|
query = """CREATE TABLE IF NOT EXISTS "vectors" (
|
|
|
|
"icao" INTEGER KEY NOT NULL,
|
|
|
|
"seen" TEXT NOT NULL,
|
|
|
|
"speed" REAL,
|
|
|
|
"heading" REAL,
|
|
|
|
"vertical" REAL
|
|
|
|
);"""
|
|
|
|
c.execute(query)
|
|
|
|
query = """CREATE TABLE IF NOT EXISTS "ident" (
|
|
|
|
"icao" INTEGER PRIMARY KEY NOT NULL,
|
|
|
|
"ident" TEXT NOT NULL
|
|
|
|
);"""
|
|
|
|
c.execute(query)
|
|
|
|
c.close()
|
|
|
|
self._db.commit()
|
|
|
|
#we close the db conn now to reopen it in the output() thread context.
|
|
|
|
self._db.close()
|
|
|
|
self._db = None
|
2013-05-30 05:18:15 +08:00
|
|
|
|
2013-05-30 15:58:03 +08:00
|
|
|
self.setDaemon(True)
|
|
|
|
self.done = False
|
|
|
|
self.start()
|
2013-05-30 05:18:15 +08:00
|
|
|
|
|
|
|
def run(self):
|
|
|
|
while not self.done:
|
|
|
|
[address, msg] = self._subscriber.recv_multipart() #blocking
|
|
|
|
try:
|
|
|
|
self.insert(msg)
|
|
|
|
except ADSBError:
|
|
|
|
pass
|
2010-10-18 13:17:48 +08:00
|
|
|
|
2013-05-30 05:18:15 +08:00
|
|
|
self._subscriber.close()
|
|
|
|
self._db = None
|
2010-10-18 13:17:48 +08:00
|
|
|
|
2013-05-30 05:18:15 +08:00
|
|
|
def insert(self, message):
|
2012-10-10 00:26:16 +08:00
|
|
|
with self._lock:
|
|
|
|
try:
|
|
|
|
#we're checking to see if the db is empty, and creating the db object
|
|
|
|
#if it is. the reason for this is so that the db writing is done within
|
|
|
|
#the thread context of output(), rather than the thread context of the
|
2013-05-30 05:18:15 +08:00
|
|
|
#constructor.
|
|
|
|
if self._db is None:
|
|
|
|
self._db = sqlite3.connect(self.filename)
|
2012-07-06 14:52:00 +08:00
|
|
|
|
2012-10-10 00:26:16 +08:00
|
|
|
query = self.make_insert_query(message)
|
|
|
|
if query is not None:
|
2013-05-30 05:18:15 +08:00
|
|
|
c = self._db.cursor()
|
2012-10-10 00:26:16 +08:00
|
|
|
c.execute(query)
|
|
|
|
c.close()
|
2013-05-30 05:18:15 +08:00
|
|
|
self._db.commit()
|
2012-10-08 08:54:03 +08:00
|
|
|
|
2012-10-10 00:26:16 +08:00
|
|
|
except ADSBError:
|
|
|
|
pass
|
2012-06-20 06:43:43 +08:00
|
|
|
|
2010-10-18 15:14:28 +08:00
|
|
|
def make_insert_query(self, message):
|
2010-10-18 13:17:48 +08:00
|
|
|
#assembles a SQL query tailored to our database
|
|
|
|
#this version ignores anything that isn't Type 17 for now, because we just don't care
|
2012-06-27 14:27:58 +08:00
|
|
|
[data, ecc, reference, timestamp] = message.split()
|
2010-10-18 13:17:48 +08:00
|
|
|
|
2012-07-17 10:27:09 +08:00
|
|
|
data = air_modes.modes_reply(long(data, 16))
|
2010-10-18 13:17:48 +08:00
|
|
|
ecc = long(ecc, 16)
|
2012-07-14 00:43:22 +08:00
|
|
|
# reference = float(reference)
|
2010-10-18 13:17:48 +08:00
|
|
|
query = None
|
2012-06-27 14:27:58 +08:00
|
|
|
msgtype = data["df"]
|
2010-10-18 13:17:48 +08:00
|
|
|
if msgtype == 17:
|
2012-07-14 00:43:22 +08:00
|
|
|
query = self.sql17(data)
|
2010-10-18 13:17:48 +08:00
|
|
|
|
|
|
|
return query
|
|
|
|
|
2012-07-14 00:43:22 +08:00
|
|
|
def sql17(self, data):
|
2012-06-27 14:27:58 +08:00
|
|
|
icao24 = data["aa"]
|
2012-07-17 00:16:48 +08:00
|
|
|
bdsreg = data["me"].get_type()
|
2012-07-14 00:43:22 +08:00
|
|
|
|
2012-07-17 00:16:48 +08:00
|
|
|
if bdsreg == 0x08:
|
2012-07-14 00:43:22 +08:00
|
|
|
(msg, typename) = self.parseBDS08(data)
|
2013-05-30 16:06:53 +08:00
|
|
|
return "INSERT OR REPLACE INTO ident (icao, ident) VALUES (" + "%i" % icao24 + ", '" + msg + "')"
|
2012-07-17 00:16:48 +08:00
|
|
|
elif bdsreg == 0x06:
|
2012-06-27 14:27:58 +08:00
|
|
|
[ground_track, decoded_lat, decoded_lon, rnge, bearing] = self.parseBDS06(data)
|
|
|
|
altitude = 0
|
2010-10-18 13:17:48 +08:00
|
|
|
if decoded_lat is None: #no unambiguously valid position available
|
2013-05-30 16:06:53 +08:00
|
|
|
raise CPRNoPositionError
|
2010-10-18 13:17:48 +08:00
|
|
|
else:
|
2013-05-30 16:06:53 +08:00
|
|
|
return "INSERT INTO positions (icao, seen, alt, lat, lon) VALUES (" + "%i" % icao24 + ", datetime('now'), " + str(altitude) + ", " + "%.6f" % decoded_lat + ", " + "%.6f" % decoded_lon + ")"
|
2012-07-17 00:16:48 +08:00
|
|
|
elif bdsreg == 0x05:
|
2012-06-27 14:27:58 +08:00
|
|
|
[altitude, decoded_lat, decoded_lon, rnge, bearing] = self.parseBDS05(data)
|
2010-10-18 13:17:48 +08:00
|
|
|
if decoded_lat is None: #no unambiguously valid position available
|
2013-05-30 16:06:53 +08:00
|
|
|
raise CPRNoPositionError
|
2010-10-18 13:17:48 +08:00
|
|
|
else:
|
2013-05-30 16:06:53 +08:00
|
|
|
return "INSERT INTO positions (icao, seen, alt, lat, lon) VALUES (" + "%i" % icao24 + ", datetime('now'), " + str(altitude) + ", " + "%.6f" % decoded_lat + ", " + "%.6f" % decoded_lon + ")"
|
2012-07-17 00:16:48 +08:00
|
|
|
elif bdsreg == 0x09:
|
|
|
|
subtype = data["bds09"].get_type()
|
2012-07-22 02:12:19 +08:00
|
|
|
if subtype == 0:
|
|
|
|
[velocity, heading, vert_spd, turnrate] = self.parseBDS09_0(data)
|
2013-05-30 16:06:53 +08:00
|
|
|
return "INSERT INTO vectors (icao, seen, speed, heading, vertical) VALUES (" + "%i" % icao24 + ", datetime('now'), " + "%.0f" % velocity + ", " + "%.0f" % heading + ", " + "%.0f" % vert_spd + ")"
|
2012-07-22 02:12:19 +08:00
|
|
|
elif subtype == 1:
|
|
|
|
[velocity, heading, vert_spd] = self.parseBDS09_1(data)
|
2013-05-30 16:06:53 +08:00
|
|
|
return "INSERT INTO vectors (icao, seen, speed, heading, vertical) VALUES (" + "%i" % icao24 + ", datetime('now'), " + "%.0f" % velocity + ", " + "%.0f" % heading + ", " + "%.0f" % vert_spd + ")"
|
2012-07-22 02:12:19 +08:00
|
|
|
else:
|
2013-05-30 16:06:53 +08:00
|
|
|
raise NoHandlerError
|