Commit | Line | Data |
---|---|---|
6251d380 BW |
1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* | |
3 | * ARM APMT table support. | |
4 | * Design document number: ARM DEN0117. | |
5 | * | |
6 | * Copyright (c) 2022, NVIDIA CORPORATION & AFFILIATES. | |
7 | * | |
8 | */ | |
9 | ||
10 | #define pr_fmt(fmt) "ACPI: APMT: " fmt | |
11 | ||
12 | #include <linux/acpi.h> | |
6251d380 BW |
13 | #include <linux/init.h> |
14 | #include <linux/kernel.h> | |
15 | #include <linux/platform_device.h> | |
fcea0ccf | 16 | #include "init.h" |
6251d380 BW |
17 | |
18 | #define DEV_NAME "arm-cs-arch-pmu" | |
19 | ||
20 | /* There can be up to 3 resources: page 0 and 1 address, and interrupt. */ | |
21 | #define DEV_MAX_RESOURCE_COUNT 3 | |
22 | ||
23 | /* Root pointer to the mapped APMT table */ | |
24 | static struct acpi_table_header *apmt_table; | |
25 | ||
26 | static int __init apmt_init_resources(struct resource *res, | |
39522031 | 27 | struct acpi_apmt_node *node) |
6251d380 BW |
28 | { |
29 | int irq, trigger; | |
30 | int num_res = 0; | |
31 | ||
32 | res[num_res].start = node->base_address0; | |
33 | res[num_res].end = node->base_address0 + SZ_4K - 1; | |
34 | res[num_res].flags = IORESOURCE_MEM; | |
35 | ||
36 | num_res++; | |
37 | ||
87b3b6d5 RM |
38 | if (node->flags & ACPI_APMT_FLAGS_DUAL_PAGE) { |
39 | res[num_res].start = node->base_address1; | |
40 | res[num_res].end = node->base_address1 + SZ_4K - 1; | |
41 | res[num_res].flags = IORESOURCE_MEM; | |
6251d380 | 42 | |
87b3b6d5 RM |
43 | num_res++; |
44 | } | |
6251d380 BW |
45 | |
46 | if (node->ovflw_irq != 0) { | |
47 | trigger = (node->ovflw_irq_flags & ACPI_APMT_OVFLW_IRQ_FLAGS_MODE); | |
48 | trigger = (trigger == ACPI_APMT_OVFLW_IRQ_FLAGS_MODE_LEVEL) ? | |
49 | ACPI_LEVEL_SENSITIVE : ACPI_EDGE_SENSITIVE; | |
50 | irq = acpi_register_gsi(NULL, node->ovflw_irq, trigger, | |
51 | ACPI_ACTIVE_HIGH); | |
52 | ||
53 | if (irq <= 0) { | |
54 | pr_warn("APMT could not register gsi hwirq %d\n", irq); | |
55 | return num_res; | |
56 | } | |
57 | ||
58 | res[num_res].start = irq; | |
59 | res[num_res].end = irq; | |
60 | res[num_res].flags = IORESOURCE_IRQ; | |
61 | ||
62 | num_res++; | |
63 | } | |
64 | ||
65 | return num_res; | |
66 | } | |
67 | ||
68 | /** | |
69 | * apmt_add_platform_device() - Allocate a platform device for APMT node | |
70 | * @node: Pointer to device ACPI APMT node | |
39522031 | 71 | * @fwnode: fwnode associated with the APMT node |
6251d380 BW |
72 | * |
73 | * Returns: 0 on success, <0 failure | |
74 | */ | |
75 | static int __init apmt_add_platform_device(struct acpi_apmt_node *node, | |
39522031 | 76 | struct fwnode_handle *fwnode) |
6251d380 BW |
77 | { |
78 | struct platform_device *pdev; | |
79 | int ret, count; | |
80 | struct resource res[DEV_MAX_RESOURCE_COUNT]; | |
81 | ||
82 | pdev = platform_device_alloc(DEV_NAME, PLATFORM_DEVID_AUTO); | |
83 | if (!pdev) | |
84 | return -ENOMEM; | |
85 | ||
86 | memset(res, 0, sizeof(res)); | |
87 | ||
88 | count = apmt_init_resources(res, node); | |
89 | ||
90 | ret = platform_device_add_resources(pdev, res, count); | |
91 | if (ret) | |
92 | goto dev_put; | |
93 | ||
94 | /* | |
95 | * Add a copy of APMT node pointer to platform_data to be used to | |
96 | * retrieve APMT data information. | |
97 | */ | |
98 | ret = platform_device_add_data(pdev, &node, sizeof(node)); | |
99 | if (ret) | |
100 | goto dev_put; | |
101 | ||
102 | pdev->dev.fwnode = fwnode; | |
103 | ||
104 | ret = platform_device_add(pdev); | |
105 | ||
106 | if (ret) | |
107 | goto dev_put; | |
108 | ||
109 | return 0; | |
110 | ||
111 | dev_put: | |
112 | platform_device_put(pdev); | |
113 | ||
114 | return ret; | |
115 | } | |
116 | ||
117 | static int __init apmt_init_platform_devices(void) | |
118 | { | |
119 | struct acpi_apmt_node *apmt_node; | |
120 | struct acpi_table_apmt *apmt; | |
121 | struct fwnode_handle *fwnode; | |
122 | u64 offset, end; | |
123 | int ret; | |
124 | ||
125 | /* | |
126 | * apmt_table and apmt both point to the start of APMT table, but | |
127 | * have different struct types | |
128 | */ | |
129 | apmt = (struct acpi_table_apmt *)apmt_table; | |
130 | offset = sizeof(*apmt); | |
131 | end = apmt->header.length; | |
132 | ||
133 | while (offset < end) { | |
134 | apmt_node = ACPI_ADD_PTR(struct acpi_apmt_node, apmt, | |
135 | offset); | |
136 | ||
137 | fwnode = acpi_alloc_fwnode_static(); | |
138 | if (!fwnode) | |
139 | return -ENOMEM; | |
140 | ||
141 | ret = apmt_add_platform_device(apmt_node, fwnode); | |
142 | if (ret) { | |
143 | acpi_free_fwnode_static(fwnode); | |
144 | return ret; | |
145 | } | |
146 | ||
147 | offset += apmt_node->length; | |
148 | } | |
149 | ||
150 | return 0; | |
151 | } | |
152 | ||
153 | void __init acpi_apmt_init(void) | |
154 | { | |
155 | acpi_status status; | |
156 | int ret; | |
157 | ||
158 | /** | |
159 | * APMT table nodes will be used at runtime after the apmt init, | |
160 | * so we don't need to call acpi_put_table() to release | |
161 | * the APMT table mapping. | |
162 | */ | |
163 | status = acpi_get_table(ACPI_SIG_APMT, 0, &apmt_table); | |
164 | ||
165 | if (ACPI_FAILURE(status)) { | |
166 | if (status != AE_NOT_FOUND) { | |
167 | const char *msg = acpi_format_exception(status); | |
168 | ||
169 | pr_err("Failed to get APMT table, %s\n", msg); | |
170 | } | |
171 | ||
172 | return; | |
173 | } | |
174 | ||
175 | ret = apmt_init_platform_devices(); | |
176 | if (ret) { | |
177 | pr_err("Failed to initialize APMT platform devices, ret: %d\n", ret); | |
178 | acpi_put_table(apmt_table); | |
179 | } | |
180 | } |