296 lines
		
	
	
		
			17 KiB
		
	
	
	
		
			Python
		
	
	
		
			Executable File
		
	
	
	
	
			
		
		
	
	
			296 lines
		
	
	
		
			17 KiB
		
	
	
	
		
			Python
		
	
	
		
			Executable File
		
	
	
	
	
#!/usr/bin/env python
 | 
						|
#
 | 
						|
###############################################################################
 | 
						|
#   Copyright (C) 2016-2019 Cortney T. Buffington, N0MJS <n0mjs@me.com>
 | 
						|
#
 | 
						|
#   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, write to the Free Software Foundation,
 | 
						|
#   Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301  USA
 | 
						|
###############################################################################
 | 
						|
 | 
						|
'''
 | 
						|
This is a very simple call/packet router for Homebrew Repeater Protocol. It
 | 
						|
will forward traffic from any system to all other systems configured in the
 | 
						|
hblink.py configuration file. It does not check for call contentions or
 | 
						|
filter TS/TGID combinations. It should really only be used as a proxy to
 | 
						|
hide multiple Homebrew repater protocol systems behind what appears as a single
 | 
						|
repeater, hotspot, etc.
 | 
						|
 | 
						|
As is, this program only works with group voice packets. It could work for all
 | 
						|
of them by removing a few things.
 | 
						|
 | 
						|
IT ONLY WORKS FOR HBP SYSTEMS!!! Using it with OpenBridge or XLX wouldn't make
 | 
						|
a lot of sense, and has the potential to do bad things.
 | 
						|
'''
 | 
						|
 | 
						|
# Python modules we need
 | 
						|
import sys
 | 
						|
from bitarray import bitarray
 | 
						|
from time import time
 | 
						|
from importlib import import_module
 | 
						|
from types import ModuleType
 | 
						|
 | 
						|
# Twisted is pretty important, so I keep it separate
 | 
						|
from twisted.internet.protocol import Factory, Protocol
 | 
						|
from twisted.protocols.basic import NetstringReceiver
 | 
						|
from twisted.internet import reactor, task
 | 
						|
 | 
						|
# Things we import from the main hblink module
 | 
						|
from hblink import HBSYSTEM, OPENBRIDGE, systems, hblink_handler, reportFactory, REPORT_OPCODES, config_reports, mk_aliases, acl_check
 | 
						|
from dmr_utils3.utils import bytes_3, int_id, get_alias
 | 
						|
from dmr_utils3 import decode, bptc, const
 | 
						|
import config
 | 
						|
import log
 | 
						|
import const
 | 
						|
 | 
						|
# The module needs logging logging, but handlers, etc. are controlled by the parent
 | 
						|
import logging
 | 
						|
logger = logging.getLogger(__name__)
 | 
						|
 | 
						|
 | 
						|
# Does anybody read this stuff? There's a PEP somewhere that says I should do this.
 | 
						|
__author__     = 'Cortney T. Buffington, N0MJS'
 | 
						|
__copyright__  = 'Copyright (c) 2016-2018 Cortney T. Buffington, N0MJS and the K0USY Group'
 | 
						|
__credits__    = 'Colin Durbridge, G4EML, Steve Zingman, N4IRS; Mike Zingman, N4IRR; Jonathan Naylor, G4KLX; Hans Barthen, DL5DI; Torsten Shultze, DG1HT'
 | 
						|
__license__    = 'GNU GPLv3'
 | 
						|
__maintainer__ = 'Cort Buffington, N0MJS'
 | 
						|
__email__      = 'n0mjs@me.com'
 | 
						|
__status__     = 'pre-alpha'
 | 
						|
 | 
						|
# Module gobal varaibles
 | 
						|
 | 
						|
 | 
						|
class bridgeallSYSTEM(HBSYSTEM):
 | 
						|
 | 
						|
    def __init__(self, _name, _config, _report):
 | 
						|
        HBSYSTEM.__init__(self, _name, _config, _report)
 | 
						|
        self._laststrid = ''
 | 
						|
 | 
						|
        # Status information for the system, TS1 & TS2
 | 
						|
        # 1 & 2 are "timeslot"
 | 
						|
        self.STATUS = {
 | 
						|
            1: {
 | 
						|
                'RX_START':     time(),
 | 
						|
                'RX_LOSS':      0,
 | 
						|
                'RX_SEQ':       0,
 | 
						|
                'RX_RFS':       b'\x00',
 | 
						|
                'TX_RFS':       b'\x00',
 | 
						|
                'RX_STREAM_ID': b'\x00',
 | 
						|
                'TX_STREAM_ID': b'\x00',
 | 
						|
                'RX_TGID':      b'\x00\x00\x00',
 | 
						|
                'TX_TGID':      b'\x00\x00\x00',
 | 
						|
                'RX_TIME':      time(),
 | 
						|
                'TX_TIME':      time(),
 | 
						|
                'RX_TYPE':      const.HBPF_SLT_VTERM,
 | 
						|
                },
 | 
						|
            2: {
 | 
						|
                'RX_START':     time(),
 | 
						|
                'RX:LOSS':      0,
 | 
						|
                'RX_SEQ':       0,
 | 
						|
                'RX_RFS':       b'\x00',
 | 
						|
                'TX_RFS':       b'\x00',
 | 
						|
                'RX_STREAM_ID': b'\x00',
 | 
						|
                'TX_STREAM_ID': b'\x00',
 | 
						|
                'RX_TGID':      b'\x00\x00\x00',
 | 
						|
                'TX_TGID':      b'\x00\x00\x00',
 | 
						|
                'RX_TIME':      time(),
 | 
						|
                'TX_TIME':      time(),
 | 
						|
                'RX_TYPE':      const.HBPF_SLT_VTERM,
 | 
						|
                }
 | 
						|
            }
 | 
						|
 | 
						|
    def dmrd_received(self, _peer_id, _rf_src, _dst_id, _seq, _slot, _call_type, _frame_type, _dtype_vseq, _stream_id, _data):
 | 
						|
        pkt_time = time()
 | 
						|
        dmrpkt = _data[20:53]
 | 
						|
        _bits = _data[15]
 | 
						|
 | 
						|
        if _call_type == 'group':
 | 
						|
 | 
						|
            # Is this is a new call stream?
 | 
						|
            new_stream = (_stream_id != self.STATUS[_slot]['RX_STREAM_ID'])
 | 
						|
 | 
						|
            if new_stream:
 | 
						|
                self.STATUS[_slot]['RX_START'] = pkt_time
 | 
						|
                self.STATUS[_slot]['RX_LOSS'] = 0
 | 
						|
                self.STATUS[_slot]['RX_SEQ'] = _seq
 | 
						|
                logger.info('(%s) *CALL START* STREAM ID: %s SUB: %s (%s) PEER: %s (%s) TGID %s (%s), TS %s', \
 | 
						|
                        self._system, int_id(_stream_id), get_alias(_rf_src, subscriber_ids), int_id(_rf_src), get_alias(_peer_id, peer_ids), int_id(_peer_id), get_alias(_dst_id, talkgroup_ids), int_id(_dst_id), _slot)
 | 
						|
            else:
 | 
						|
                # This could be much better, it will have errors during roll-over
 | 
						|
                if _seq > (self.STATUS[_slot]['RX_SEQ'] + 1):
 | 
						|
                    #print(_seq, self.STATUS[_slot]['RX_SEQ'])
 | 
						|
                    self.STATUS[_slot]['RX_LOSS'] += _seq - (self.STATUS[_slot]['RX_SEQ'] + 1)
 | 
						|
 | 
						|
            # Final actions - Is this a voice terminator?
 | 
						|
            if (_frame_type == const.HBPF_DATA_SYNC) and (_dtype_vseq == const.HBPF_SLT_VTERM) and (self.STATUS[_slot]['RX_TYPE'] != const.HBPF_SLT_VTERM):
 | 
						|
                call_duration = pkt_time - self.STATUS[_slot]['RX_START']
 | 
						|
                logger.info('(%s) *CALL END*   STREAM ID: %s SUB: %s (%s) PEER: %s (%s) TGID %s (%s), TS %s, Loss: %s, Duration: %s', \
 | 
						|
                        self._system, int_id(_stream_id), get_alias(_rf_src, subscriber_ids), int_id(_rf_src), get_alias(_peer_id, peer_ids), int_id(_peer_id), get_alias(_dst_id, talkgroup_ids), int_id(_dst_id), _slot, self.STATUS[_slot]['RX_LOSS'], call_duration)
 | 
						|
 | 
						|
 | 
						|
            for _target in self._CONFIG['SYSTEMS']: 
 | 
						|
                if _target != self._system:
 | 
						|
 | 
						|
                    _target_status = systems[_target].STATUS
 | 
						|
                    _target_system = self._CONFIG['SYSTEMS'][_target]
 | 
						|
 | 
						|
                    # BEGIN STANDARD CONTENTION HANDLING
 | 
						|
                    #
 | 
						|
                    # The rules for each of the 4 "ifs" below are listed here for readability. The Frame To Send is:
 | 
						|
                    #   From a different group than last RX from this HBSystem, but it has been less than Group Hangtime
 | 
						|
                    #   From a different group than last TX to this HBSystem, but it has been less than Group Hangtime
 | 
						|
                    #   From the same group as the last RX from this HBSystem, but from a different subscriber, and it has been less than stream timeout
 | 
						|
                    #   From the same group as the last TX to this HBSystem, but from a different subscriber, and it has been less than stream timeout
 | 
						|
                    # The "continue" at the end of each means the next iteration of the for loop that tests for matching rules
 | 
						|
                    #
 | 
						|
                    if ((_dst_id != _target_status[_slot]['RX_TGID']) and ((pkt_time - _target_status[_slot]['RX_TIME']) < _target_system['GROUP_HANGTIME'])):
 | 
						|
                        if _frame_type == const.HBPF_DATA_SYNC and _dtype_vseq == const.HBPF_SLT_VHEAD and self.STATUS[_slot]['RX_STREAM_ID'] != _stream_id:
 | 
						|
                            logger.info('(%s) Call not routed to TGID %s, target active or in group hangtime: HBSystem: %s, TS: %s, TGID: %s', self._system, int_id(_dst_id), _target, _slot, int_id(_target_status[_slot]['RX_TGID']))
 | 
						|
                        continue
 | 
						|
                    if ((_dst_id != _target_status[_slot]['TX_TGID']) and ((pkt_time - _target_status[_slot]['TX_TIME']) < _target_system['GROUP_HANGTIME'])):
 | 
						|
                        if _frame_type == const.HBPF_DATA_SYNC and _dtype_vseq == const.HBPF_SLT_VHEAD and self.STATUS[_slot]['RX_STREAM_ID'] != _stream_id:
 | 
						|
                            logger.info('(%s) Call not routed to TGID%s, target in group hangtime: HBSystem: %s, TS: %s, TGID: %s', self._system, int_id(_dst_id), _target, _slot, int_id(_target_status[_slot]['TX_TGID']))
 | 
						|
                        continue
 | 
						|
                    if (_dst_id == _target_status[_slot]['RX_TGID']) and ((pkt_time - _target_status[_slot]['RX_TIME']) < const.STREAM_TO):
 | 
						|
                        if _frame_type == const.HBPF_DATA_SYNC and _dtype_vseq == const.HBPF_SLT_VHEAD and self.STATUS[_slot]['RX_STREAM_ID'] != _stream_id:
 | 
						|
                            logger.info('(%s) Call not routed to TGID%s, matching call already active on target: HBSystem: %s, TS: %s, TGID: %s', self._system, int_id(_dst_id), _target, _slot, int_id(_target_status[_slot]['RX_TGID']))
 | 
						|
                        continue
 | 
						|
                    if (_dst_id == _target_status[_slot]['TX_TGID']) and (_rf_src != _target_status[_slot]['TX_RFS']) and ((pkt_time - _target_status[_slot]['TX_TIME']) < const.STREAM_TO):
 | 
						|
                        if _frame_type == const.HBPF_DATA_SYNC and _dtype_vseq == const.HBPF_SLT_VHEAD and self.STATUS[_slot]['RX_STREAM_ID'] != _stream_id:
 | 
						|
                            logger.info('(%s) Call not routed for subscriber %s, call route in progress on target: HBSystem: %s, TS: %s, TGID: %s, SUB: %s', self._system, int_id(_rf_src), _target, _slot, int_id(_target_status[_slot]['TX_TGID']), int_id(_target_status[_slot]['TX_RFS']))
 | 
						|
                        continue
 | 
						|
 | 
						|
 | 
						|
                    # ACL Processing
 | 
						|
                    if self._CONFIG['GLOBAL']['USE_ACL']:
 | 
						|
                        if not acl_check(_rf_src, self._CONFIG['GLOBAL']['SUB_ACL']):
 | 
						|
                            if _stream_id != _target_status[_slot]['TX_STREAM_ID']:
 | 
						|
                                logger.info('(%s) CALL DROPPED ON EGRESS WITH STREAM ID %s FROM SUBSCRIBER %s BY GLOBAL ACL', _target, int_id(_stream_id), int_id(_rf_src))
 | 
						|
                                _target_status[_slot]['TX_STREAM_ID'] = _stream_id
 | 
						|
                            continue
 | 
						|
                        if _slot == 1 and not acl_check(_dst_id, self._CONFIG['GLOBAL']['TG1_ACL']):
 | 
						|
                            if _stream_id != _target_status[_slot]['TX_STREAM_ID']:
 | 
						|
                                logger.info('(%s) CALL DROPPED ON EGRESS WITH STREAM ID %s ON TGID %s BY GLOBAL TS1 ACL', _target, int_id(_stream_id), int_id(_dst_id))
 | 
						|
                                _target_status[_slot]['TX_STREAM_ID'] = _stream_id
 | 
						|
                            continue
 | 
						|
                        if _slot == 2 and not acl_check(_dst_id, self._CONFIG['GLOBAL']['TG2_ACL']):
 | 
						|
                            if _stream_id != _target_status[_slot]['TX_STREAM_ID']:
 | 
						|
                                logger.info('(%s) CALL DROPPED ON EGRESS WITH STREAM ID %s ON TGID %s BY GLOBAL TS2 ACL', _target, int_id(_stream_id), int_id(_dst_id))
 | 
						|
                                _target_status[_slot]['TX_STREAM_ID'] = _stream_id
 | 
						|
                            continue
 | 
						|
                    if _target_system['USE_ACL']:
 | 
						|
                        if not acl_check(_rf_src, _target_system['SUB_ACL']):
 | 
						|
                            if _stream_id != _target_status[_slot]['TX_STREAM_ID']:
 | 
						|
                                logger.info('(%s) CALL DROPPED ON EGRESS WITH STREAM ID %s FROM SUBSCRIBER %s BY SYSTEM ACL', _target, int_id(_stream_id), int_id(_rf_src))
 | 
						|
                                _target_status[_slot]['TX_STREAM_ID'] = _stream_id
 | 
						|
                            continue
 | 
						|
                        if _slot == 1 and not acl_check(_dst_id, _target_system['TG1_ACL']):
 | 
						|
                            if _stream_id != _target_status[_slot]['TX_STREAM_ID']:
 | 
						|
                                logger.info('(%s) CALL DROPPED ON EGRESS WITH STREAM ID %s ON TGID %s BY SYSTEM TS1 ACL', _target, int_id(_stream_id), int_id(_dst_id))
 | 
						|
                                _target_status[_slot]['TX_STREAM_ID'] = _stream_id
 | 
						|
                            continue
 | 
						|
                        if _slot == 2 and not acl_check(_dst_id, _target_system['TG2_ACL']):
 | 
						|
                            if _stream_id != _target_status[_slot]['TX_STREAM_ID']:
 | 
						|
                                logger.info('(%s) CALL DROPPED ON EGRESS WITH STREAM ID %s ON TGID %s BY SYSTEM TS2 ACL', _target, int_id(_stream_id), int_id(_dst_id))
 | 
						|
                                _target_status[_slot]['TX_STREAM_ID'] = _stream_id
 | 
						|
                            continue
 | 
						|
 | 
						|
                    # Record this stuff for later
 | 
						|
                    # Is this a new call stream?
 | 
						|
                    if new_stream:
 | 
						|
                         # Record the DST TGID and Stream ID
 | 
						|
                         _target_status[_slot]['TX_START'] = pkt_time
 | 
						|
                         _target_status[_slot]['TX_TGID'] = _dst_id
 | 
						|
                         _target_status[_slot]['TX_RFS'] = _rf_src
 | 
						|
                         _target_status[_slot]['TX_PEER'] = _peer_id
 | 
						|
                         _target_status[_slot]['TX_STREAM_ID'] = _stream_id
 | 
						|
 | 
						|
                    _target_status[_slot]['TX_TIME'] = pkt_time
 | 
						|
 | 
						|
                    systems[_target].send_system(_data)
 | 
						|
                    #logger.debug('(%s) Packet routed to system: %s', self._system, _target)
 | 
						|
 | 
						|
            # Mark status variables for use later
 | 
						|
            self.STATUS[_slot]['RX_RFS']       = _rf_src
 | 
						|
            self.STATUS[_slot]['RX_SEQ']       = _seq
 | 
						|
            self.STATUS[_slot]['RX_TYPE']      = _dtype_vseq
 | 
						|
            self.STATUS[_slot]['RX_TGID']      = _dst_id
 | 
						|
            self.STATUS[_slot]['RX_TIME']      = pkt_time
 | 
						|
            self.STATUS[_slot]['RX_STREAM_ID'] = _stream_id
 | 
						|
 | 
						|
 | 
						|
#************************************************
 | 
						|
#      MAIN PROGRAM LOOP STARTS HERE
 | 
						|
#************************************************
 | 
						|
 | 
						|
if __name__ == '__main__':
 | 
						|
    import argparse
 | 
						|
    import sys
 | 
						|
    import os
 | 
						|
    import signal
 | 
						|
    from dmr_utils3.utils import try_download, mk_id_dict
 | 
						|
 | 
						|
    # Change the current directory to the location of the application
 | 
						|
    os.chdir(os.path.dirname(os.path.realpath(sys.argv[0])))
 | 
						|
 | 
						|
    # 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.')
 | 
						|
    cli_args = parser.parse_args()
 | 
						|
 | 
						|
    # Ensure we have a path for the config file, if one wasn't specified, then use the default (top of file)
 | 
						|
    if not cli_args.CONFIG_FILE:
 | 
						|
        cli_args.CONFIG_FILE = os.path.dirname(os.path.abspath(__file__))+'/hblink.cfg'
 | 
						|
 | 
						|
    # Call the external routine to build the configuration dictionary
 | 
						|
    CONFIG = config.build_config(cli_args.CONFIG_FILE)
 | 
						|
 | 
						|
    # Start the system logger
 | 
						|
    if cli_args.LOG_LEVEL:
 | 
						|
        CONFIG['LOGGER']['LOG_LEVEL'] = cli_args.LOG_LEVEL
 | 
						|
    logger = log.config_logging(CONFIG['LOGGER'])
 | 
						|
    logger.info('\n\nCopyright (c) 2013, 2014, 2015, 2016, 2018, 2019\n\tThe Regents of the K0USY Group. All rights reserved.\n')
 | 
						|
    logger.debug('Logging system started, anything from here on gets logged')
 | 
						|
 | 
						|
    # Set up the signal handler
 | 
						|
    def sig_handler(_signal, _frame):
 | 
						|
        logger.info('SHUTDOWN: BRIDGE_ALL IS TERMINATING WITH SIGNAL %s', str(_signal))
 | 
						|
        hblink_handler(_signal, _frame)
 | 
						|
        logger.info('SHUTDOWN: ALL SYSTEM HANDLERS EXECUTED - STOPPING REACTOR')
 | 
						|
        reactor.stop()
 | 
						|
 | 
						|
    # Set signal handers so that we can gracefully exit if need be
 | 
						|
    for sig in [signal.SIGTERM, signal.SIGINT]:
 | 
						|
        signal.signal(sig, sig_handler)
 | 
						|
 | 
						|
    # Create the name-number mapping dictionaries
 | 
						|
    peer_ids, subscriber_ids, talkgroup_ids = mk_aliases(CONFIG)
 | 
						|
 | 
						|
    # INITIALIZE THE REPORTING LOOP
 | 
						|
    report_server = config_reports(CONFIG, reportFactory)
 | 
						|
 | 
						|
    # HBlink instance creation
 | 
						|
    logger.info('HBlink \'bridge_all.py\' -- SYSTEM STARTING...')
 | 
						|
    for system in CONFIG['SYSTEMS']:
 | 
						|
        if CONFIG['SYSTEMS'][system]['ENABLED']:
 | 
						|
            if CONFIG['SYSTEMS'][system]['MODE'] == 'OPENBRIDGE':
 | 
						|
                logger.critical('%s FATAL: Instance is mode \'OPENBRIDGE\', \n\t\t...Which would be tragic for Bridge All, since it carries multiple call\n\t\tstreams simultaneously. bridge_all.py onlyl works with MMDVM-based systems', system)
 | 
						|
                sys.exit('bridge_all.py cannot function with systems that are not MMDVM devices. System {} is configured as an OPENBRIDGE'.format(system))
 | 
						|
            else:
 | 
						|
                systems[system] = bridgeallSYSTEM(system, CONFIG, report_server)
 | 
						|
            reactor.listenUDP(CONFIG['SYSTEMS'][system]['PORT'], systems[system], interface=CONFIG['SYSTEMS'][system]['IP'])
 | 
						|
            logger.debug('%s instance created: %s, %s', CONFIG['SYSTEMS'][system]['MODE'], system, systems[system])
 | 
						|
 | 
						|
    reactor.run()
 |