2016-07-20 17:16:27 -04:00
#!/usr/bin/env python
#
# This work is licensed under the Creative Attribution-NonCommercial-ShareAlike
# 3.0 Unported License.To view a copy of this license, visit
# http://creativecommons.org/licenses/by-nc-sa/3.0/ or send a letter to
# Creative Commons, 444 Castro Street, Suite 900, Mountain View,
# California, 94041, USA.
from __future__ import print_function
2016-07-20 22:25:47 -04:00
# Python modules we need
2016-07-20 17:16:27 -04:00
import argparse
import sys
import os
2016-07-23 16:53:22 -04:00
import signal
2016-07-20 17:16:27 -04:00
2016-07-20 22:25:47 -04:00
# Specifig functions from modules we need
2016-07-20 17:16:27 -04:00
from binascii import b2a_hex as h
2016-07-21 20:06:04 -04:00
from binascii import a2b_hex as a
2016-07-20 22:25:47 -04:00
from socket import gethostbyname
2016-07-21 13:41:36 -04:00
from random import randint
2016-07-21 17:14:42 -04:00
from hashlib import sha256
2016-07-24 10:42:42 -04:00
from time import time
2016-07-30 12:28:49 -04:00
from bitstring import BitArray
import socket
2016-07-21 13:41:36 -04:00
# Debugging functions
2016-07-20 22:25:47 -04:00
from pprint import pprint
2016-07-20 17:16:27 -04:00
2016-07-20 22:25:47 -04:00
# Twisted is pretty important, so I keep it separate
2016-07-20 17:16:27 -04:00
from twisted . internet . protocol import DatagramProtocol
from twisted . internet import reactor
2016-07-21 13:41:36 -04:00
from twisted . internet import task
2016-07-20 17:16:27 -04:00
2016-07-20 22:25:47 -04:00
# Other files we pull from -- this is mostly for readability and segmentation
import hb_log
import hb_config
# Does anybody read this stuff? There's a PEP somewhere that says I should do this.
2016-07-20 17:16:27 -04:00
__author__ = ' Cortney T. Buffington, N0MJS '
2016-07-30 21:37:05 -04:00
__copyright__ = ' Copyright (c) 2016 Cortney T. Buffington, N0MJS and the K0USY Group '
2016-07-23 16:53:22 -04:00
__credits__ = ' Colin Durbridge, G4EML, Steve Zingman, N4IRS; Mike Zingman, N4IRR; Jonathan Naylor, G4KLX; Hans Barthen, DL5DI; Torsten Shultze, DG1HT '
2016-07-20 17:16:27 -04:00
__license__ = ' Creative Commons Attribution-NonCommercial-ShareAlike 3.0 Unported '
__maintainer__ = ' Cort Buffington, N0MJS '
__email__ = ' n0mjs@me.com '
__status__ = ' pre-alpha '
2016-07-20 22:25:47 -04:00
2016-07-31 10:41:21 -04:00
# Global variables used whether we are a module or __main__
masters = { }
clients = { }
2016-07-20 17:16:27 -04:00
# Change the current directory to the location of the application
os . chdir ( os . path . dirname ( os . path . realpath ( sys . argv [ 0 ] ) ) )
2016-07-20 22:25:47 -04:00
# CLI argument parser - handles picking up the config file from the command line, and sending a "help" message
parser = argparse . ArgumentParser ( )
parser . add_argument ( ' -c ' , ' --config ' , action = ' store ' , dest = ' CONFIG_FILE ' , help = ' /full/path/to/config.file (usually hblink.cfg) ' )
parser . add_argument ( ' -l ' , ' --logging ' , action = ' store ' , dest = ' LOG_LEVEL ' , help = ' Override config file logging level. ' )
2016-07-20 17:16:27 -04:00
cli_args = parser . parse_args ( )
2016-07-20 22:25:47 -04:00
# Ensure we have a path for the config file, if one wasn't specified, then use the execution directory
if not cli_args . CONFIG_FILE :
cli_args . CONFIG_FILE = os . path . dirname ( os . path . abspath ( __file__ ) ) + ' /hblink.cfg '
2016-07-20 17:16:27 -04:00
2016-07-20 22:25:47 -04:00
# Call the external routine to build the configuration dictionary
CONFIG = hb_config . build_config ( cli_args . CONFIG_FILE )
# Call the external routing to start the system logger
if cli_args . LOG_LEVEL :
CONFIG [ ' LOGGER ' ] [ ' LOG_LEVEL ' ] = cli_args . LOG_LEVEL
logger = hb_log . config_logging ( CONFIG [ ' LOGGER ' ] )
logger . debug ( ' Logging system started, anything from here on gets logged ' )
2016-07-30 12:28:49 -04:00
2016-07-23 16:53:22 -04:00
# Shut ourselves down gracefully by disconnecting from the masters and clients.
def handler ( _signal , _frame ) :
logger . info ( ' *** HBLINK IS TERMINATING WITH SIGNAL %s *** ' , str ( _signal ) )
for client in clients :
this_client = clients [ client ]
this_client . send_packet ( ' RPTCL ' + CONFIG [ ' CLIENTS ' ] [ client ] [ ' RADIO_ID ' ] )
logger . info ( ' ( %s ) De-Registering From the Master ' , client )
2016-07-24 10:42:42 -04:00
for master in masters :
this_master = masters [ master ]
2016-07-30 19:42:17 -04:00
for client in CONFIG [ ' MASTERS ' ] [ master ] [ ' CLIENTS ' ] :
2016-07-24 13:07:43 -04:00
this_master . send_packet ( client , ' MSTCL ' + client )
logger . info ( ' ( %s ) Sending De-Registration to Client: %s ' , master , CONFIG [ ' MASTERS ' ] [ master ] [ ' CLIENTS ' ] [ client ] [ ' RADIO_ID ' ] )
2016-07-23 16:53:22 -04:00
reactor . stop ( )
2016-07-20 17:16:27 -04:00
2016-07-23 16:53:22 -04:00
# Set signal handers so that we can gracefully exit if need be
for sig in [ signal . SIGTERM , signal . SIGINT , signal . SIGQUIT ] :
signal . signal ( sig , handler )
2016-07-20 17:16:27 -04:00
2016-07-24 10:42:42 -04:00
#************************************************
# UTILITY FUNCTIONS
#************************************************
2016-07-31 10:41:21 -04:00
# Create a 3 byte hex string from an integer
def hex_str_3 ( _int_id ) :
try :
return hex ( _int_id ) [ 2 : ] . rjust ( 6 , ' 0 ' ) . decode ( ' hex ' )
except TypeError :
logger . error ( ' hex_str_3: invalid integer length ' )
2016-07-24 13:07:43 -04:00
# Create a 4 byte hex string from an integer
def hex_str_4 ( _int_id ) :
try :
return hex ( _int_id ) [ 2 : ] . rjust ( 8 , ' 0 ' ) . decode ( ' hex ' )
except TypeError :
logger . error ( ' hex_str_4: invalid integer length ' )
2016-07-27 22:56:33 -04:00
# Convert a hex string to an int (radio ID, etc.)
def int_id ( _hex_string ) :
return int ( h ( _hex_string ) , 16 )
2016-07-30 12:28:49 -04:00
#************************************************
# AMBE CLASS: Used to parse out AMBE and send to gateway
#************************************************
class AMBE :
_sock = socket . socket ( socket . AF_INET , socket . SOCK_DGRAM )
2016-07-30 21:37:05 -04:00
_exp_ip = CONFIG [ ' AMBE ' ] [ ' EXPORT_IP ' ]
_exp_port = CONFIG [ ' AMBE ' ] [ ' EXPORT_PORT ' ]
2016-07-30 12:28:49 -04:00
def parseAMBE ( self , _client , _data ) :
_seq = int_id ( _data [ 4 : 5 ] )
_srcID = int_id ( _data [ 5 : 8 ] )
_dstID = int_id ( _data [ 8 : 11 ] )
_rptID = int_id ( _data [ 11 : 15 ] )
_bits = int_id ( _data [ 15 : 16 ] ) # SCDV NNNN (Slot|Call type|Data|Voice|Seq or Data type)
_slot = 2 if _bits & 0x80 else 1
_callType = 1 if ( _bits & 0x40 ) else 0
_frameType = ( _bits & 0x30 ) >> 4
_voiceSeq = ( _bits & 0x0f )
_streamID = int_id ( _data [ 16 : 20 ] )
logger . debug ( ' ( %s ) seq: %d srcID: %d dstID: %d rptID: %d bits: %0X slot: %d callType: %d frameType: %d voiceSeq: %d streamID: %0X ' ,
_client , _seq , _srcID , _dstID , _rptID , _bits , _slot , _callType , _frameType , _voiceSeq , _streamID )
#logger.debug('Frame 1:(%s)', self.ByteToHex(_data))
_dmr_frame = BitArray ( ' 0x ' + h ( _data [ 20 : ] ) )
_ambe = _dmr_frame [ 0 : 108 ] + _dmr_frame [ 156 : 264 ]
#_sock.sendto(_ambe.tobytes(), ("127.0.0.1", 31000))
ambeBytes = _ambe . tobytes ( )
2016-07-30 21:37:05 -04:00
self . _sock . sendto ( ambeBytes [ 0 : 9 ] , ( self . _exp_ip , self . _exp_port ) )
self . _sock . sendto ( ambeBytes [ 9 : 18 ] , ( self . _exp_ip , self . _exp_port ) )
self . _sock . sendto ( ambeBytes [ 18 : 27 ] , ( self . _exp_ip , self . _exp_port ) )
2016-07-30 12:28:49 -04:00
2016-07-20 17:16:27 -04:00
#************************************************
2016-07-24 10:42:42 -04:00
# HB MASTER CLASS
2016-07-20 17:16:27 -04:00
#************************************************
class HBMASTER ( DatagramProtocol ) :
def __init__ ( self , * args , * * kwargs ) :
2016-07-24 10:42:42 -04:00
if len ( args ) == 1 :
2016-07-26 21:51:04 -04:00
# Define a few shortcuts to make the rest of the class more readable
2016-07-24 10:42:42 -04:00
self . _master = args [ 0 ]
self . _config = CONFIG [ ' MASTERS ' ] [ self . _master ]
self . _clients = CONFIG [ ' MASTERS ' ] [ self . _master ] [ ' CLIENTS ' ]
2016-07-30 21:37:05 -04:00
# Configure for AMBE audio export if enabled
if self . _config [ ' EXPORT_AMBE ' ] :
self . _ambe = AMBE ( )
2016-07-24 10:42:42 -04:00
else :
2016-07-26 21:51:04 -04:00
# If we didn't get called correctly, log it and quit.
2016-07-24 10:42:42 -04:00
logger . error ( ' ( %s ) HBMASTER was not called with an argument. Terminating ' , self . _master )
sys . exit ( )
2016-07-21 13:41:36 -04:00
def startProtocol ( self ) :
2016-07-24 10:42:42 -04:00
# Set up periodic loop for tracking pings from clients. Run every 'PING_TIME' seconds
self . _master_maintenance = task . LoopingCall ( self . master_maintenance_loop )
self . _master_maintenance_loop = self . _master_maintenance . start ( CONFIG [ ' GLOBAL ' ] [ ' PING_TIME ' ] )
2016-07-21 13:41:36 -04:00
2016-07-24 10:42:42 -04:00
def master_maintenance_loop ( self ) :
2016-07-24 21:16:19 -04:00
logger . debug ( ' ( %s ) Master maintenance loop started ' , self . _master )
2016-07-30 19:42:17 -04:00
for client in self . _clients :
2016-07-24 13:07:43 -04:00
_this_client = self . _clients [ client ]
2016-07-26 21:51:04 -04:00
# Check to see if any of the clients have been quiet (no ping) longer than allowed
2016-07-24 13:07:43 -04:00
if _this_client [ ' LAST_PING ' ] + CONFIG [ ' GLOBAL ' ] [ ' PING_TIME ' ] * CONFIG [ ' GLOBAL ' ] [ ' MAX_MISSED ' ] < time ( ) :
logger . info ( ' ( %s ) Client %s has timed out ' , self . _master , _this_client [ ' RADIO_ID ' ] )
2016-07-26 21:51:04 -04:00
# Remove any timed out clients from the configuration
2016-07-24 21:16:19 -04:00
del CONFIG [ ' MASTERS ' ] [ self . _master ] [ ' CLIENTS ' ] [ client ]
2016-08-02 09:10:52 -04:00
def send_clients ( self , _packet ) :
for _client in self . _clients :
2016-08-02 19:23:04 -04:00
self . send_packet ( _client , _packet )
2016-08-03 05:41:38 -04:00
#logger.debug('(%s) Packet sent to client %s', self._master, self._clients[_client]['RADIO_ID'])
2016-08-02 09:10:52 -04:00
2016-07-24 10:42:42 -04:00
def send_packet ( self , _client , _packet ) :
2016-07-30 19:42:17 -04:00
_ip = self . _clients [ _client ] [ ' IP ' ]
_port = self . _clients [ _client ] [ ' PORT ' ]
self . transport . write ( _packet , ( _ip , _port ) )
2016-07-24 10:42:42 -04:00
# KEEP THE FOLLOWING COMMENTED OUT UNLESS YOU'RE DEBUGGING DEEPLY!!!!
2016-07-30 11:00:00 -04:00
#logger.debug('(%s) TX Packet to %s on port %s: %s', self._clients[_client]['RADIO_ID'], self._clients[_client]['IP'], self._clients[_client]['PORT'], h(_packet))
2016-07-27 19:07:01 -04:00
2016-07-31 10:41:21 -04:00
def dmrd_received ( self , _radio_id , _rf_src , _dst_id , _seq , _data ) :
pass
2016-07-30 19:42:17 -04:00
2016-07-24 10:42:42 -04:00
def datagramReceived ( self , _data , ( _host , _port ) ) :
2016-08-01 22:30:40 -04:00
# Keep This Line Commented Unless HEAVILY Debugging!
# logger.debug('(%s) RX packet from %s:%s -- %s', self._client, _host, _port, h(_data))
# Extract the command, which is various length, all but one 4 significant characters -- RPTCL
_command = _data [ : 4 ]
if _command == ' DMRD ' : # DMRData -- encapsulated DMR data frame
_radio_id = _data [ 11 : 15 ]
if _radio_id in self . _clients \
and self . _clients [ _radio_id ] [ ' CONNECTION ' ] == ' YES ' \
and self . _clients [ _radio_id ] [ ' IP ' ] == _host \
and self . _clients [ _radio_id ] [ ' PORT ' ] == _port :
_seq = _data [ 4 : 5 ]
_rf_src = _data [ 5 : 8 ]
_dst_id = _data [ 8 : 11 ]
2016-08-03 05:41:38 -04:00
#logger.debug('(%s) DMRD - Seqence: %s, RF Source: %s, Destination ID: %s', self._master, int_id(_seq), int_id(_rf_src), int_id(_dst_id))
2016-08-01 22:30:40 -04:00
# If AMBE audio exporting is configured...
if self . _config [ ' EXPORT_AMBE ' ] :
self . _ambe . parseAMBE ( self . _master , _data )
# The basic purpose of a master is to repeat to the clients
if self . _config [ ' REPEAT ' ] == True :
for _client in self . _clients :
if _client != _radio_id :
self . send_packet ( _client , _data )
logger . debug ( ' ( %s ) Packet repeated to client: %s ' , self . _master , int_id ( _client ) )
# Userland actions -- typically this is the function you subclass for an application
self . dmrd_received ( _radio_id , _rf_src , _dst_id , _seq , _data )
elif _command == ' RPTL ' : # RPTLogin -- a repeater wants to login
_radio_id = _data [ 4 : 8 ]
if _radio_id : # Future check here for valid Radio ID
self . _clients . update ( { _radio_id : { # Build the configuration data strcuture for the client
' CONNECTION ' : ' RPTL-RECEIVED ' ,
' PINGS_RECEIVED ' : 0 ,
' LAST_PING ' : time ( ) ,
' IP ' : _host ,
' PORT ' : _port ,
' SALT ' : randint ( 0 , 0xFFFFFFFF ) ,
' RADIO_ID ' : str ( int ( h ( _radio_id ) , 16 ) ) ,
' CALLSIGN ' : ' ' ,
' RX_FREQ ' : ' ' ,
' TX_FREQ ' : ' ' ,
' TX_POWER ' : ' ' ,
' COLORCODE ' : ' ' ,
' LATITUDE ' : ' ' ,
' LONGITUDE ' : ' ' ,
' HEIGHT ' : ' ' ,
' LOCATION ' : ' ' ,
' DESCRIPTION ' : ' ' ,
' SLOTS ' : ' ' ,
' URL ' : ' ' ,
' SOFTWARE_ID ' : ' ' ,
' PACKAGE_ID ' : ' ' ,
} } )
logger . info ( ' ( %s ) Repeater Logging in with Radio ID: %s , %s : %s ' , self . _master , int_id ( _radio_id ) , _host , _port )
_salt_str = hex_str_4 ( self . _clients [ _radio_id ] [ ' SALT ' ] )
self . send_packet ( _radio_id , ' RPTACK ' + _salt_str )
self . _clients [ _radio_id ] [ ' CONNECTION ' ] = ' CHALLENGE_SENT '
logger . info ( ' ( %s ) Sent Challenge Response to %s for login: %s ' , self . _master , int_id ( _radio_id ) , self . _clients [ _radio_id ] [ ' SALT ' ] )
else :
self . transport . write ( ' MSTNAK ' + _radio_id , ( _host , _port ) )
logger . warning ( ' ( %s ) Invalid Login from Radio ID: %s ' , self . _master , int_id ( _radio_id ) )
elif _command == ' RPTK ' : # Repeater has answered our login challenge
_radio_id = _data [ 4 : 8 ]
if _radio_id in self . _clients \
and self . _clients [ _radio_id ] [ ' CONNECTION ' ] == ' CHALLENGE_SENT ' \
and self . _clients [ _radio_id ] [ ' IP ' ] == _host \
and self . _clients [ _radio_id ] [ ' PORT ' ] == _port :
_this_client = self . _clients [ _radio_id ]
_this_client [ ' LAST_PING ' ] = time ( )
_sent_hash = _data [ 8 : ]
_salt_str = hex_str_4 ( _this_client [ ' SALT ' ] )
_calc_hash = a ( sha256 ( _salt_str + self . _config [ ' PASSPHRASE ' ] ) . hexdigest ( ) )
if _sent_hash == _calc_hash :
_this_client [ ' CONNECTION ' ] = ' WAITING_CONFIG '
self . send_packet ( _radio_id , ' RPTACK ' + _radio_id )
logger . info ( ' ( %s ) Client %s has completed the login exchange successfully ' , self . _master , _this_client [ ' RADIO_ID ' ] )
else :
logger . info ( ' ( %s ) Client %s has FAILED the login exchange successfully ' , self . _master , _this_client [ ' RADIO_ID ' ] )
self . transport . write ( ' MSTNAK ' + _radio_id , ( _host , _port ) )
del self . _clients [ _radio_id ]
else :
self . transport . write ( ' MSTNAK ' + _radio_id , ( _host , _port ) )
logger . warning ( ' ( %s ) Login challenge from Radio ID that has not logged in: %s ' , self . _master , int_id ( _radio_id ) )
2016-07-24 10:42:42 -04:00
2016-08-01 22:30:40 -04:00
elif _command == ' RPTC ' : # Repeater is sending it's configuraiton OR disconnecting
if _data [ : 5 ] == ' RPTCL ' : # Disconnect command
_radio_id = _data [ 5 : 9 ]
2016-07-27 22:56:33 -04:00
if _radio_id in self . _clients \
and self . _clients [ _radio_id ] [ ' CONNECTION ' ] == ' YES ' \
and self . _clients [ _radio_id ] [ ' IP ' ] == _host \
and self . _clients [ _radio_id ] [ ' PORT ' ] == _port :
2016-08-01 22:30:40 -04:00
logger . info ( ' ( %s ) Client is closing down: %s ' , self . _master , int_id ( _radio_id ) )
2016-07-26 21:51:04 -04:00
self . transport . write ( ' MSTNAK ' + _radio_id , ( _host , _port ) )
2016-08-01 22:30:40 -04:00
del self . _clients [ _radio_id ]
else :
_radio_id = _data [ 4 : 8 ] # Configure Command
2016-07-26 21:51:04 -04:00
if _radio_id in self . _clients \
2016-08-01 22:30:40 -04:00
and self . _clients [ _radio_id ] [ ' CONNECTION ' ] == ' WAITING_CONFIG ' \
2016-07-26 21:51:04 -04:00
and self . _clients [ _radio_id ] [ ' IP ' ] == _host \
and self . _clients [ _radio_id ] [ ' PORT ' ] == _port :
_this_client = self . _clients [ _radio_id ]
2016-08-01 22:30:40 -04:00
_this_client [ ' CONNECTION ' ] = ' YES '
2016-07-26 21:51:04 -04:00
_this_client [ ' LAST_PING ' ] = time ( )
2016-08-01 22:30:40 -04:00
_this_client [ ' CALLSIGN ' ] = _data [ 8 : 16 ]
_this_client [ ' RX_FREQ ' ] = _data [ 16 : 25 ]
_this_client [ ' TX_FREQ ' ] = _data [ 25 : 34 ]
_this_client [ ' TX_POWER ' ] = _data [ 34 : 36 ]
_this_client [ ' COLORCODE ' ] = _data [ 36 : 38 ]
_this_client [ ' LATITUDE ' ] = _data [ 38 : 47 ]
_this_client [ ' LONGITUDE ' ] = _data [ 47 : 57 ]
_this_client [ ' HEIGHT ' ] = _data [ 57 : 60 ]
_this_client [ ' LOCATION ' ] = _data [ 60 : 80 ]
_this_client [ ' DESCRIPTION ' ] = _data [ 80 : 99 ]
_this_client [ ' SLOTS ' ] = _data [ 99 : 100 ]
_this_client [ ' URL ' ] = _data [ 100 : 224 ]
_this_client [ ' SOFTWARE_ID ' ] = _data [ 224 : 264 ]
_this_client [ ' PACKAGE_ID ' ] = _data [ 264 : 304 ]
self . send_packet ( _radio_id , ' RPTACK ' + _radio_id )
logger . info ( ' ( %s ) Client %s has sent repeater configuration ' , self . _master , _this_client [ ' RADIO_ID ' ] )
2016-07-24 13:07:43 -04:00
else :
2016-07-25 19:55:23 -04:00
self . transport . write ( ' MSTNAK ' + _radio_id , ( _host , _port ) )
2016-08-01 22:30:40 -04:00
logger . warning ( ' ( %s ) Client info from Radio ID that has not logged in: %s ' , self . _master , int_id ( _radio_id ) )
elif _command == ' RPTP ' : # RPTPing -- client is pinging us
_radio_id = _data [ 7 : 11 ]
if _radio_id in self . _clients \
and self . _clients [ _radio_id ] [ ' CONNECTION ' ] == " YES " \
and self . _clients [ _radio_id ] [ ' IP ' ] == _host \
and self . _clients [ _radio_id ] [ ' PORT ' ] == _port :
self . _clients [ _radio_id ] [ ' LAST_PING ' ] = time ( )
self . send_packet ( _radio_id , ' MSTPONG ' + _radio_id )
logger . debug ( ' ( %s ) Received and answered RPTPING from client %s ' , self . _master , int_id ( _radio_id ) )
else :
self . transport . write ( ' MSTNAK ' + _radio_id , ( _host , _port ) )
logger . warning ( ' ( %s ) Client info from Radio ID that has not logged in: %s ' , self . _master , int_id ( _radio_id ) )
else :
logger . error ( ' ( %s ) Unrecognized command from: %s . Packet: %s ' , self . _master , int_id ( _radio_id ) , h ( _data ) )
2016-07-24 10:42:42 -04:00
#************************************************
# HB CLIENT CLASS
#************************************************
2016-07-30 21:37:05 -04:00
2016-07-20 17:16:27 -04:00
class HBCLIENT ( DatagramProtocol ) :
2016-07-30 21:37:05 -04:00
2016-07-20 17:16:27 -04:00
def __init__ ( self , * args , * * kwargs ) :
2016-07-21 13:41:36 -04:00
if len ( args ) == 1 :
self . _client = args [ 0 ]
self . _config = CONFIG [ ' CLIENTS ' ] [ self . _client ]
2016-07-21 17:14:42 -04:00
self . _stats = self . _config [ ' STATS ' ]
2016-07-30 21:37:05 -04:00
# Configure for AMBE audio export if enabled
if self . _config [ ' EXPORT_AMBE ' ] :
self . _ambe = AMBE ( )
2016-07-21 13:41:36 -04:00
else :
# If we didn't get called correctly, log it!
logger . error ( ' ( %s ) HBCLIENT was not called with an argument. Terminating ' , self . _client )
2016-07-23 16:53:22 -04:00
sys . exit ( )
2016-07-30 21:37:05 -04:00
2016-07-21 13:41:36 -04:00
def startProtocol ( self ) :
2016-07-24 10:42:42 -04:00
# Set up periodic loop for sending pings to the master. Run every 'PING_TIME' seconds
self . _client_maintenance = task . LoopingCall ( self . client_maintenance_loop )
self . _client_maintenance_loop = self . _client_maintenance . start ( CONFIG [ ' GLOBAL ' ] [ ' PING_TIME ' ] )
2016-07-21 13:41:36 -04:00
2016-07-24 10:42:42 -04:00
def client_maintenance_loop ( self ) :
2016-07-24 21:16:19 -04:00
logger . debug ( ' ( %s ) Client maintenance loop started ' , self . _client )
2016-07-26 21:51:04 -04:00
# If we're not connected, zero out the stats and send a login request RPTL
2016-08-01 21:24:27 -04:00
if self . _stats [ ' CONNECTION ' ] == ' NO ' or self . _stats [ ' CONNECTION ' ] == ' RTPL_SENT ' :
2016-07-23 16:53:22 -04:00
self . _stats [ ' PINGS_SENT ' ] = 0
self . _stats [ ' PINGS_ACKD ' ] = 0
2016-07-22 22:41:22 -04:00
self . _stats [ ' CONNECTION ' ] = ' RTPL_SENT '
2016-07-23 16:53:22 -04:00
self . send_packet ( ' RPTL ' + self . _config [ ' RADIO_ID ' ] )
2016-08-01 21:24:27 -04:00
logger . info ( ' ( %s ) Sending login request to master %s : %s ' , self . _client , self . _config [ ' MASTER_IP ' ] , self . _config [ ' MASTER_PORT ' ] )
2016-07-26 21:51:04 -04:00
# If we are connected, sent a ping to the master and increment the counter
2016-07-22 22:41:22 -04:00
if self . _stats [ ' CONNECTION ' ] == ' YES ' :
2016-07-23 11:25:34 -04:00
self . send_packet ( ' RPTPING ' + self . _config [ ' RADIO_ID ' ] )
2016-07-23 16:53:22 -04:00
self . _stats [ ' PINGS_SENT ' ] + = 1
2016-07-27 19:07:01 -04:00
logger . debug ( ' ( %s ) RPTPING Sent to Master. Pings Since Connected: %s ' , self . _client , self . _stats [ ' PINGS_SENT ' ] )
2016-07-21 13:41:36 -04:00
2016-07-21 17:14:42 -04:00
def send_packet ( self , _packet ) :
self . transport . write ( _packet , ( self . _config [ ' MASTER_IP ' ] , self . _config [ ' MASTER_PORT ' ] ) )
# KEEP THE FOLLOWING COMMENTED OUT UNLESS YOU'RE DEBUGGING DEEPLY!!!!
2016-08-01 22:30:40 -04:00
#logger.debug('(%s) TX Packet to %s:%s -- %s', self._client, self._config['MASTER_IP'], self._config['MASTER_PORT'], h(_packet))
2016-07-21 17:14:42 -04:00
2016-07-31 10:41:21 -04:00
def dmrd_received ( self , _radio_id , _rf_src , _dst_id , _seq , _data ) :
pass
2016-07-26 21:51:04 -04:00
2016-07-21 17:14:42 -04:00
def datagramReceived ( self , _data , ( _host , _port ) ) :
2016-08-01 22:30:40 -04:00
# Keep This Line Commented Unless HEAVILY Debugging!
# logger.debug('(%s) RX packet from %s:%s -- %s', self._client, _host, _port, h(_data))
2016-07-26 21:51:04 -04:00
# Validate that we receveived this packet from the master - security check!
if self . _config [ ' MASTER_IP ' ] == _host and self . _config [ ' MASTER_PORT ' ] == _port :
# Extract the command, which is various length, but only 4 significant characters
_command = _data [ : 4 ]
if _command == ' DMRD ' : # DMRData -- encapsulated DMR data frame
2016-07-27 22:56:33 -04:00
_radio_id = _data [ 11 : 15 ]
if _radio_id == self . _config [ ' RADIO_ID ' ] : # Validate the source and intended target
2016-07-31 10:41:21 -04:00
_seq = _data [ 4 : 5 ]
_rf_src = _data [ 5 : 8 ]
_dst_id = _data [ 8 : 11 ]
2016-08-03 05:41:38 -04:00
#logger.debug('(%s) DMRD - Seqence: %s, RF Source: %s, Destination ID: %s', self._client, h(_seq), int_id(_rf_src), int_id(_dst_id))
2016-07-31 10:41:21 -04:00
# If AMBE audio exporting is configured...
if self . _config [ ' EXPORT_AMBE ' ] :
self . _ambe . parseAMBE ( self . _client , _data )
# Userland actions -- typically this is the function you subclass for an application
self . dmrd_received ( _radio_id , _rf_src , _dst_id , _seq , _data )
2016-07-21 17:14:42 -04:00
2016-07-26 21:51:04 -04:00
elif _command == ' MSTN ' : # Actually MSTNAK -- a NACK from the master
2016-07-27 15:42:49 -04:00
_radio_id = _data [ 4 : 8 ]
2016-07-27 22:56:33 -04:00
if _radio_id == self . _config [ ' RADIO_ID ' ] : # Validate the source and intended target
2016-07-27 19:07:01 -04:00
logger . warning ( ' ( %s ) MSTNAK Received ' , self . _client )
2016-07-26 21:51:04 -04:00
self . _stats [ ' CONNECTION ' ] = ' NO ' # Disconnect ourselves and re-register
2016-07-23 11:25:34 -04:00
2016-07-26 21:51:04 -04:00
elif _command == ' RPTA ' : # Actually RPTACK -- an ACK from the master
# Depending on the state, an RPTACK means different things, in each clause, we check and/or set the state
if self . _stats [ ' CONNECTION ' ] == ' RTPL_SENT ' : # If we've sent a login request...
_login_int32 = _data [ 6 : 10 ]
2016-08-01 22:30:40 -04:00
logger . info ( ' ( %s ) Repeater Login ACK Received with 32bit ID: %s ' , self . _client , int_id ( _login_int32 ) )
2016-07-26 21:51:04 -04:00
_pass_hash = sha256 ( _login_int32 + self . _config [ ' PASSPHRASE ' ] ) . hexdigest ( )
_pass_hash = a ( _pass_hash )
self . send_packet ( ' RPTK ' + self . _config [ ' RADIO_ID ' ] + _pass_hash )
self . _stats [ ' CONNECTION ' ] = ' AUTHENTICATED '
2016-07-23 11:25:34 -04:00
2016-07-26 21:51:04 -04:00
elif self . _stats [ ' CONNECTION ' ] == ' AUTHENTICATED ' : # If we've sent the login challenge...
if _data [ 6 : 10 ] == self . _config [ ' RADIO_ID ' ] :
logger . info ( ' ( %s ) Repeater Authentication Accepted ' , self . _client )
_config_packet = self . _config [ ' RADIO_ID ' ] + \
self . _config [ ' CALLSIGN ' ] + \
self . _config [ ' RX_FREQ ' ] + \
self . _config [ ' TX_FREQ ' ] + \
self . _config [ ' TX_POWER ' ] + \
self . _config [ ' COLORCODE ' ] + \
self . _config [ ' LATITUDE ' ] + \
self . _config [ ' LONGITUDE ' ] + \
self . _config [ ' HEIGHT ' ] + \
self . _config [ ' LOCATION ' ] + \
self . _config [ ' DESCRIPTION ' ] + \
self . _config [ ' SLOTS ' ] + \
self . _config [ ' URL ' ] + \
self . _config [ ' SOFTWARE_ID ' ] + \
self . _config [ ' PACKAGE_ID ' ]
self . send_packet ( ' RPTC ' + _config_packet )
self . _stats [ ' CONNECTION ' ] = ' CONFIG-SENT '
logger . info ( ' ( %s ) Repeater Configuration Sent ' , self . _client )
else :
self . _stats [ ' CONNECTION ' ] = ' NO '
logger . error ( ' ( %s ) Master ACK Contained wrong ID - Connection Reset ' , self . _client )
elif self . _stats [ ' CONNECTION ' ] == ' CONFIG-SENT ' : # If we've sent out configuration to the master
if _data [ 6 : 10 ] == self . _config [ ' RADIO_ID ' ] :
logger . info ( ' ( %s ) Repeater Configuration Accepted ' , self . _client )
self . _stats [ ' CONNECTION ' ] = ' YES '
logger . info ( ' ( %s ) Connection to Master Completed ' , self . _client )
else :
self . _stats [ ' CONNECTION ' ] = ' NO '
logger . error ( ' ( %s ) Master ACK Contained wrong ID - Connection Reset ' , self . _client )
2016-07-22 22:41:22 -04:00
2016-07-26 21:51:04 -04:00
elif _command == ' MSTP ' : # Actually MSTPONG -- a reply to RPTPING (send by client)
if _data [ 7 : 11 ] == self . _config [ ' RADIO_ID ' ] :
self . _stats [ ' PINGS_ACKD ' ] + = 1
2016-07-27 19:07:01 -04:00
logger . debug ( ' ( %s ) MSTPONG Received. Pongs Since Connected: %s ' , self . _client , self . _stats [ ' PINGS_ACKD ' ] )
2016-07-23 11:25:34 -04:00
2016-07-26 21:51:04 -04:00
elif _command == ' MSTC ' : # Actually MSTCL -- notify us the master is closing down
if _data [ 5 : 9 ] == self . _config [ ' RADIO_ID ' ] :
self . _stats [ ' CONNECTION ' ] = ' NO '
logger . info ( ' ( %s ) MSTCL Recieved ' , self . _client )
2016-07-23 11:25:34 -04:00
2016-07-26 21:51:04 -04:00
else :
logger . error ( ' ( %s ) Received an invalid command in packet: %s ' , self . _client , h ( _data ) )
2016-07-20 17:16:27 -04:00
2016-07-20 22:25:47 -04:00
2016-07-20 17:16:27 -04:00
#************************************************
# MAIN PROGRAM LOOP STARTS HERE
#************************************************
if __name__ == ' __main__ ' :
logger . info ( ' HBlink \' HBlink.py \' (c) 2016 N0MJS & the K0USY Group - SYSTEM STARTING... ' )
# HBlink Master
2016-07-20 22:25:47 -04:00
for master in CONFIG [ ' MASTERS ' ] :
if CONFIG [ ' MASTERS ' ] [ master ] [ ' ENABLED ' ] :
2016-07-20 20:14:42 -04:00
masters [ master ] = HBMASTER ( master )
2016-07-20 22:25:47 -04:00
reactor . listenUDP ( CONFIG [ ' MASTERS ' ] [ master ] [ ' PORT ' ] , masters [ master ] , interface = CONFIG [ ' MASTERS ' ] [ master ] [ ' IP ' ] )
logger . debug ( ' MASTER instance created: %s , %s ' , master , masters [ master ] )
2016-07-31 10:41:21 -04:00
# HBlink Client
2016-07-20 22:25:47 -04:00
for client in CONFIG [ ' CLIENTS ' ] :
if CONFIG [ ' CLIENTS ' ] [ client ] [ ' ENABLED ' ] :
2016-07-20 17:16:27 -04:00
clients [ client ] = HBCLIENT ( client )
2016-07-20 22:25:47 -04:00
reactor . listenUDP ( CONFIG [ ' CLIENTS ' ] [ client ] [ ' PORT ' ] , clients [ client ] , interface = CONFIG [ ' CLIENTS ' ] [ client ] [ ' IP ' ] )
logger . debug ( ' CLIENT instance created: %s , %s ' , client , clients [ client ] )
2016-07-20 17:16:27 -04:00
2016-07-30 21:37:05 -04:00
reactor . run ( )