trezor-firmware/src/trezor/loop.py

import utime

from uheapq import heappop, heappush
from .utils import type_gen
from . import msg
from . import log

TOUCH_START = const(-1)
TOUCH_MOVE = const(-2)
TOUCH_END = const(-3)
MESSAGE = const(-4)

event_handlers = {
    TOUCH_START: None,
    TOUCH_MOVE: None,
    TOUCH_END: None,
    MESSAGE: None,
}
time_queue = []
schedule_ctr = 0

if __debug__:
    # For performance stats
    import array
    log_delay_pos = 0
    log_delay_rb_len = const(10)
    log_delay_rb = array.array('i', [0] * log_delay_rb_len)


def __schedule(gen, args=(), time=None):
    global schedule_ctr
    if not time:
        time = utime.ticks_us()
    heappush(time_queue, (time, schedule_ctr, gen, args))
    schedule_ctr += 1


class Wait():

    def __init__(self, gens, wait_for=1, exit_others=True):
        self.wait_for = wait_for
        self.exit_others = exit_others
        self.received = 0
        self.callback = None
        self.gens = gens

        for g in gens:
            __schedule(self._wait(g))

    def _wait(self, gen):
        if isinstance(gen, type_gen):
            ret = yield from gen
        else:
            ret = yield gen

        self.finish(gen, ret)

    def finish(self, gen, result):
        self.received += 1

        if self.received == self.wait_for:
            __schedule(self.callback, (gen, result))
            self.callback = None

            if self.exit_others:
                for g in self.gens:
                    if isinstance(gen, type_gen):
                        g.close()


def sleep(us):
    return utime.ticks_us() + us


def run_forever(start_gens):
    if __debug__:
        global log_delay_pos
        global log_delay_rb
        global log_delay_rb_len

    delay_max = const(1000000)

    for gen in start_gens:
        __schedule(gen)

    while True:

        if time_queue:
            t, _, _, _ = time_queue[0]
            delay = t - utime.ticks_us()
        else:
            delay = delay_max

        if __debug__:
            # Adding current delay to ring buffer for performance stats
            log_delay_rb[log_delay_pos] = delay
            log_delay_pos = (log_delay_pos + 1) % log_delay_rb_len

        event = msg.select(delay)

        if event:
            # Run interrupt handler
            event_id, *args = event
            event_id = -event_id
            gen = event_handlers.get(event_id, None)
            event_handlers[event_id] = None
            if not gen:
                log.info(__name__, 'No handler for event: %s', event)
                continue
        else:
            if time_queue:
                # Run something from the time queue
                _, _, gen, args = heappop(time_queue)
            else:
                # Sleep again
                delay = delay_max
                continue

        if not args:
            args = None
        try:
            ret = gen.send(args)

        except StopIteration as e:
            log.debug(__name__, '%s finished', gen)
            continue

        except Exception as e:
            log.exception(__name__, e)
            continue

        if isinstance(ret, int) and ret >= 0:
            # Sleep until ret, call us later
            __schedule(gen, (), ret)

        elif isinstance(ret, int) and ret in event_handlers:
            # Wait for event
            if event_handlers[ret]:
                event_handlers[ret].close()
            event_handlers[ret] = gen

        elif isinstance(ret, Wait):
            # Register the origin generator as a waiting callback
            ret.callback = gen

        elif ret is None:
            # Just call us asap
            __schedule(gen)

        else:
            raise Exception('Unhandled result %s by %s' % (ret, gen))