diff --git a/libcortex_r5/src/cache.rs b/libcortex_r5/src/cache.rs new file mode 100644 index 0000000..3361f0d --- /dev/null +++ b/libcortex_r5/src/cache.rs @@ -0,0 +1,87 @@ +/// Basically same as the Cortex A9 but with no L2 +pub use libcortex_a9::cache::{ + iciallu, + dcisw, + dccsw, + dccisw, + dccimvac, + dccmvac, + dcimvac, + object_cache_line_addrs, + slice_cache_line_addrs, + CACHE_LINE, + CACHE_LINE_MASK +}; +use super::asm::{dmb, dsb}; + +#[inline(always)] +pub fn dciall() { + unsafe { + llvm_asm!("mcr p15, 0, $0, c15, c5, 0") + } +} + +// D$ clean and invalidate +pub fn dcci(object: &T) { + dmb(); + for addr in object_cache_line_addrs(object) { + dccimvac(addr); + } + dsb(); +} + +pub fn dcci_slice(slice: &[T]) { + dmb(); + for addr in slice_cache_line_addrs(slice) { + dccimvac(addr); + } + dsb(); +} + +// D$ clean +pub fn dcc(object: &T) { + dmb(); + for addr in object_cache_line_addrs(object) { + dccmvac(addr); + } + dsb(); +} + +pub fn dcc_slice(slice: &[T]) { + if slice.len() == 0 { + return; + } + dmb(); + for addr in slice_cache_line_addrs(slice) { + dccmvac(addr); + } + dsb(); +} + +// D$ invalidate +pub unsafe fn dci(object: &mut T) { + let first_addr = object as *const _ as usize; + let beyond_addr = (object as *const _ as usize) + core::mem::size_of_val(object); + assert_eq!(first_addr & CACHE_LINE_MASK, 0, "dci object first_addr must be aligned"); + assert_eq!(beyond_addr & CACHE_LINE_MASK, 0, "dci object beyond_addr must be aligned"); + + dmb(); + for addr in (first_addr..beyond_addr).step_by(CACHE_LINE) { + dcimvac(addr); + } + dsb(); +} + +pub unsafe fn dci_slice(slice: &mut [T]) { + let first_addr = &slice[0] as *const _ as usize; + let beyond_addr = (&slice[slice.len() - 1] as *const _ as usize) + + core::mem::size_of_val(&slice[slice.len() - 1]); + assert_eq!(first_addr & CACHE_LINE_MASK, 0, "dci slice first_addr must be aligned"); + assert_eq!(beyond_addr & CACHE_LINE_MASK, 0, "dci slice beyond_addr must be aligned"); + + dmb(); + for addr in (first_addr..beyond_addr).step_by(CACHE_LINE) { + dcimvac(addr); + } + dsb(); +} \ No newline at end of file