1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67

#[macro_use]
mod register_generation;

pub mod custom_ap;
pub mod generic_ap;
pub mod memory_ap;

use std::error::Error;
use std::fmt;

use crate::coresight::ap_access::AccessPort;
use crate::coresight::common::Register;

#[derive(Debug, PartialEq)]
pub enum AccessPortError {
    InvalidAccessPortNumber,
    MemoryNotAligned,
    RegisterReadError { addr: u8, name: &'static str },
    RegisterWriteError { addr: u8, name: &'static str },
    OutOfBoundsError,
    CtrlAPNotFound,
}

impl Error for AccessPortError {}

impl fmt::Display for AccessPortError {
    fn fmt(&self, f: &mut fmt::Formatter) -> fmt::Result {
        use AccessPortError::*;

        match self {
            InvalidAccessPortNumber => write!(f, "Invalid Access Port Number"),
            MemoryNotAligned => write!(f, "Misaligned memory access"),
            RegisterReadError { addr, name } => write!(
                f,
                "Failed to read register {}, address 0x{:08x}",
                name, addr
            ),
            RegisterWriteError { addr, name } => write!(
                f,
                "Failed to write register {}, address 0x{:08x}",
                name, addr
            ),
            OutOfBoundsError => write!(f, "Out of bounds access"),
            CtrlAPNotFound => write!(f, "Could not find Nordic's CTRL-AP"),
        }
    }
}

impl AccessPortError {
    pub fn register_read_error<R: Register>() -> AccessPortError {
        AccessPortError::RegisterReadError {
            addr: R::ADDRESS,
            name: R::NAME,
        }
    }

    pub fn register_write_error<R: Register>() -> AccessPortError {
        AccessPortError::RegisterWriteError {
            addr: R::ADDRESS,
            name: R::NAME,
        }
    }
}

pub trait APRegister<PORT: AccessPort>: Register + Sized {
    const APBANKSEL: u8;
}