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
|
/* Copyright 2012 The Chromium OS Authors. All rights reserved.
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
/* Watchdog common code */
#include "common.h"
#include "cpu.h"
#include "panic.h"
#include "task.h"
#include "timer.h"
#include "watchdog.h"
/*
* As defined by Armv7-M Reference Manual B1.5.6 "Exception Entry Behavior",
* the structure of the saved context on the stack is:
* r0, r1, r2, r3, r12, lr, pc, psr, ...
*/
#define STACK_IDX_REG_LR 5
#define STACK_IDX_REG_PC 6
void __keep watchdog_trace(uint32_t excep_lr, uint32_t excep_sp)
{
uint32_t psp;
uint32_t *stack;
asm("mrs %0, psp" : "=r"(psp));
if ((excep_lr & 0xf) == 1) {
/* we were already in exception context */
stack = (uint32_t *)excep_sp;
} else {
/* we were in task context */
stack = (uint32_t *)psp;
}
panic_set_reason(PANIC_SW_WATCHDOG, stack[STACK_IDX_REG_PC],
(excep_lr & 0xf) == 1 ? 0xff : task_get_current());
/*
* This is our last breath, the last opportunity to sort out all
* matters. Flush and invalidate D-cache if cache enabled.
*/
if (IS_ENABLED(CONFIG_ARMV7M_CACHE))
cpu_clean_invalidate_dcache();
panic_printf("### WATCHDOG PC=%08x / LR=%08x / pSP=%08x ",
stack[STACK_IDX_REG_PC], stack[STACK_IDX_REG_LR], psp);
if ((excep_lr & 0xf) == 1)
panic_puts("(exc) ###\n");
else
panic_printf("(task %d) ###\n", task_get_current());
/* If we are blocked in a high priority IT handler, the following debug
* messages might not appear but they are useless in that situation. */
timer_print_info();
task_print_list();
}
|
