diff --git a/cortex-m/src/coprocessor.rs b/cortex-m/src/coprocessor.rs new file mode 100644 index 00000000..2e286f9f --- /dev/null +++ b/cortex-m/src/coprocessor.rs @@ -0,0 +1,104 @@ +//! Coprocessor access assembly instructions. + +/// This instruction moves one Register to a Coprocessor Register. +/// This function generates inline assembly and needs the instruction configuration +/// during compilation time (i.e. as `const`). +/// The values of the constants required by this function should be defined by +/// the coprocessor's reference manual. +/// - CP: The coprocessor's index. +/// - OP1: First optional operation for the coprocessor. +/// - CRN: Coprocessor register N. +/// - CRM: Coprocessor register M. +/// - OP2: Second optional operation for the coprocessor. +#[inline(always)] +pub unsafe fn mcr( + value: u32, +) { + core::arch::asm!( + "MCR p{cp}, #{op1}, {0}, c{crn}, c{crm}, #{op2}", + in(reg) value, + cp = const CP, + op1 = const OP1, + crn = const CRN, + crm = const CRM, + op2 = const OP2, + options(nostack, nomem) + ); +} + +/// This instruction moves one Coprocessor Register to a Register. +/// This function generates inline assembly and needs the instruction configuration +/// during compilation time (i.e. as `const`). +/// The values of the constants required by this function should be defined by +/// the coprocessor's reference manual. +/// - CP: The coprocessor's index. +/// - OP1: First optional operation for the coprocessor. +/// - CRN: Coprocessor register N. +/// - CRM: Coprocessor register M. +/// - OP2: Second optional operation for the coprocessor. +#[inline(always)] +pub unsafe fn mrc( +) -> u32 { + let a: u32; + + core::arch::asm!( + "MRC p{cp}, #{op1}, {0}, c{crn}, c{crm}, #{op2}", + out(reg) a, + cp = const CP, + op1 = const OP1, + crn = const CRN, + crm = const CRM, + op2 = const OP2, + options(nostack, nomem) + ); + + a +} + +/// This instruction moves two Registers to Coprocessor Registers. +/// This function generates inline assembly and needs the instruction configuration +/// during compilation time (i.e. as `const`). +/// The values of the constants required by this function should be defined by +/// the coprocessor's reference manual. +/// - CP: The coprocessor's index. +/// - OP1: First optional operation for the coprocessor. +/// - CRM: Coprocessor register M. +#[inline(always)] +pub unsafe fn mcrr(a: u32, b: u32) { + core::arch::asm!( + "MCRR p{cp}, #{op1}, {0}, {1}, c{crm}", + in(reg) a, + in(reg) b, + cp = const CP, + op1 = const OP1, + crm = const CRM, + options(nostack, nomem) + ); +} + +/// This instruction moves two Coprocessor Registers to Registers. +/// This function generates inline assembly and needs the instruction configuration +/// during compilation time (i.e. as `const`). +/// The values of the constants required by this function should be defined by +/// the coprocessor's reference manual. +/// - CP: The coprocessor's index. +/// - OP1: First optional operation for the coprocessor. +/// - CRM: Coprocessor register M. +#[inline(always)] +pub unsafe fn mrrc() -> (u32, u32) { + // Preallocate the values. + let a: u32; + let b: u32; + + core::arch::asm!( + "MRRC p{cp}, #{opc}, {0}, {1}, c{crm}", + out(reg) a, + out(reg) b, + cp = const CP, + opc = const OPC, + crm = const CRM, + options(nostack, nomem) + ); + + (a, b) +} diff --git a/cortex-m/src/lib.rs b/cortex-m/src/lib.rs index c103322b..fcd38037 100644 --- a/cortex-m/src/lib.rs +++ b/cortex-m/src/lib.rs @@ -105,6 +105,8 @@ mod macros; pub mod asm; #[cfg(armv8m)] pub mod cmse; +#[cfg(not(armv6m))] +pub mod coprocessor; pub mod delay; pub mod interrupt; #[cfg(all(not(armv6m), not(armv8m_base)))]