nold/Atmosphere
1
0
Fork 0
mirror of https://github.com/Atmosphere-NX/Atmosphere synced 2024-11-15 01:26:34 +00:00
Code Issues Projects Releases Packages Wiki Activity

thermosphere: interrupt mask guard

Browse source
This commit is contained in:
TuxSH 2020-02-11 21:41:14 +00:00
parent dd9b3ddb0d
commit c99a77a0c3
3 changed files with 63 additions and 34 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

54
thermosphere/src/cpu/hvisor_cpu_interrupt_mask_guard.hpp Normal file
View file

@ -0,0 +1,54 @@
/*
* Copyright (c) 2019-2020 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/>.
*/
#pragma once
#include "hvisor_cpu_sysreg_general.hpp"
namespace ams::hvisor::cpu {
static inline u64 MaskIrq()
{
u64 daif = THERMOSPHERE_GET_SYSREG(daif);
THERMOSPHERE_SET_SYSREG_IMM(daifset, BIT(1));
return daif;
}
static inline u64 UnmaskIrq()
{
u64 daif = THERMOSPHERE_GET_SYSREG(daif);
THERMOSPHERE_SET_SYSREG_IMM(daifclr, BIT(1));
return daif;
}
static inline void RestoreInterruptFlags(u64 flags)
{
THERMOSPHERE_SET_SYSREG(daif, flags);
}
class InterruptMaskGuard final {
NON_COPYABLE(InterruptMaskGuard);
NON_MOVEABLE(InterruptMaskGuard);
private:
u64 m_flags;
public:
ALWAYS_INLINE InterruptMaskGuard() : m_flags(MaskIrq()) {}
ALWAYS_INLINE ~InterruptMaskGuard()
{
RestoreInterruptFlags(m_flags);
}
};
}

23
thermosphere/src/hvisor_irq_manager.cpp
View file

@ -17,7 +17,7 @@
#include <mutex>
#include "hvisor_irq_manager.hpp"
#include "cpu/hvisor_cpu_interrupt_mask_guard.hpp"
#include "platform/interrupt_config.h"
#include "core_ctx.h"
#include "guest_timers.h"
@ -159,8 +159,8 @@ namespace ams::hvisor {
void IrqManager::Initialize()
{
u64 flags = MaskIrq();
m_lock.lock();
cpu::InterruptMaskGuard mg{};
std::scoped_lock lk{m_lock};
InitializeGic();
for (u32 i = 0; i < MaxSgi; i++) {
@ -170,27 +170,22 @@ namespace ams::hvisor {
DoConfigureInterrupt(GIC_IRQID_MAINTENANCE, hostPriority, true);
vgicInit();
m_lock.unlock();
RestoreInterruptFlags(flags);
}
void IrqManager::ConfigureInterrupt(u32 id, u8 prio, bool isLevelSensitive)
{
u64 flags = MaskIrq();
m_lock.lock();
cpu::InterruptMaskGuard mg{};
std::scoped_lock lk{m_lock};
DoConfigureInterrupt(id, prio, isLevelSensitive);
m_lock.unlock();
RestoreInterruptFlags(flags);
}
void IrqManager::SetInterruptAffinity(u32 id, u8 affinity)
{
u64 flags = MaskIrq();
m_lock.lock();
cpu::InterruptMaskGuard mg{};
std::scoped_lock lk{m_lock};
DoSetInterruptAffinity(id, affinity);
m_lock.unlock();
RestoreInterruptFlags(flags);
}
void IrqManager::HandleInterrupt(ExceptionStackFrame *frame)

20
thermosphere/src/hvisor_irq_manager.hpp
View file

@ -18,7 +18,6 @@
#include "hvisor_gicv2.hpp"
#include "hvisor_synchronization.hpp"
#include "cpu/hvisor_cpu_sysreg_general.hpp"
#include "memory_map.h"
#include "exceptions.h" // TODO
@ -93,25 +92,6 @@ namespace ams::hvisor {
gicd->sgir = GicV2Distributor::ForwardToAllOthers << 24 | id;
}
static u64 MaskIrq()
{
u64 daif = THERMOSPHERE_GET_SYSREG(daif);
THERMOSPHERE_SET_SYSREG_IMM(daifset, BIT(1));
return daif;
}
static u64 UnmaskIrq()
{
u64 daif = THERMOSPHERE_GET_SYSREG(daif);
THERMOSPHERE_SET_SYSREG_IMM(daifclr, BIT(1));
return daif;
}
static void RestoreInterruptFlags(u64 flags)
{
THERMOSPHERE_SET_SYSREG(daif, flags);
}
static IrqManager &GetInstance() { return instance; }
static void HandleInterrupt(ExceptionStackFrame *frame);