2023-05-24 07:00:54 +00:00
|
|
|
# -*- coding: UTF-8 -*-
|
|
|
|
"""
|
|
|
|
|
|
|
|
@author: DJ2LS
|
|
|
|
|
|
|
|
HF mesh networking prototype and testing module
|
|
|
|
|
|
|
|
import time
|
|
|
|
MeshParam.routing_table = [['AA1AA', 'direct', 0, 1.0, 25, time.time(), ], ['AA1AA', 'AA2BB', 1, 3.1, 10, time.time(), ],
|
|
|
|
['AA3CC', 'AA2BB', 5, -4.5, -3, time.time(), ]]
|
|
|
|
|
|
|
|
print(MeshParam.routing_table)
|
|
|
|
print("---------------------------------")
|
|
|
|
|
2023-05-27 17:52:09 +00:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
TODO: SIGNALLING FOR ACK/NACK:
|
|
|
|
- mesh-signalling burst is datac13
|
2023-05-29 16:39:45 +00:00
|
|
|
- mesh-signalling frame contains [message id, status, hops, score, payload]
|
|
|
|
- frame type is 1 byte
|
|
|
|
- message id is 32bit crc --> 4bytes
|
|
|
|
- status can be ACK, NACK, PING, PINGACK --> 1byte
|
|
|
|
- payload = 14bytes - 8 bytes = 6bytes
|
2023-05-27 17:52:09 +00:00
|
|
|
- create a list for signalling frames, contains [message id, message-status, attempts, state, timestamp]
|
|
|
|
- on "IRS", send ACK/NACK 10 times on receiving beacon?
|
|
|
|
- on "ROUTER", receive ACK/NACK, and store it in table, also send it 10 times
|
|
|
|
- if sent 10 times, set ACK/NACK state to "done"
|
|
|
|
- if done already in list, don't reset retry counter
|
|
|
|
- delete ACK/NACK if "done" and timestamp older than 1day
|
|
|
|
|
2023-05-29 16:39:45 +00:00
|
|
|
TODO: SCORE CALCULATION:
|
|
|
|
SNR: negative --> * 2
|
2023-05-27 17:52:09 +00:00
|
|
|
|
2023-05-24 07:00:54 +00:00
|
|
|
"""
|
|
|
|
# pylint: disable=invalid-name, line-too-long, c-extension-no-member
|
|
|
|
# pylint: disable=import-outside-toplevel, attribute-defined-outside-init
|
|
|
|
|
2023-05-30 06:38:25 +00:00
|
|
|
from static import TNC, MeshParam, FRAME_TYPE, Station, ModemParam, ARQ
|
2023-05-26 12:25:48 +00:00
|
|
|
from codec2 import FREEDV_MODE
|
|
|
|
import numpy as np
|
2023-05-24 07:00:54 +00:00
|
|
|
import time
|
|
|
|
import threading
|
2023-05-26 12:25:48 +00:00
|
|
|
import modem
|
|
|
|
import helpers
|
2023-05-27 17:52:09 +00:00
|
|
|
import structlog
|
2023-06-11 07:12:40 +00:00
|
|
|
import ujson as json
|
2023-05-27 17:52:09 +00:00
|
|
|
|
2023-06-13 12:03:36 +00:00
|
|
|
from queues import MESH_RECEIVED_QUEUE, MESH_QUEUE_TRANSMIT, MESH_SIGNALLING_TABLE
|
2023-05-24 07:00:54 +00:00
|
|
|
|
|
|
|
class MeshRouter():
|
2023-05-26 12:25:48 +00:00
|
|
|
def __init__(self):
|
2023-05-27 17:52:09 +00:00
|
|
|
|
2023-05-27 19:00:46 +00:00
|
|
|
self.log = structlog.get_logger("RF")
|
2023-05-27 17:52:09 +00:00
|
|
|
|
2023-07-04 05:38:50 +00:00
|
|
|
self.transmission_time_list = [
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360,
|
|
|
|
30, 30, 30, 60, 60, 60, 60, 60, 60, 60, 60, 60, 120, 120, 120, 120, 120, 120, 180, 180, 180, 180, 180, 180,
|
|
|
|
360, 360, 360, 360, 360, 360
|
|
|
|
]
|
|
|
|
# for testing only: self.transmission_time_list = [30, 30]
|
|
|
|
self.signalling_max_attempts = len(self.transmission_time_list)
|
|
|
|
|
|
|
|
|
2023-05-27 17:52:09 +00:00
|
|
|
|
2023-05-26 12:25:48 +00:00
|
|
|
self.mesh_broadcasting_thread = threading.Thread(
|
|
|
|
target=self.broadcast_routing_table, name="worker thread receive", daemon=True
|
|
|
|
)
|
|
|
|
self.mesh_broadcasting_thread.start()
|
|
|
|
|
|
|
|
self.mesh_rx_dispatcher_thread = threading.Thread(
|
|
|
|
target=self.mesh_rx_dispatcher, name="worker thread receive", daemon=True
|
|
|
|
)
|
|
|
|
self.mesh_rx_dispatcher_thread.start()
|
|
|
|
|
2023-06-11 07:12:40 +00:00
|
|
|
self.mesh_tx_dispatcher_thread = threading.Thread(
|
|
|
|
target=self.mesh_tx_dispatcher, name="worker thread receive", daemon=True
|
|
|
|
)
|
|
|
|
self.mesh_tx_dispatcher_thread.start()
|
|
|
|
|
|
|
|
self.mesh_signalling_dispatcher_thread = threading.Thread(
|
|
|
|
target=self.mesh_signalling_dispatcher, name="worker thread receive", daemon=True
|
|
|
|
)
|
|
|
|
self.mesh_signalling_dispatcher_thread.start()
|
2023-05-24 07:00:54 +00:00
|
|
|
|
|
|
|
def get_from_heard_stations(self):
|
|
|
|
"""
|
|
|
|
get data from heard stations
|
|
|
|
heard stations format:
|
|
|
|
[dxcallsign,dxgrid,int(time.time()),datatype,snr,offset,frequency]
|
|
|
|
|
|
|
|
TNC.heard_stations.append(
|
|
|
|
[
|
|
|
|
dxcallsign,
|
|
|
|
dxgrid,
|
|
|
|
int(time.time()),
|
|
|
|
datatype,
|
|
|
|
snr,
|
|
|
|
offset,
|
|
|
|
frequency,
|
|
|
|
]
|
|
|
|
)
|
|
|
|
"""
|
2023-05-28 07:46:46 +00:00
|
|
|
dxcallsign_position = 0
|
|
|
|
dxgrid_position = 1
|
|
|
|
timestamp_position = 2
|
|
|
|
type_position = 3
|
|
|
|
snr_position = 4
|
|
|
|
offset_position = 5
|
|
|
|
frequency_position = 6
|
2023-05-24 07:00:54 +00:00
|
|
|
|
2023-05-28 07:23:01 +00:00
|
|
|
try:
|
|
|
|
for item in TNC.heard_stations:
|
2023-07-03 16:35:04 +00:00
|
|
|
#print("-----------")
|
|
|
|
#print(item)
|
|
|
|
#print(item[snr_position])
|
2023-05-28 07:23:01 +00:00
|
|
|
try:
|
2023-07-03 16:35:04 +00:00
|
|
|
#print(item[snr_position])
|
2023-05-28 07:46:46 +00:00
|
|
|
snr = bytes(item[snr_position], "utf-8").split(b"/")
|
2023-05-28 07:23:01 +00:00
|
|
|
snr = int(float(snr[0]))
|
2023-05-28 07:24:52 +00:00
|
|
|
except Exception as err:
|
2023-05-28 07:46:46 +00:00
|
|
|
snr = int(float(item[snr_position]))
|
2023-05-28 07:23:01 +00:00
|
|
|
|
2023-05-29 16:39:45 +00:00
|
|
|
new_router = [helpers.get_crc_24(item[dxcallsign_position]), helpers.get_crc_24(b'direct'), 0, snr, self.calculate_score_by_snr(snr), item[timestamp_position]]
|
2023-05-28 07:23:01 +00:00
|
|
|
self.add_router_to_routing_table(new_router)
|
|
|
|
except Exception as e:
|
|
|
|
self.log.warning("[MESH] error fetching data from heard station list", e=e)
|
2023-05-24 07:00:54 +00:00
|
|
|
|
|
|
|
def add_router_to_routing_table(self, new_router):
|
2023-05-28 07:30:54 +00:00
|
|
|
try:
|
|
|
|
# destination callsign # router callsign # hops # rx snr # route quality # timestamp
|
|
|
|
for _, item in enumerate(MeshParam.routing_table):
|
|
|
|
# update routing entry if exists
|
|
|
|
if new_router[0] in item[0] and new_router[1] in item[1]:
|
2023-07-03 16:35:04 +00:00
|
|
|
#print(f"UPDATE {MeshParam.routing_table[_]} >>> {new_router}")
|
|
|
|
self.log.info(f"[MESH] [ROUTING TABLE] [UPDATE]: {MeshParam.routing_table[_]} >>> ",
|
|
|
|
update=new_router)
|
|
|
|
|
2023-05-28 07:30:54 +00:00
|
|
|
MeshParam.routing_table[_] = new_router
|
|
|
|
|
|
|
|
# add new routing entry if not exists
|
|
|
|
if new_router not in MeshParam.routing_table:
|
2023-07-03 16:35:04 +00:00
|
|
|
#print(f"INSERT {new_router} >>> ROUTING TABLE")
|
2023-07-03 16:36:42 +00:00
|
|
|
self.log.info("[MESH] [ROUTING TABLE] [INSERT]:", insert=new_router)
|
2023-07-03 16:35:04 +00:00
|
|
|
|
2023-05-28 07:30:54 +00:00
|
|
|
MeshParam.routing_table.append(new_router)
|
|
|
|
except Exception as e:
|
|
|
|
self.log.warning("[MESH] error adding data to routing table", e=e, router=new_router)
|
2023-05-26 12:25:48 +00:00
|
|
|
|
2023-06-11 07:12:40 +00:00
|
|
|
def broadcast_routing_table(self, interval=600):
|
2023-05-26 12:25:48 +00:00
|
|
|
|
|
|
|
while True:
|
2023-05-29 16:51:19 +00:00
|
|
|
# always enable receiving for datac4 if broadcasting
|
|
|
|
modem.RECEIVE_DATAC4 = True
|
|
|
|
|
2023-05-28 15:33:24 +00:00
|
|
|
threading.Event().wait(1)
|
2023-07-03 16:14:50 +00:00
|
|
|
if not ARQ.arq_state and not ModemParam.channel_busy:
|
2023-05-28 15:33:24 +00:00
|
|
|
try:
|
|
|
|
|
|
|
|
# wait some time until sending routing table
|
|
|
|
threading.Event().wait(interval)
|
|
|
|
|
|
|
|
# before we are transmitting, let us update our routing table
|
|
|
|
self.get_from_heard_stations()
|
|
|
|
|
|
|
|
#[b'DJ2LS-0', 'direct', 0, 9.6, 9.6, 1684912305]
|
|
|
|
mesh_broadcast_frame_header = bytearray(4)
|
|
|
|
mesh_broadcast_frame_header[:1] = bytes([FRAME_TYPE.MESH_BROADCAST.value])
|
|
|
|
mesh_broadcast_frame_header[1:4] = helpers.get_crc_24(Station.mycallsign)
|
|
|
|
|
|
|
|
# callsign(6), router(6), hops(1), path_score(1) == 14 ==> 14 28 42 ==> 3 mesh routing entries
|
|
|
|
# callsign_crc(3), router_crc(3), hops(1), path_score(1) == 8 --> 6
|
|
|
|
# callsign_crc(3), hops(1), path_score(1) == 5 --> 10
|
|
|
|
|
|
|
|
# Create a new bytearray with a fixed length of 50
|
|
|
|
result = bytearray(50)
|
|
|
|
|
|
|
|
# Iterate over the route subarrays and add the selected entries to the result bytearray
|
|
|
|
index = 0
|
|
|
|
for route_id, route in enumerate(MeshParam.routing_table):
|
|
|
|
# the value 5 is the length of crc24 + hops + score
|
|
|
|
|
|
|
|
dxcall = MeshParam.routing_table[route_id][0]
|
|
|
|
# router = MeshParam.routing_table[i][1]
|
|
|
|
hops = MeshParam.routing_table[route_id][2]
|
|
|
|
# snr = MeshParam.routing_table[i][3]
|
|
|
|
route_score = np.clip(MeshParam.routing_table[route_id][4], 0, 254)
|
|
|
|
# timestamp = MeshParam.routing_table[i][5]
|
|
|
|
result[index:index + 5] = dxcall + bytes([hops]) + bytes([route_score])
|
|
|
|
index += 5
|
|
|
|
|
|
|
|
# Split the result bytearray into a list of fixed-length bytearrays
|
|
|
|
split_result = [result[i:i + 50] for i in range(0, len(result), 50)]
|
|
|
|
frame_list = []
|
|
|
|
for _ in split_result:
|
|
|
|
# make sure payload is always 50
|
|
|
|
_[len(_):] = bytes(50 - len(_))
|
|
|
|
#print(len(_))
|
|
|
|
frame_list.append(mesh_broadcast_frame_header + _)
|
|
|
|
|
|
|
|
TNC.transmitting = True
|
|
|
|
c2_mode = FREEDV_MODE.datac4.value
|
2023-05-30 06:40:43 +00:00
|
|
|
self.log.info("[MESH] broadcasting routing table", frame_list=frame_list, frames=len(split_result))
|
2023-05-28 15:33:24 +00:00
|
|
|
modem.MODEM_TRANSMIT_QUEUE.put([c2_mode, 1, 0, frame_list])
|
|
|
|
|
|
|
|
# Wait while transmitting
|
|
|
|
while TNC.transmitting:
|
|
|
|
threading.Event().wait(0.01)
|
|
|
|
except Exception as e:
|
|
|
|
self.log.warning("[MESH] broadcasting routing table", e=e)
|
|
|
|
|
2023-05-26 12:25:48 +00:00
|
|
|
|
|
|
|
def mesh_rx_dispatcher(self):
|
|
|
|
while True:
|
|
|
|
data_in = MESH_RECEIVED_QUEUE.get()
|
|
|
|
if int.from_bytes(data_in[:1], "big") in [FRAME_TYPE.MESH_BROADCAST.value]:
|
2023-05-26 13:36:05 +00:00
|
|
|
self.received_routing_table(data_in[:-2])
|
2023-06-11 07:12:40 +00:00
|
|
|
elif int.from_bytes(data_in[:1], "big") in [FRAME_TYPE.MESH_SIGNALLING_PING.value]:
|
|
|
|
self.received_mesh_ping(data_in[:-2])
|
2023-06-13 12:03:36 +00:00
|
|
|
elif int.from_bytes(data_in[:1], "big") in [FRAME_TYPE.MESH_SIGNALLING_PING_ACK.value]:
|
|
|
|
self.received_mesh_ping_ack(data_in[:-2])
|
|
|
|
|
2023-05-26 12:25:48 +00:00
|
|
|
else:
|
|
|
|
print("wrong mesh data received")
|
2023-07-03 16:35:04 +00:00
|
|
|
#print(data_in)
|
2023-06-11 07:12:40 +00:00
|
|
|
|
|
|
|
def mesh_tx_dispatcher(self):
|
|
|
|
while True:
|
|
|
|
data = MESH_QUEUE_TRANSMIT.get()
|
2023-07-03 16:35:04 +00:00
|
|
|
#print(data)
|
2023-06-11 07:12:40 +00:00
|
|
|
if data[0] == "PING":
|
2023-07-09 07:51:18 +00:00
|
|
|
self.add_mesh_ping_to_signalling_table(helpers.get_crc_24(data[2]).hex(), helpers.get_crc_24(data[3]).hex(), status="awaiting_ack")
|
2023-06-11 07:12:40 +00:00
|
|
|
else:
|
|
|
|
print("wrong mesh command")
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
def mesh_signalling_dispatcher(self):
|
2023-07-09 07:48:50 +00:00
|
|
|
# [timestamp, destination, origin, frametype, payload, attempt, status]
|
2023-06-13 12:03:36 +00:00
|
|
|
# --------------0------------1---------2---------3--------4---------5--------6 #
|
2023-07-03 16:14:50 +00:00
|
|
|
|
2023-07-04 05:38:50 +00:00
|
|
|
|
2023-06-11 07:12:40 +00:00
|
|
|
while True:
|
|
|
|
threading.Event().wait(1.0)
|
|
|
|
for entry in MESH_SIGNALLING_TABLE:
|
2023-07-03 16:35:04 +00:00
|
|
|
#print(entry)
|
2023-06-11 07:12:40 +00:00
|
|
|
attempt = entry[5]
|
2023-06-13 12:03:36 +00:00
|
|
|
status = entry[6]
|
2023-06-11 07:12:40 +00:00
|
|
|
# check for PING cases
|
2023-07-04 05:38:50 +00:00
|
|
|
if entry[3] in ["PING", "PING-ACK"] and attempt < len(self.transmission_time_list) and status not in ["acknowledged"]:
|
2023-06-11 07:12:40 +00:00
|
|
|
|
|
|
|
|
|
|
|
# Calculate the transmission time with exponential increase
|
2023-06-13 15:06:56 +00:00
|
|
|
#transmission_time = timestamp + (2 ** attempt) * 10
|
2023-06-16 08:27:38 +00:00
|
|
|
# Calculate transmission times for attempts 0 to 30 with stronger S-curves in minutes
|
2023-07-03 16:14:50 +00:00
|
|
|
#correction_factor = 750
|
2023-07-03 08:01:35 +00:00
|
|
|
timestamp = entry[0]
|
2023-07-03 16:14:50 +00:00
|
|
|
#transmission_time = timestamp + (4.5 / (1 + np.exp(-1. * (attempt - 5)))) * correction_factor * attempt
|
2023-07-04 05:38:50 +00:00
|
|
|
transmission_time = timestamp + sum(self.transmission_time_list[:attempt])
|
2023-06-11 07:12:40 +00:00
|
|
|
# check if it is time to transmit
|
|
|
|
if time.time() >= transmission_time:
|
|
|
|
entry[5] += 1
|
2023-07-09 07:48:50 +00:00
|
|
|
self.log.info("[MESH] [TX] Ping", destination=entry[1], origin=entry[2])
|
2023-06-13 13:15:42 +00:00
|
|
|
channel_busy_timeout = time.time() + 5
|
|
|
|
while ModemParam.channel_busy and time.time() < channel_busy_timeout:
|
|
|
|
threading.Event().wait(0.01)
|
2023-07-09 07:48:50 +00:00
|
|
|
self.transmit_mesh_signalling_ping(bytes.fromhex(entry[1]), bytes.fromhex(entry[2]))
|
2023-06-13 13:15:42 +00:00
|
|
|
#print("...")
|
2023-06-11 07:12:40 +00:00
|
|
|
|
2023-05-26 12:25:48 +00:00
|
|
|
def received_routing_table(self, data_in):
|
2023-05-27 10:56:33 +00:00
|
|
|
try:
|
|
|
|
print("data received........")
|
|
|
|
print(data_in)
|
|
|
|
|
|
|
|
router = data_in[1:4] # Extract the first 4 bytes (header)
|
|
|
|
payload = data_in[4:] # Extract the payload (excluding the header)
|
|
|
|
|
|
|
|
print("Router:", router) # Output the header bytes
|
|
|
|
|
|
|
|
for i in range(0, len(payload)-1, 5):
|
|
|
|
callsign_checksum = payload[i:i + 3] # First 3 bytes of the information (callsign_checksum)
|
2023-05-27 11:47:04 +00:00
|
|
|
hops = int.from_bytes(payload[i+3:i + 4], "big") # Fourth byte of the information (hops)
|
|
|
|
score = int.from_bytes(payload[i+4:i + 5], "big") # Fifth byte of the information (score)
|
2023-05-27 10:56:33 +00:00
|
|
|
snr = int(ModemParam.snr)
|
2023-05-29 16:39:45 +00:00
|
|
|
score = self.calculate_new_avg_score(score, self.calculate_score_by_snr(snr))
|
|
|
|
timestamp = int(time.time())
|
2023-05-27 10:56:33 +00:00
|
|
|
|
|
|
|
# use case 1: add new router to table only if callsign not empty
|
|
|
|
_use_case1 = callsign_checksum.startswith(b'\x00')
|
|
|
|
|
|
|
|
# use case 2: add new router to table only if not own callsign
|
|
|
|
_use_case2 = callsign_checksum not in [helpers.get_crc_24(Station.mycallsign)]
|
|
|
|
|
2023-05-27 12:23:46 +00:00
|
|
|
# use case 3: increment hop if router not direct
|
2023-05-27 10:56:33 +00:00
|
|
|
if router not in [helpers.get_crc_24(b'direct')] and hops == 0:
|
|
|
|
hops += 1
|
|
|
|
|
2023-05-27 12:23:46 +00:00
|
|
|
# use case 4: if callsign is directly available skip route for only keeping shortest way in db
|
|
|
|
_use_case4 = False
|
|
|
|
for _, call in enumerate(MeshParam.routing_table):
|
2023-05-27 12:26:42 +00:00
|
|
|
# check if callsign already in routing table and is direct connection
|
|
|
|
if callsign_checksum in [MeshParam.routing_table[_][0]] and MeshParam.routing_table[_][1] in [helpers.get_crc_24(b'direct')]:
|
2023-05-27 12:23:46 +00:00
|
|
|
_use_case4 = True
|
2023-05-27 11:47:04 +00:00
|
|
|
|
|
|
|
# use case N: calculate score
|
2023-05-27 10:56:33 +00:00
|
|
|
# TODO...
|
|
|
|
|
|
|
|
if not _use_case1 \
|
2023-05-27 12:23:46 +00:00
|
|
|
and _use_case2\
|
|
|
|
and not _use_case4:
|
2023-05-27 10:56:33 +00:00
|
|
|
|
2023-05-28 07:23:01 +00:00
|
|
|
print("Callsign Checksum:", callsign_checksum)
|
|
|
|
print("Hops:", hops)
|
|
|
|
print("Score:", score)
|
|
|
|
|
2023-05-27 10:56:33 +00:00
|
|
|
new_router = [callsign_checksum, router, hops, snr, score, timestamp]
|
|
|
|
print(new_router)
|
|
|
|
self.add_router_to_routing_table(new_router)
|
|
|
|
|
|
|
|
print("-------------------------")
|
|
|
|
for _, item in enumerate(MeshParam.routing_table):
|
|
|
|
print(MeshParam.routing_table[_])
|
|
|
|
print("-------------------------")
|
|
|
|
except Exception as e:
|
|
|
|
self.log.warning("[MESH] error processing received routing broadcast", e=e)
|
2023-05-29 16:39:45 +00:00
|
|
|
|
|
|
|
def calculate_score_by_snr(self, snr):
|
|
|
|
if snr < -12 or snr > 12:
|
|
|
|
raise ValueError("Value must be in the range of -12 to 12")
|
|
|
|
|
|
|
|
score = (snr + 12) * 100 / 24 # Scale the value to the range [0, 100]
|
|
|
|
if score < 0:
|
|
|
|
score = 0 # Ensure the score is not less than 0
|
|
|
|
elif score > 100:
|
|
|
|
score = 100 # Ensure the score is not greater than 100
|
|
|
|
|
|
|
|
return int(score)
|
|
|
|
|
|
|
|
def calculate_new_avg_score(self, value_old, value):
|
2023-06-11 07:12:40 +00:00
|
|
|
return int((value_old + value) / 2)
|
|
|
|
|
|
|
|
def received_mesh_ping(self, data_in):
|
2023-06-13 12:03:36 +00:00
|
|
|
destination = data_in[1:4].hex()
|
2023-07-09 07:48:50 +00:00
|
|
|
origin = data_in[4:7].hex()
|
2023-06-13 12:03:36 +00:00
|
|
|
if destination == Station.mycallsign_crc.hex():
|
2023-07-09 07:48:50 +00:00
|
|
|
self.log.info("[MESH] [RX] [PING] [REQ]", destination=destination, origin=origin, mycall=Station.mycallsign_crc.hex())
|
2023-06-13 12:03:36 +00:00
|
|
|
# use case 1: set status to acknowleding if we are the receiver of a PING
|
2023-07-09 07:48:50 +00:00
|
|
|
self.add_mesh_ping_to_signalling_table(destination, origin, status="acknowledging")
|
2023-06-13 13:15:42 +00:00
|
|
|
|
|
|
|
channel_busy_timeout = time.time() + 5
|
|
|
|
while ModemParam.channel_busy and time.time() < channel_busy_timeout:
|
|
|
|
threading.Event().wait(0.01)
|
|
|
|
|
2023-07-09 07:48:50 +00:00
|
|
|
# dxcallsign_crc = Station.mycallsign_crc
|
|
|
|
self.transmit_mesh_signalling_ping_ack(bytes.fromhex(destination), bytes.fromhex(origin))
|
2023-07-04 06:11:21 +00:00
|
|
|
|
2023-06-13 12:03:36 +00:00
|
|
|
else:
|
2023-07-09 07:48:50 +00:00
|
|
|
self.log.info("[MESH] [RX] [PING] [REQ]", destination=destination, origin=origin, mycall=Station.mycallsign_crc.hex())
|
2023-07-04 05:38:50 +00:00
|
|
|
# lookup if entry is already in database - if so, udpate and exit
|
2023-07-04 06:11:21 +00:00
|
|
|
for item in MESH_SIGNALLING_TABLE:
|
2023-07-04 05:38:50 +00:00
|
|
|
if item[1] == destination and item[5] >= self.signalling_max_attempts:
|
|
|
|
# use case 2: set status to forwarded if we are not the receiver of a PING and out of retries
|
2023-07-09 07:48:50 +00:00
|
|
|
self.add_mesh_ping_to_signalling_table(destination, origin, status="forwarded")
|
2023-07-04 05:38:50 +00:00
|
|
|
return
|
|
|
|
|
|
|
|
print("......................")
|
|
|
|
# use case 1: set status to forwarding if we are not the receiver of a PING and we don't have an entry in our database
|
2023-07-09 07:48:50 +00:00
|
|
|
self.add_mesh_ping_to_signalling_table(destination, origin, status="forwarding")
|
2023-06-13 12:03:36 +00:00
|
|
|
|
|
|
|
def received_mesh_ping_ack(self, data_in):
|
|
|
|
# TODO:
|
|
|
|
# Check if we have a ping callsign already in signalling table
|
|
|
|
# if PING, then override and make it a PING-ACK
|
|
|
|
# if not, then add to table
|
|
|
|
|
|
|
|
destination = data_in[1:4].hex()
|
2023-07-09 07:48:50 +00:00
|
|
|
origin = data_in[4:7].hex()
|
2023-06-13 12:03:36 +00:00
|
|
|
timestamp = time.time()
|
2023-07-09 07:48:50 +00:00
|
|
|
#router = ""
|
2023-06-13 12:03:36 +00:00
|
|
|
frametype = "PING-ACK"
|
|
|
|
payload = ""
|
|
|
|
attempt = 0
|
|
|
|
|
|
|
|
|
2023-06-13 13:15:42 +00:00
|
|
|
if destination == Station.mycallsign_crc.hex():
|
2023-07-09 07:48:50 +00:00
|
|
|
self.log.info("[MESH] [RX] [PING] [ACK]", destination=destination, origin=origin, mycall=Station.mycallsign_crc.hex())
|
|
|
|
self.add_mesh_ping_ack_to_signalling_table(destination, origin, status="acknowledged")
|
2023-06-13 13:15:42 +00:00
|
|
|
else:
|
2023-07-04 05:47:39 +00:00
|
|
|
#status = "forwarding"
|
2023-07-04 05:38:50 +00:00
|
|
|
#self.add_mesh_ping_ack_to_signalling_table(destination, status)
|
2023-07-03 16:35:04 +00:00
|
|
|
self.log.info("[MESH] [RX] [PING] [ACK]", destination=destination, mycall=Station.mycallsign_crc.hex())
|
2023-07-04 06:11:21 +00:00
|
|
|
for item in MESH_SIGNALLING_TABLE:
|
2023-07-04 05:38:50 +00:00
|
|
|
if item[1] == destination and item[5] >= self.signalling_max_attempts:
|
|
|
|
# use case 2: set status to forwarded if we are not the receiver of a PING and out of retries
|
|
|
|
self.add_mesh_ping_ack_to_signalling_table(destination, status="forwarded")
|
2023-07-04 06:11:21 +00:00
|
|
|
return
|
2023-07-04 05:38:50 +00:00
|
|
|
|
2023-07-09 07:48:50 +00:00
|
|
|
self.add_mesh_ping_ack_to_signalling_table(destination, origin, status="forwarding")
|
2023-07-04 06:11:21 +00:00
|
|
|
#dxcallsign_crc = bytes.fromhex(destination)
|
|
|
|
#self.transmit_mesh_signalling_ping_ack(dxcallsign_crc)
|
2023-06-13 12:03:36 +00:00
|
|
|
|
2023-06-13 13:15:42 +00:00
|
|
|
print(MESH_SIGNALLING_TABLE)
|
2023-06-13 12:03:36 +00:00
|
|
|
|
|
|
|
|
2023-07-09 07:48:50 +00:00
|
|
|
def add_mesh_ping_to_signalling_table(self, destination, origin, status):
|
2023-06-13 13:15:42 +00:00
|
|
|
timestamp = time.time()
|
2023-07-09 07:48:50 +00:00
|
|
|
#router = ""
|
2023-06-13 13:15:42 +00:00
|
|
|
frametype = "PING"
|
|
|
|
payload = ""
|
|
|
|
attempt = 0
|
|
|
|
|
2023-07-09 07:48:50 +00:00
|
|
|
# [timestamp, destination, origin, frametype, payload, attempt, status]
|
2023-06-13 13:15:42 +00:00
|
|
|
# --------------0------------1---------2---------3--------4---------5--------6-----#
|
2023-07-09 07:48:50 +00:00
|
|
|
new_entry = [timestamp, destination, origin, frametype, payload, attempt, status]
|
2023-06-13 13:15:42 +00:00
|
|
|
for _, item in enumerate(MESH_SIGNALLING_TABLE):
|
|
|
|
# update entry if exists
|
2023-06-13 12:03:36 +00:00
|
|
|
if destination in item[1] and "PING" in item[3]:
|
2023-07-04 04:42:12 +00:00
|
|
|
# reset attempts if entry exists and it failed or is acknowledged
|
2023-07-04 06:11:21 +00:00
|
|
|
attempt = 0 if item[6] in ["failed", "acknowledged"] else item[5]
|
2023-07-04 04:42:12 +00:00
|
|
|
update_entry = [item[0], destination, "", "PING", "",attempt, status]
|
2023-07-03 16:35:04 +00:00
|
|
|
#print(f"UPDATE {MESH_SIGNALLING_TABLE[_]} >>> {update_entry}")
|
|
|
|
|
|
|
|
self.log.info(f"[MESH] [SIGNALLING TABLE] [UPDATE]: {MESH_SIGNALLING_TABLE[_]} >>> ", update=update_entry)
|
|
|
|
|
2023-06-13 12:03:36 +00:00
|
|
|
MESH_SIGNALLING_TABLE[_] = update_entry
|
|
|
|
return
|
|
|
|
|
2023-06-13 13:15:42 +00:00
|
|
|
# add new routing entry if not exists
|
2023-06-13 12:03:36 +00:00
|
|
|
if new_entry not in MESH_SIGNALLING_TABLE:
|
2023-07-03 16:35:04 +00:00
|
|
|
#print(f"INSERT {new_entry} >>> SIGNALLING TABLE")
|
2023-07-03 16:36:42 +00:00
|
|
|
self.log.info("[MESH] [SIGNALLING TABLE] [INSERT]:", insert=new_entry)
|
2023-07-03 16:35:04 +00:00
|
|
|
|
2023-06-13 12:03:36 +00:00
|
|
|
MESH_SIGNALLING_TABLE.append(new_entry)
|
|
|
|
|
2023-07-09 07:48:50 +00:00
|
|
|
def add_mesh_ping_ack_to_signalling_table(self, destination, origin, status):
|
2023-06-13 13:15:42 +00:00
|
|
|
|
2023-06-11 07:12:40 +00:00
|
|
|
timestamp = time.time()
|
2023-07-09 07:48:50 +00:00
|
|
|
#router = ""
|
2023-06-13 13:15:42 +00:00
|
|
|
frametype = "PING-ACK"
|
2023-06-11 07:12:40 +00:00
|
|
|
payload = ""
|
|
|
|
attempt = 0
|
2023-07-09 07:48:50 +00:00
|
|
|
new_entry = [timestamp, destination, origin, frametype, payload, attempt, status]
|
2023-06-13 13:15:42 +00:00
|
|
|
|
2023-06-11 07:12:40 +00:00
|
|
|
for _, item in enumerate(MESH_SIGNALLING_TABLE):
|
2023-06-13 12:03:36 +00:00
|
|
|
# update entry if exists
|
2023-07-04 06:11:21 +00:00
|
|
|
if destination in item[1] and item[3] in ["PING", "PING-ACK"]:
|
2023-07-04 04:42:12 +00:00
|
|
|
# reset attempts if entry exists and it failed or is acknowledged
|
2023-07-04 06:11:21 +00:00
|
|
|
attempt = 0 if item[6] in ["failed", "acknowledged"] else item[5]
|
2023-07-04 04:42:12 +00:00
|
|
|
update_entry = [item[0], destination, "", "PING-ACK", "", attempt, status]
|
2023-07-03 16:35:04 +00:00
|
|
|
#print(f"UPDATE {MESH_SIGNALLING_TABLE[_]} >>> {update_entry}")
|
|
|
|
self.log.info(f"[MESH] [SIGNALLING TABLE] [UPDATE]: {MESH_SIGNALLING_TABLE[_]} >>> ", update=update_entry)
|
|
|
|
|
2023-06-13 12:03:36 +00:00
|
|
|
MESH_SIGNALLING_TABLE[_] = update_entry
|
|
|
|
return
|
2023-06-11 07:12:40 +00:00
|
|
|
|
|
|
|
# add new routing entry if not exists
|
|
|
|
if new_entry not in MESH_SIGNALLING_TABLE:
|
2023-07-03 16:35:04 +00:00
|
|
|
#print(f"INSERT {new_entry} >>> SIGNALLING TABLE")
|
|
|
|
self.log.info(f"[MESH] [SIGNALLING TABLE] [INSERT]: {MESH_SIGNALLING_TABLE[_]} >>> ", update=new_entry)
|
|
|
|
|
2023-06-11 07:12:40 +00:00
|
|
|
MESH_SIGNALLING_TABLE.append(new_entry)
|
|
|
|
|
|
|
|
def enqueue_frame_for_tx(
|
|
|
|
self,
|
|
|
|
frame_to_tx, # : list[bytearray], # this causes a crash on python 3.7
|
|
|
|
c2_mode=FREEDV_MODE.sig0.value,
|
|
|
|
copies=1,
|
|
|
|
repeat_delay=0,
|
|
|
|
) -> None:
|
|
|
|
"""
|
|
|
|
Send (transmit) supplied frame to TNC
|
|
|
|
|
|
|
|
:param frame_to_tx: Frame data to send
|
|
|
|
:type frame_to_tx: list of bytearrays
|
|
|
|
:param c2_mode: Codec2 mode to use, defaults to datac13
|
|
|
|
:type c2_mode: int, optional
|
|
|
|
:param copies: Number of frame copies to send, defaults to 1
|
|
|
|
:type copies: int, optional
|
|
|
|
:param repeat_delay: Delay time before sending repeat frame, defaults to 0
|
|
|
|
:type repeat_delay: int, optional
|
|
|
|
"""
|
|
|
|
#print(frame_to_tx[0])
|
|
|
|
#print(frame_to_tx)
|
|
|
|
frame_type = FRAME_TYPE(int.from_bytes(frame_to_tx[0][:1], byteorder="big")).name
|
|
|
|
self.log.debug("[TNC] enqueue_frame_for_tx", c2_mode=FREEDV_MODE(c2_mode).name, data=frame_to_tx,
|
|
|
|
type=frame_type)
|
|
|
|
|
|
|
|
# Set the TRANSMITTING flag before adding an object to the transmit queue
|
|
|
|
# TODO: This is not that nice, we could improve this somehow
|
|
|
|
TNC.transmitting = True
|
|
|
|
modem.MODEM_TRANSMIT_QUEUE.put([c2_mode, copies, repeat_delay, frame_to_tx])
|
|
|
|
|
|
|
|
# Wait while transmitting
|
|
|
|
while TNC.transmitting:
|
|
|
|
threading.Event().wait(0.01)
|
|
|
|
|
|
|
|
|
2023-07-09 07:48:50 +00:00
|
|
|
def transmit_mesh_signalling_ping(self, destination, origin):
|
2023-06-11 07:12:40 +00:00
|
|
|
|
|
|
|
frame_type = bytes([FRAME_TYPE.MESH_SIGNALLING_PING.value])
|
|
|
|
|
|
|
|
ping_frame = bytearray(14)
|
|
|
|
ping_frame[:1] = frame_type
|
2023-07-09 07:48:50 +00:00
|
|
|
ping_frame[1:4] = destination
|
|
|
|
ping_frame[4:7] = origin
|
2023-06-11 07:12:40 +00:00
|
|
|
ping_frame[7:13] = helpers.callsign_to_bytes(Station.mycallsign)
|
|
|
|
|
2023-06-13 12:03:36 +00:00
|
|
|
self.enqueue_frame_for_tx([ping_frame], c2_mode=FREEDV_MODE.sig0.value)
|
|
|
|
|
2023-07-09 07:48:50 +00:00
|
|
|
def transmit_mesh_signalling_ping_ack(self, destination, origin):
|
2023-06-13 12:03:36 +00:00
|
|
|
#dxcallsign_crc = bytes.fromhex(data[1])
|
|
|
|
|
|
|
|
frame_type = bytes([FRAME_TYPE.MESH_SIGNALLING_PING_ACK.value])
|
|
|
|
|
|
|
|
ping_frame = bytearray(14)
|
|
|
|
ping_frame[:1] = frame_type
|
2023-07-09 07:48:50 +00:00
|
|
|
ping_frame[1:4] = destination
|
|
|
|
ping_frame[4:7] = origin
|
2023-06-13 12:03:36 +00:00
|
|
|
#ping_frame[7:13] = helpers.callsign_to_bytes(Station.mycallsign)
|
|
|
|
|
2023-06-11 07:12:40 +00:00
|
|
|
self.enqueue_frame_for_tx([ping_frame], c2_mode=FREEDV_MODE.sig0.value)
|