atmosphere/thermosphere/src/timer.c

/*
 * Copyright (c) 2019 Atmosphère-NX
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope 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, see <http://www.gnu.org/licenses/>.
 */

#include "timer.h"
#include "irq.h"
#include "exceptions.h"

u64 g_timerFreq = 0;

void timerInit(void)
{
    timerConfigure(false, false);
    if (currentCoreCtx->isBootCore) {
        g_timerFreq = GET_SYSREG(cntfrq_el0);
    }
}

void timerInterruptHandler(void)
{
    // Mask the timer interrupt until reprogrammed
    timerConfigure(false, false);
}

void timerWaitUsecs(u64 us)
{
    exceptionEnterInterruptibleHypervisorCode();
    u64 mask = unmaskIrq();
    timerSetTimeoutUs(us);
    do {
        __wfi();
    } while (!timerGetInterruptStatus());
    restoreInterruptFlags(mask);
}