cache.hpp

Go to the documentation of this file.

 /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
  *  _____.___.                 .___                    .__.__      *
  *  \__  |   | ____   ____   __| _/___________    _____|__|  |     *
  *   /   |   |/ ___\ / ___\ / __ |\_  __ \__  \  /  ___/  |  |     *
  *   \____   / /_/  > /_/  > /_/ | |  | \// __ \_\___ \|  |  |__   *
  *   / ______\___  /\___  /\____ | |__|  (____  /____  >__|____/   *
  *   \/     /_____//_____/      \/            \/     \/            *
  *                          - Midgard -                            *
  * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
  * This software can be used by students and other personal of the *
  * Bern University of Applied Sciences under the terms of the MIT  *
  * license.                                                        *
  * For other persons this software is under the terms of the GNU   *
  * General Public License version 2.                               *
  *                                                                 *
  * Copyright © 2021, Bern University of Applied Sciences.     *
  * All rights reserved.                                            *
  * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
#pragma once
 
#include <cpp/common/types.hpp>
#include <cpp/common/attributes.hpp>
 
#include <cpp/midgard/core/instructions.hpp>
 
#include <core_cm7.h>
 
namespace bsp::core {
 
    constexpr auto DCacheLineSize = 32; 
    constexpr auto ICacheLineSize = 32; 
 
    ALWAYS_INLINE void invalidateICache() {
        DSB();
        ISB();
 
        SCB->ICIALLU = 0UL;
 
        DSB();
        ISB();
    }
 
    ALWAYS_INLINE void invalidateICache(void *address, size_t size) {
        if (size > 0) {
            addr_t invalidateAddress = reinterpret_cast<addr_t>(address);
            ssize_t invalidateSize = size + (invalidateAddress & (ICacheLineSize - 1));
 
            DSB();
 
            do {
                SCB->ICIMVAU = invalidateAddress;
 
                invalidateAddress += ICacheLineSize;
                invalidateSize -= ICacheLineSize;
            } while (invalidateSize > 0);
 
            DSB();
            ISB();
        }
    }
 
}