1 /*
2 * Copyright (c) 2018, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7 #include <lib/extensions/ras_arch.h>
8 #include <lib/utils_def.h>
9
10 /*
11 * Probe for error in memory-mapped registers containing error records
12 * implemented Standard Error Record format. Upon detecting an error, set probe
13 * data to the index of the record in error, and return 1; otherwise, return 0.
14 */
ser_probe_memmap(uintptr_t base,unsigned int size_num_k,int * probe_data)15 int ser_probe_memmap(uintptr_t base, unsigned int size_num_k, int *probe_data)
16 {
17 unsigned int num_records, num_group_regs, i;
18 uint64_t gsr;
19
20 assert(base != 0UL);
21
22 /* Only 4K supported for now */
23 assert(size_num_k == STD_ERR_NODE_SIZE_NUM_K);
24
25 num_records = (unsigned int)
26 (mmio_read_32(ERR_DEVID(base, size_num_k)) & ERR_DEVID_MASK);
27
28 /* A group register shows error status for 2^6 error records */
29 num_group_regs = (num_records >> 6U) + 1U;
30
31 /* Iterate through group registers to find a record in error */
32 for (i = 0; i < num_group_regs; i++) {
33 gsr = mmio_read_64(ERR_GSR(base, size_num_k, i));
34 if (gsr == 0ULL)
35 continue;
36
37 /* Return the index of the record in error */
38 if (probe_data != NULL)
39 *probe_data = (((int) (i << 6U)) + __builtin_ctzll(gsr));
40
41 return 1;
42 }
43
44 return 0;
45 }
46
47 /*
48 * Probe for error in System Registers where error records are implemented in
49 * Standard Error Record format. Upon detecting an error, set probe data to the
50 * index of the record in error, and return 1; otherwise, return 0.
51 */
ser_probe_sysreg(unsigned int idx_start,unsigned int num_idx,int * probe_data)52 int ser_probe_sysreg(unsigned int idx_start, unsigned int num_idx, int *probe_data)
53 {
54 unsigned int i;
55 uint64_t status;
56 unsigned int max_idx __unused =
57 ((unsigned int) read_erridr_el1()) & ERRIDR_MASK;
58
59 assert(idx_start < max_idx);
60 assert(check_u32_overflow(idx_start, num_idx) == 0);
61 assert((idx_start + num_idx - 1U) < max_idx);
62
63 for (i = 0; i < num_idx; i++) {
64 /* Select the error record */
65 ser_sys_select_record(idx_start + i);
66
67 /* Retrieve status register from the error record */
68 status = read_erxstatus_el1();
69
70 /* Check for valid field in status */
71 if (ERR_STATUS_GET_FIELD(status, V) != 0U) {
72 if (probe_data != NULL)
73 *probe_data = (int) i;
74 return 1;
75 }
76 }
77
78 return 0;
79 }
80