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
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
use std::sync::Arc;
use super::ArmDebugSequence;
use crate::architecture::arm::{
ap::MemoryAp, component::TraceSink, memory::CoresightComponent, ApAddress, ArmError,
ArmProbeInterface, DpAddress,
};
pub struct Stm32fSeries {}
impl Stm32fSeries {
pub fn create() -> Arc<Self> {
Arc::new(Self {})
}
}
mod dbgmcu {
use crate::architecture::arm::{memory::adi_v5_memory_interface::ArmProbe, ArmError};
use bitfield::bitfield;
const DBGMCU: u64 = 0xE004_2000;
bitfield! {
pub struct Control(u32);
impl Debug;
pub u8, trace_mode, set_tracemode: 7, 6;
pub u8, trace_ioen, set_traceioen: 5;
pub u8, dbg_standby, enable_standby_debug: 2;
pub u8, dbg_stop, enable_stop_debug: 1;
pub u8, dbg_sleep, enable_sleep_debug: 0;
}
impl Control {
const ADDRESS: u64 = 0x04;
pub fn read(memory: &mut dyn ArmProbe) -> Result<Self, ArmError> {
let contents = memory.read_word_32(DBGMCU + Self::ADDRESS)?;
Ok(Self(contents))
}
pub fn write(&mut self, memory: &mut dyn ArmProbe) -> Result<(), ArmError> {
memory.write_word_32(DBGMCU + Self::ADDRESS, self.0)
}
}
}
impl ArmDebugSequence for Stm32fSeries {
fn debug_device_unlock(
&self,
interface: &mut dyn ArmProbeInterface,
default_ap: MemoryAp,
_permissions: &crate::Permissions,
) -> Result<(), ArmError> {
let mut memory = interface.memory_interface(default_ap)?;
let mut cr = dbgmcu::Control::read(&mut *memory)?;
cr.enable_standby_debug(true);
cr.enable_sleep_debug(true);
cr.enable_stop_debug(true);
cr.write(&mut *memory)?;
Ok(())
}
fn debug_core_stop(&self, interface: &mut dyn ArmProbeInterface) -> Result<(), ArmError> {
let ap = MemoryAp::new(ApAddress {
dp: DpAddress::Default,
ap: 0,
});
let mut memory = interface.memory_interface(ap)?;
let mut cr = dbgmcu::Control::read(&mut *memory)?;
cr.enable_standby_debug(false);
cr.enable_sleep_debug(false);
cr.enable_stop_debug(false);
cr.write(&mut *memory)?;
Ok(())
}
fn trace_start(
&self,
interface: &mut dyn ArmProbeInterface,
components: &[CoresightComponent],
sink: &TraceSink,
) -> Result<(), ArmError> {
let mut memory = interface.memory_interface(components[0].ap)?;
let mut cr = dbgmcu::Control::read(&mut *memory)?;
if matches!(sink, TraceSink::Tpiu(_) | TraceSink::Swo(_)) {
cr.set_traceioen(true);
cr.set_tracemode(0);
} else {
cr.set_traceioen(false);
cr.set_tracemode(0);
}
cr.write(&mut *memory)?;
Ok(())
}
}