diff options
Diffstat (limited to 'cortex_m')
| -rw-r--r-- | cortex_m/debug.h | 8 |
1 files changed, 8 insertions, 0 deletions
diff --git a/cortex_m/debug.h b/cortex_m/debug.h index 8134829..7117309 100644 --- a/cortex_m/debug.h +++ b/cortex_m/debug.h @@ -20,6 +20,14 @@ struct ITM_reg_t { volatile uint32_t LSR; // FIXME - only supports first 32 stimulus ports + void stim_blocking(unsigned stim, char data) { + if (!(this->TER[0] & (1<<stim))) { + return; + } + while (!(this->STIM[stim].u8 & 1)) + ; + this->STIM[stim].u8 = data; + } void stim_blocking(unsigned stim, uint8_t data) { if (!(this->TER[0] & (1<<stim))) { return; |