#!/usr/bin/python3

import os
import logging
import argparse
import psutil
import re
import alsaaudio
import sys
from pyudev import Context, Devices

# Parse arguments
parser = argparse.ArgumentParser(
    description='Real-Time Config IRQ Udev Service. Set RT priorities of IRQs '
                'of audio devices using udev')
parser.add_argument('-p', '--priority',
                    default=90,
                    help='Priority to set [90]')
parser.add_argument('-s', '--step',
                    default=5,
                    help='Steps between priorities [5]')
parser.add_argument('-c', '--configuration',
                    default='/etc/rtcirqus.d/rtcirqus.conf',
                    help='Path to configuration file [/etc/rtcirqus.d/'
                         'rtcirqus.conf]')
parser.add_argument('-a', '--action',
                    default='add',
                    help='Action to perform, add or remove')
parser.add_argument('-d', '--dev-path',
                    help='udev device path')

args = parser.parse_args()

# Set variables
udev_action = args.action
udev_dev_path = args.dev_path
prio = {}
prio['rt'] = int(args.priority)
prio['step'] = int(args.step)
conf = {}
conf['file'] = args.configuration
conf['deny_list'] = []
irq_re = re.compile('irq\/\d+-(audiodsp|snd|[e,u,x]hci_hcd)')
snd_card_indexes = alsaaudio.card_indexes()
snd_cards = [
    dict([
        ('name', card[0]), ('description', card[1]), ('index', card[2])]
    ) for card in [
        alsaaudio.card_name(index) + (index,) for index in snd_card_indexes]]
udev_context = Context()
snd_dev_paths = [
    Devices.from_name(
        udev_context, 'sound', f'card{index}').device_path for index in
    snd_card_indexes]
snd_usb_cards = []
snd_onboard_cards = []
procs = {proc.info['name']: proc.info['pid'] for proc in psutil.process_iter(
    ['name', 'pid'])}

# Set default logging level
logging.basicConfig(format='%(levelname)s: %(message)s', level=logging.INFO)


# Check if we're running as root
def check_root():
    if os.getuid() != 0:
        msg = 'Not running as root, rtcirqus needs to be run as root in ' \
              'order to set IRQ priorities'

        logging.error(msg)
        sys.exit(1)


# Read configuration file
def read_config():
    if os.path.exists(conf['file']):
        with open(conf['file'], 'r') as f:
            for line in f.readlines():
                if not line.startswith('#'):
                    key, values = line.split('=')[0].strip(), \
                                  line.split('=')[1].strip()
                conf[key] = [
                    value.strip() for value in values.split(',')
                    if key == 'deny_list']
    else:
        logging.warning(
            "No configuration file found, continuing with defaults")


# Check if kernel runs with threadirqs parameter and if threaded IRQs of
# audio devices are actually available
def check_threadirqs():
    for proc_name in procs:
        if irq_re.match(proc_name):
            irq_match = True

    with open('/proc/cmdline', 'r') as f:
        kernel_cmdline = f.readline().strip().split()

    if 'threadirqs' in kernel_cmdline and irq_match:
        logging.info('Loaded kernel is using threaded IRQs and '
                     'threaded IRQ processes detected')

    else:
        logging.info('Loaded kernel is not using threaded IRQs, no '
                     '"threadirqs" parameter found.')


# Create lists of USB and onboard audio devices
def detect_cards():
    for card in snd_cards:
        if 'usb-' in card['description']:
            snd_usb_cards.append(card)
        else:
            snd_onboard_cards.append(card)

    if len(snd_onboard_cards) > 0:
        logging.info(
            'Onboard cards found: '
            f'{", ".join([card["name"] for card in snd_onboard_cards])}')

    if len(snd_usb_cards) > 0:
        logging.info(
            'USB cards found: '
            f'{", ".join([card["name"] for card in snd_usb_cards])}')


# Get IRQs of audio devices and pass these on to the relevant functions
def get_irq():
    check_root()

    if udev_action == 'add':
        for dev_path in snd_dev_paths:
            split_dev_path = re.split('(sound|usb\d+)', dev_path)[0]
            card_index = int(dev_path.split('/')[-1].removeprefix('card'))
            irq_path = f'/sys{split_dev_path}irq'

            if 'usb' in dev_path:
                card_type = 'USB'
            else:
                card_type = 'onboard'

            card_name = alsaaudio.card_name(card_index)[0]

            if card_name not in conf['deny_list'] \
                    and os.path.exists(irq_path):
                logging.info(
                    f'Setting RT priority {prio["rt"]} for {card_type} '
                    f'card {card_name}')
                with open(irq_path, 'r') as f:
                    irq = f.readline().strip()

                set_rt_prio(irq, prio['rt'])

            prio['rt'] = prio['rt'] - prio['step']

    if udev_action == 'remove':
        unset_rt_prio()


# Set real-time priority of threaded IRQs of audio devices
def set_rt_prio(irq, prio_rt):
    os_sched = os.SCHED_FIFO

    for proc_name in procs:
        if irq_re.match(proc_name) and irq in proc_name:
            proc_pid = procs[proc_name]
            os_sched_param = os.sched_param(prio_rt)
            os.sched_setscheduler(proc_pid, os_sched, os_sched_param)


def unset_rt_prio():
    split_re = re.split('(sound|usb\d+)', udev_dev_path)[0]
    irq_path = f'/sys{split_re}irq'

    with open(irq_path, 'r') as f:
        irq = f.readline().strip()

    set_rt_prio(irq, 50)


def main():
    read_config()
    check_threadirqs()
    detect_cards()
    get_irq()


if __name__ == "__main__":
    main()
