Newer
Older
minerva / Kernel / Arch / riscv64 / Timer.cpp
@minerva minerva on 13 Jul 2 KB Initial commit
/*
 * Copyright (c) 2023, Sönke Holz <sholz8530@gmail.com>
 *
 * SPDX-License-Identifier: BSD-2-Clause
 */

#include <AK/Format.h>
#include <Kernel/Arch/riscv64/SBI.h>
#include <Kernel/Arch/riscv64/Timer.h>
#include <Kernel/Firmware/DeviceTree/DeviceTree.h>

namespace Kernel::RISCV64 {

static Timer* s_the;

Timer::Timer()
{
    m_frequency = DeviceTree::get().resolve_property("/cpus/timebase-frequency"sv).value().as<u32>();

    m_interrupt_interval = m_frequency / OPTIMAL_TICKS_PER_SECOND_RATE;

    set_compare(current_ticks() + m_interrupt_interval);
    RISCV64::CSR::set_bits<RISCV64::CSR::Address::SIE>(CSR::SIE::SupervisorTimerInterrupt);
}

NonnullLockRefPtr<Timer> Timer::initialize()
{
    VERIFY(!s_the);
    auto timer = adopt_lock_ref(*new Timer);
    s_the = timer.ptr();
    return timer;
}

Timer& Timer::the()
{
    VERIFY(s_the);
    return *s_the;
}

u64 Timer::current_ticks()
{
    return RISCV64::CSR::read<RISCV64::CSR::Address::TIME>();
}

void Timer::handle_interrupt()
{
    if (m_callback)
        m_callback();
    set_compare(current_ticks() + m_interrupt_interval);
}

void Timer::disable()
{
    RISCV64::CSR::clear_bits<RISCV64::CSR::Address::SIE>(CSR::SIE::SupervisorTimerInterrupt);
}

u64 Timer::update_time(u64& seconds_since_boot, u32& ticks_this_second, bool query_only)
{
    // Should only be called by the time keeper interrupt handler!
    u64 current_value = current_ticks();
    u64 delta_ticks = m_main_counter_drift;
    if (current_value >= m_main_counter_last_read) {
        delta_ticks += current_value - m_main_counter_last_read;
    } else {
        // the counter wrapped around
        delta_ticks += (NumericLimits<u64>::max() - m_main_counter_last_read + 1) + current_value;
    }

    u64 ticks_since_last_second = (u64)ticks_this_second + delta_ticks;
    auto frequency = ticks_per_second();
    seconds_since_boot += ticks_since_last_second / frequency;
    ticks_this_second = ticks_since_last_second % frequency;

    if (!query_only) {
        m_main_counter_drift = 0;
        m_main_counter_last_read = current_value;
    }

    // Return the time passed (in ns) since last time update_time was called
    return (delta_ticks * 1000000000ull) / frequency;
}

void Timer::set_compare(u64 compare)
{
    if (Processor::current().has_feature(CPUFeature::Sstc)) {
        RISCV64::CSR::write<RISCV64::CSR::Address::STIMECMP>(compare);
        return;
    }

    if (SBI::Timer::set_timer(compare).is_error())
        MUST(SBI::Legacy::set_timer(compare));
}

}