Atmosphere/thermosphere/src/utils.c

/*
 * Copyright (c) 2018-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 <string.h>
#include "utils.h"
#include "arm.h"
#include "spinlock.h"

__attribute__((noinline)) bool overlaps(u64 as, u64 ae, u64 bs, u64 be)
{
    if(as <= bs && bs < ae)
        return true;
    if(bs <= as && as < be)
        return true;
    return false;
}

// TODO: put that elsewhere
bool readEl1Memory(void *dst, uintptr_t addr, size_t size)
{
    bool valid;

    u64 flags = maskIrq();
    uintptr_t pa = get_physical_address_el1_stage12(&valid, addr);
    restoreInterruptFlags(flags);

    if (!valid) {
        return false;
    }

    flush_dcache_range((const void *)pa, (const void *)(pa + size));
    memcpy(dst, (const void *)pa, size);

    return true;
}

bool writeEl1Memory(uintptr_t addr, const void *src, size_t size)
{
    bool valid;

    u64 flags = maskIrq();
    uintptr_t pa = get_physical_address_el1_stage12(&valid, addr);
    restoreInterruptFlags(flags);

    if (!valid) {
        return false;
    }

    flush_dcache_range((const void *)pa, (const void *)(pa + size));
    memcpy((void *)pa, src, size);
    flush_dcache_range((const void *)pa, (const void *)(pa + size));
    invalidate_icache_all();

    __tlb_invalidate_el1_stage12();
    __dsb_sy();
    __isb();

    return true;
}