boot: refactor to use sts::boot namespace
This commit is contained in:
@@ -14,44 +14,54 @@
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include "boot_functions.hpp"
|
||||
#include "boot_pmc_wrapper.hpp"
|
||||
|
||||
static constexpr u32 SmcFunctionId_AtmosphereReadWriteRegister = 0xF0000002;
|
||||
namespace sts::boot {
|
||||
|
||||
static constexpr u32 PmcPhysStart = 0x7000E400;
|
||||
static constexpr u32 PmcPhysEnd = 0x7000EFFF;
|
||||
namespace {
|
||||
|
||||
static inline bool IsValidPmcAddress(u32 phys_addr) {
|
||||
return (phys_addr & 3) == 0 && PmcPhysStart <= phys_addr && phys_addr <= PmcPhysEnd;
|
||||
}
|
||||
/* Convenience definitions. */
|
||||
constexpr u32 SmcFunctionId_AtmosphereReadWriteRegister = 0xF0000002;
|
||||
|
||||
static inline u32 SmcAtmosphereReadWriteRegister(u32 phys_addr, u32 value, u32 mask) {
|
||||
SecmonArgs args;
|
||||
constexpr u32 PmcPhysStart = 0x7000E400;
|
||||
constexpr u32 PmcPhysEnd = 0x7000EFFF;
|
||||
|
||||
/* Helpers. */
|
||||
bool IsValidPmcAddress(u32 phys_addr) {
|
||||
return (phys_addr & 3) == 0 && PmcPhysStart <= phys_addr && phys_addr <= PmcPhysEnd;
|
||||
}
|
||||
|
||||
inline u32 SmcAtmosphereReadWriteRegister(u32 phys_addr, u32 value, u32 mask) {
|
||||
SecmonArgs args;
|
||||
|
||||
args.X[0] = SmcFunctionId_AtmosphereReadWriteRegister;
|
||||
args.X[1] = phys_addr;
|
||||
args.X[2] = mask;
|
||||
args.X[3] = value;
|
||||
R_ASSERT(svcCallSecureMonitor(&args));
|
||||
if (args.X[0] != 0) {
|
||||
std::abort();
|
||||
}
|
||||
|
||||
return static_cast<u32>(args.X[1]);
|
||||
}
|
||||
|
||||
args.X[0] = SmcFunctionId_AtmosphereReadWriteRegister;
|
||||
args.X[1] = phys_addr;
|
||||
args.X[2] = mask;
|
||||
args.X[3] = value;
|
||||
svcCallSecureMonitor(&args);
|
||||
if (args.X[0] != 0) {
|
||||
std::abort();
|
||||
}
|
||||
|
||||
return static_cast<u32>(args.X[1]);
|
||||
}
|
||||
u32 ReadPmcRegister(u32 phys_addr) {
|
||||
if (!IsValidPmcAddress(phys_addr)) {
|
||||
std::abort();
|
||||
}
|
||||
|
||||
u32 Boot::ReadPmcRegister(u32 phys_addr) {
|
||||
if (!IsValidPmcAddress(phys_addr)) {
|
||||
std::abort();
|
||||
return SmcAtmosphereReadWriteRegister(phys_addr, 0, 0);
|
||||
}
|
||||
|
||||
return SmcAtmosphereReadWriteRegister(phys_addr, 0, 0);
|
||||
}
|
||||
void WritePmcRegister(u32 phys_addr, u32 value, u32 mask) {
|
||||
if (!IsValidPmcAddress(phys_addr)) {
|
||||
std::abort();
|
||||
}
|
||||
|
||||
void Boot::WritePmcRegister(u32 phys_addr, u32 value, u32 mask) {
|
||||
if (!IsValidPmcAddress(phys_addr)) {
|
||||
std::abort();
|
||||
SmcAtmosphereReadWriteRegister(phys_addr, value, mask);
|
||||
}
|
||||
|
||||
SmcAtmosphereReadWriteRegister(phys_addr, value, mask);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user