hc
2023-10-25 6c2073b7aa40e29d0eca7d571dd7bc590c7ecaa7
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
115
116
117
118
119
120
121
122
123
124
125
126
127
// SPDX-License-Identifier: GPL-2.0
/**
 * imr_selftest.c -- Intel Isolated Memory Region self-test driver
 *
 * Copyright(c) 2013 Intel Corporation.
 * Copyright(c) 2015 Bryan O'Donoghue <pure.logic@nexus-software.ie>
 *
 * IMR self test. The purpose of this module is to run a set of tests on the
 * IMR API to validate it's sanity. We check for overlapping, reserved
 * addresses and setup/teardown sanity.
 *
 */
 
#include <asm-generic/sections.h>
#include <asm/cpu_device_id.h>
#include <asm/imr.h>
#include <linux/init.h>
#include <linux/mm.h>
#include <linux/types.h>
 
#define SELFTEST KBUILD_MODNAME ": "
/**
 * imr_self_test_result - Print result string for self test.
 *
 * @res:    result code - true if test passed false otherwise.
 * @fmt:    format string.
 * ...        variadic argument list.
 */
static __printf(2, 3)
void __init imr_self_test_result(int res, const char *fmt, ...)
{
   va_list vlist;
 
   /* Print pass/fail. */
   if (res)
       pr_info(SELFTEST "pass ");
   else
       pr_info(SELFTEST "fail ");
 
   /* Print variable string. */
   va_start(vlist, fmt);
   vprintk(fmt, vlist);
   va_end(vlist);
 
   /* Optional warning. */
   WARN(res == 0, "test failed");
}
#undef SELFTEST
 
/**
 * imr_self_test
 *
 * Verify IMR self_test with some simple tests to verify overlap,
 * zero sized allocations and 1 KiB sized areas.
 *
 */
static void __init imr_self_test(void)
{
   phys_addr_t base  = virt_to_phys(&_text);
   size_t size = virt_to_phys(&__end_rodata) - base;
   const char *fmt_over = "overlapped IMR @ (0x%08lx - 0x%08lx)\n";
   int ret;
 
   /* Test zero zero. */
   ret = imr_add_range(0, 0, 0, 0);
   imr_self_test_result(ret < 0, "zero sized IMR\n");
 
   /* Test exact overlap. */
   ret = imr_add_range(base, size, IMR_CPU, IMR_CPU);
   imr_self_test_result(ret < 0, fmt_over, __va(base), __va(base + size));
 
   /* Test overlap with base inside of existing. */
   base += size - IMR_ALIGN;
   ret = imr_add_range(base, size, IMR_CPU, IMR_CPU);
   imr_self_test_result(ret < 0, fmt_over, __va(base), __va(base + size));
 
   /* Test overlap with end inside of existing. */
   base -= size + IMR_ALIGN * 2;
   ret = imr_add_range(base, size, IMR_CPU, IMR_CPU);
   imr_self_test_result(ret < 0, fmt_over, __va(base), __va(base + size));
 
   /* Test that a 1 KiB IMR @ zero with read/write all will bomb out. */
   ret = imr_add_range(0, IMR_ALIGN, IMR_READ_ACCESS_ALL,
               IMR_WRITE_ACCESS_ALL);
   imr_self_test_result(ret < 0, "1KiB IMR @ 0x00000000 - access-all\n");
 
   /* Test that a 1 KiB IMR @ zero with CPU only will work. */
   ret = imr_add_range(0, IMR_ALIGN, IMR_CPU, IMR_CPU);
   imr_self_test_result(ret >= 0, "1KiB IMR @ 0x00000000 - cpu-access\n");
   if (ret >= 0) {
       ret = imr_remove_range(0, IMR_ALIGN);
       imr_self_test_result(ret == 0, "teardown - cpu-access\n");
   }
 
   /* Test 2 KiB works. */
   size = IMR_ALIGN * 2;
   ret = imr_add_range(0, size, IMR_READ_ACCESS_ALL, IMR_WRITE_ACCESS_ALL);
   imr_self_test_result(ret >= 0, "2KiB IMR @ 0x00000000\n");
   if (ret >= 0) {
       ret = imr_remove_range(0, size);
       imr_self_test_result(ret == 0, "teardown 2KiB\n");
   }
}
 
static const struct x86_cpu_id imr_ids[] __initconst = {
   { X86_VENDOR_INTEL, 5, 9 },    /* Intel Quark SoC X1000. */
   {}
};
 
/**
 * imr_self_test_init - entry point for IMR driver.
 *
 * return: -ENODEV for no IMR support 0 if good to go.
 */
static int __init imr_self_test_init(void)
{
   if (x86_match_cpu(imr_ids))
       imr_self_test();
   return 0;
}
 
/**
 * imr_self_test_exit - exit point for IMR code.
 *
 * return:
 */
device_initcall(imr_self_test_init);