1b0013e03SChen Yu // SPDX-License-Identifier: GPL-2.0
2b0013e03SChen Yu /*
3b0013e03SChen Yu * ACPI Platform Firmware Runtime Telemetry driver
4b0013e03SChen Yu *
5b0013e03SChen Yu * Copyright (C) 2021 Intel Corporation
6b0013e03SChen Yu * Author: Chen Yu <yu.c.chen@intel.com>
7b0013e03SChen Yu *
8b0013e03SChen Yu * This driver allows user space to fetch telemetry data from the
9b0013e03SChen Yu * firmware with the help of the Platform Firmware Runtime Telemetry
10b0013e03SChen Yu * interface.
11b0013e03SChen Yu */
12b0013e03SChen Yu #include <linux/acpi.h>
13b0013e03SChen Yu #include <linux/device.h>
14b0013e03SChen Yu #include <linux/err.h>
15b0013e03SChen Yu #include <linux/errno.h>
16b0013e03SChen Yu #include <linux/file.h>
17b0013e03SChen Yu #include <linux/fs.h>
18b0013e03SChen Yu #include <linux/miscdevice.h>
19b0013e03SChen Yu #include <linux/module.h>
20b0013e03SChen Yu #include <linux/mm.h>
21b0013e03SChen Yu #include <linux/platform_device.h>
22b0013e03SChen Yu #include <linux/string.h>
23b0013e03SChen Yu #include <linux/uaccess.h>
24b0013e03SChen Yu #include <linux/uio.h>
25b0013e03SChen Yu #include <linux/uuid.h>
26b0013e03SChen Yu
27b0013e03SChen Yu #include <uapi/linux/pfrut.h>
28b0013e03SChen Yu
29b0013e03SChen Yu #define PFRT_LOG_EXEC_IDX 0
30b0013e03SChen Yu #define PFRT_LOG_HISTORY_IDX 1
31b0013e03SChen Yu
32b0013e03SChen Yu #define PFRT_LOG_ERR 0
33b0013e03SChen Yu #define PFRT_LOG_WARN 1
34b0013e03SChen Yu #define PFRT_LOG_INFO 2
35b0013e03SChen Yu #define PFRT_LOG_VERB 4
36b0013e03SChen Yu
37b0013e03SChen Yu #define PFRT_FUNC_SET_LEV 1
38b0013e03SChen Yu #define PFRT_FUNC_GET_LEV 2
39b0013e03SChen Yu #define PFRT_FUNC_GET_DATA 3
40b0013e03SChen Yu
41b0013e03SChen Yu #define PFRT_REVID_1 1
42b0013e03SChen Yu #define PFRT_REVID_2 2
43b0013e03SChen Yu #define PFRT_DEFAULT_REV_ID PFRT_REVID_1
44b0013e03SChen Yu
45b0013e03SChen Yu enum log_index {
46b0013e03SChen Yu LOG_STATUS_IDX = 0,
47b0013e03SChen Yu LOG_EXT_STATUS_IDX = 1,
48b0013e03SChen Yu LOG_MAX_SZ_IDX = 2,
49b0013e03SChen Yu LOG_CHUNK1_LO_IDX = 3,
50b0013e03SChen Yu LOG_CHUNK1_HI_IDX = 4,
51b0013e03SChen Yu LOG_CHUNK1_SZ_IDX = 5,
52b0013e03SChen Yu LOG_CHUNK2_LO_IDX = 6,
53b0013e03SChen Yu LOG_CHUNK2_HI_IDX = 7,
54b0013e03SChen Yu LOG_CHUNK2_SZ_IDX = 8,
55b0013e03SChen Yu LOG_ROLLOVER_CNT_IDX = 9,
56b0013e03SChen Yu LOG_RESET_CNT_IDX = 10,
57b0013e03SChen Yu LOG_NR_IDX
58b0013e03SChen Yu };
59b0013e03SChen Yu
60b0013e03SChen Yu struct pfrt_log_device {
61b0013e03SChen Yu int index;
62b0013e03SChen Yu struct pfrt_log_info info;
63b0013e03SChen Yu struct device *parent_dev;
64b0013e03SChen Yu struct miscdevice miscdev;
65b0013e03SChen Yu };
66b0013e03SChen Yu
67b0013e03SChen Yu /* pfrt_guid is the parameter for _DSM method */
68b0013e03SChen Yu static const guid_t pfrt_log_guid =
69b0013e03SChen Yu GUID_INIT(0x75191659, 0x8178, 0x4D9D, 0xB8, 0x8F, 0xAC, 0x5E,
70b0013e03SChen Yu 0x5E, 0x93, 0xE8, 0xBF);
71b0013e03SChen Yu
72b0013e03SChen Yu static DEFINE_IDA(pfrt_log_ida);
73b0013e03SChen Yu
to_pfrt_log_dev(struct file * file)74b0013e03SChen Yu static inline struct pfrt_log_device *to_pfrt_log_dev(struct file *file)
75b0013e03SChen Yu {
76b0013e03SChen Yu return container_of(file->private_data, struct pfrt_log_device, miscdev);
77b0013e03SChen Yu }
78b0013e03SChen Yu
get_pfrt_log_data_info(struct pfrt_log_data_info * data_info,struct pfrt_log_device * pfrt_log_dev)79b0013e03SChen Yu static int get_pfrt_log_data_info(struct pfrt_log_data_info *data_info,
80b0013e03SChen Yu struct pfrt_log_device *pfrt_log_dev)
81b0013e03SChen Yu {
82b0013e03SChen Yu acpi_handle handle = ACPI_HANDLE(pfrt_log_dev->parent_dev);
83b0013e03SChen Yu union acpi_object *out_obj, in_obj, in_buf;
84b0013e03SChen Yu int ret = -EBUSY;
85b0013e03SChen Yu
867bf2e4d5SDan Carpenter memset(data_info, 0, sizeof(*data_info));
87b0013e03SChen Yu memset(&in_obj, 0, sizeof(in_obj));
88b0013e03SChen Yu memset(&in_buf, 0, sizeof(in_buf));
89b0013e03SChen Yu in_obj.type = ACPI_TYPE_PACKAGE;
90b0013e03SChen Yu in_obj.package.count = 1;
91b0013e03SChen Yu in_obj.package.elements = &in_buf;
92b0013e03SChen Yu in_buf.type = ACPI_TYPE_INTEGER;
93b0013e03SChen Yu in_buf.integer.value = pfrt_log_dev->info.log_type;
94b0013e03SChen Yu
95b0013e03SChen Yu out_obj = acpi_evaluate_dsm_typed(handle, &pfrt_log_guid,
96b0013e03SChen Yu pfrt_log_dev->info.log_revid, PFRT_FUNC_GET_DATA,
97b0013e03SChen Yu &in_obj, ACPI_TYPE_PACKAGE);
98b0013e03SChen Yu if (!out_obj)
99b0013e03SChen Yu return -EINVAL;
100b0013e03SChen Yu
101b0013e03SChen Yu if (out_obj->package.count < LOG_NR_IDX ||
102b0013e03SChen Yu out_obj->package.elements[LOG_STATUS_IDX].type != ACPI_TYPE_INTEGER ||
103b0013e03SChen Yu out_obj->package.elements[LOG_EXT_STATUS_IDX].type != ACPI_TYPE_INTEGER ||
104b0013e03SChen Yu out_obj->package.elements[LOG_MAX_SZ_IDX].type != ACPI_TYPE_INTEGER ||
105b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK1_LO_IDX].type != ACPI_TYPE_INTEGER ||
106b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK1_HI_IDX].type != ACPI_TYPE_INTEGER ||
107b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK1_SZ_IDX].type != ACPI_TYPE_INTEGER ||
108b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK2_LO_IDX].type != ACPI_TYPE_INTEGER ||
109b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK2_HI_IDX].type != ACPI_TYPE_INTEGER ||
110b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK2_SZ_IDX].type != ACPI_TYPE_INTEGER ||
111b0013e03SChen Yu out_obj->package.elements[LOG_ROLLOVER_CNT_IDX].type != ACPI_TYPE_INTEGER ||
112b0013e03SChen Yu out_obj->package.elements[LOG_RESET_CNT_IDX].type != ACPI_TYPE_INTEGER)
113b0013e03SChen Yu goto free_acpi_buffer;
114b0013e03SChen Yu
115b0013e03SChen Yu data_info->status = out_obj->package.elements[LOG_STATUS_IDX].integer.value;
116b0013e03SChen Yu data_info->ext_status =
117b0013e03SChen Yu out_obj->package.elements[LOG_EXT_STATUS_IDX].integer.value;
118b0013e03SChen Yu if (data_info->status != DSM_SUCCEED) {
119b0013e03SChen Yu dev_dbg(pfrt_log_dev->parent_dev, "Error Status:%d\n", data_info->status);
120b0013e03SChen Yu dev_dbg(pfrt_log_dev->parent_dev, "Error Extend Status:%d\n",
121b0013e03SChen Yu data_info->ext_status);
122b0013e03SChen Yu goto free_acpi_buffer;
123b0013e03SChen Yu }
124b0013e03SChen Yu
125b0013e03SChen Yu data_info->max_data_size =
126b0013e03SChen Yu out_obj->package.elements[LOG_MAX_SZ_IDX].integer.value;
127b0013e03SChen Yu data_info->chunk1_addr_lo =
128b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK1_LO_IDX].integer.value;
129b0013e03SChen Yu data_info->chunk1_addr_hi =
130b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK1_HI_IDX].integer.value;
131b0013e03SChen Yu data_info->chunk1_size =
132b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK1_SZ_IDX].integer.value;
133b0013e03SChen Yu data_info->chunk2_addr_lo =
134b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK2_LO_IDX].integer.value;
135b0013e03SChen Yu data_info->chunk2_addr_hi =
136b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK2_HI_IDX].integer.value;
137b0013e03SChen Yu data_info->chunk2_size =
138b0013e03SChen Yu out_obj->package.elements[LOG_CHUNK2_SZ_IDX].integer.value;
139b0013e03SChen Yu data_info->rollover_cnt =
140b0013e03SChen Yu out_obj->package.elements[LOG_ROLLOVER_CNT_IDX].integer.value;
141b0013e03SChen Yu data_info->reset_cnt =
142b0013e03SChen Yu out_obj->package.elements[LOG_RESET_CNT_IDX].integer.value;
143b0013e03SChen Yu
144b0013e03SChen Yu ret = 0;
145b0013e03SChen Yu
146b0013e03SChen Yu free_acpi_buffer:
1470f2aa7fcSWang ShaoBo ACPI_FREE(out_obj);
148b0013e03SChen Yu
149b0013e03SChen Yu return ret;
150b0013e03SChen Yu }
151b0013e03SChen Yu
set_pfrt_log_level(int level,struct pfrt_log_device * pfrt_log_dev)152b0013e03SChen Yu static int set_pfrt_log_level(int level, struct pfrt_log_device *pfrt_log_dev)
153b0013e03SChen Yu {
154b0013e03SChen Yu acpi_handle handle = ACPI_HANDLE(pfrt_log_dev->parent_dev);
155b0013e03SChen Yu union acpi_object *out_obj, *obj, in_obj, in_buf;
156b0013e03SChen Yu enum pfru_dsm_status status, ext_status;
157b0013e03SChen Yu int ret = 0;
158b0013e03SChen Yu
159b0013e03SChen Yu memset(&in_obj, 0, sizeof(in_obj));
160b0013e03SChen Yu memset(&in_buf, 0, sizeof(in_buf));
161b0013e03SChen Yu in_obj.type = ACPI_TYPE_PACKAGE;
162b0013e03SChen Yu in_obj.package.count = 1;
163b0013e03SChen Yu in_obj.package.elements = &in_buf;
164b0013e03SChen Yu in_buf.type = ACPI_TYPE_INTEGER;
165b0013e03SChen Yu in_buf.integer.value = level;
166b0013e03SChen Yu
167b0013e03SChen Yu out_obj = acpi_evaluate_dsm_typed(handle, &pfrt_log_guid,
168b0013e03SChen Yu pfrt_log_dev->info.log_revid, PFRT_FUNC_SET_LEV,
169b0013e03SChen Yu &in_obj, ACPI_TYPE_PACKAGE);
170b0013e03SChen Yu if (!out_obj)
171b0013e03SChen Yu return -EINVAL;
172b0013e03SChen Yu
173b0013e03SChen Yu obj = &out_obj->package.elements[0];
174b0013e03SChen Yu status = obj->integer.value;
175b0013e03SChen Yu if (status != DSM_SUCCEED) {
176b0013e03SChen Yu obj = &out_obj->package.elements[1];
177b0013e03SChen Yu ext_status = obj->integer.value;
178b0013e03SChen Yu dev_dbg(pfrt_log_dev->parent_dev, "Error Status:%d\n", status);
179b0013e03SChen Yu dev_dbg(pfrt_log_dev->parent_dev, "Error Extend Status:%d\n", ext_status);
180b0013e03SChen Yu ret = -EBUSY;
181b0013e03SChen Yu }
182b0013e03SChen Yu
1830f2aa7fcSWang ShaoBo ACPI_FREE(out_obj);
184b0013e03SChen Yu
185b0013e03SChen Yu return ret;
186b0013e03SChen Yu }
187b0013e03SChen Yu
get_pfrt_log_level(struct pfrt_log_device * pfrt_log_dev)188b0013e03SChen Yu static int get_pfrt_log_level(struct pfrt_log_device *pfrt_log_dev)
189b0013e03SChen Yu {
190b0013e03SChen Yu acpi_handle handle = ACPI_HANDLE(pfrt_log_dev->parent_dev);
191b0013e03SChen Yu union acpi_object *out_obj, *obj;
192b0013e03SChen Yu enum pfru_dsm_status status, ext_status;
193b0013e03SChen Yu int ret = -EBUSY;
194b0013e03SChen Yu
195b0013e03SChen Yu out_obj = acpi_evaluate_dsm_typed(handle, &pfrt_log_guid,
196b0013e03SChen Yu pfrt_log_dev->info.log_revid, PFRT_FUNC_GET_LEV,
197b0013e03SChen Yu NULL, ACPI_TYPE_PACKAGE);
198b0013e03SChen Yu if (!out_obj)
199b0013e03SChen Yu return -EINVAL;
200b0013e03SChen Yu
201b0013e03SChen Yu obj = &out_obj->package.elements[0];
202b0013e03SChen Yu if (obj->type != ACPI_TYPE_INTEGER)
203b0013e03SChen Yu goto free_acpi_buffer;
204b0013e03SChen Yu
205b0013e03SChen Yu status = obj->integer.value;
206b0013e03SChen Yu if (status != DSM_SUCCEED) {
207b0013e03SChen Yu obj = &out_obj->package.elements[1];
208b0013e03SChen Yu ext_status = obj->integer.value;
209b0013e03SChen Yu dev_dbg(pfrt_log_dev->parent_dev, "Error Status:%d\n", status);
210b0013e03SChen Yu dev_dbg(pfrt_log_dev->parent_dev, "Error Extend Status:%d\n", ext_status);
211b0013e03SChen Yu goto free_acpi_buffer;
212b0013e03SChen Yu }
213b0013e03SChen Yu
214b0013e03SChen Yu obj = &out_obj->package.elements[2];
215b0013e03SChen Yu if (obj->type != ACPI_TYPE_INTEGER)
216b0013e03SChen Yu goto free_acpi_buffer;
217b0013e03SChen Yu
218b0013e03SChen Yu ret = obj->integer.value;
219b0013e03SChen Yu
220b0013e03SChen Yu free_acpi_buffer:
2210f2aa7fcSWang ShaoBo ACPI_FREE(out_obj);
222b0013e03SChen Yu
223b0013e03SChen Yu return ret;
224b0013e03SChen Yu }
225b0013e03SChen Yu
valid_log_level(u32 level)226b0013e03SChen Yu static int valid_log_level(u32 level)
227b0013e03SChen Yu {
228b0013e03SChen Yu return level == PFRT_LOG_ERR || level == PFRT_LOG_WARN ||
229b0013e03SChen Yu level == PFRT_LOG_INFO || level == PFRT_LOG_VERB;
230b0013e03SChen Yu }
231b0013e03SChen Yu
valid_log_type(u32 type)232b0013e03SChen Yu static int valid_log_type(u32 type)
233b0013e03SChen Yu {
234b0013e03SChen Yu return type == PFRT_LOG_EXEC_IDX || type == PFRT_LOG_HISTORY_IDX;
235b0013e03SChen Yu }
236b0013e03SChen Yu
valid_log_revid(u32 id)237b0013e03SChen Yu static inline int valid_log_revid(u32 id)
238b0013e03SChen Yu {
239b0013e03SChen Yu return id == PFRT_REVID_1 || id == PFRT_REVID_2;
240b0013e03SChen Yu }
241b0013e03SChen Yu
pfrt_log_ioctl(struct file * file,unsigned int cmd,unsigned long arg)242b0013e03SChen Yu static long pfrt_log_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
243b0013e03SChen Yu {
244b0013e03SChen Yu struct pfrt_log_device *pfrt_log_dev = to_pfrt_log_dev(file);
245b0013e03SChen Yu struct pfrt_log_data_info data_info;
246b0013e03SChen Yu struct pfrt_log_info info;
247b0013e03SChen Yu void __user *p;
248b0013e03SChen Yu int ret = 0;
249b0013e03SChen Yu
250b0013e03SChen Yu p = (void __user *)arg;
251b0013e03SChen Yu
252b0013e03SChen Yu switch (cmd) {
253b0013e03SChen Yu case PFRT_LOG_IOC_SET_INFO:
254b0013e03SChen Yu if (copy_from_user(&info, p, sizeof(info)))
255b0013e03SChen Yu return -EFAULT;
256b0013e03SChen Yu
257b0013e03SChen Yu if (valid_log_revid(info.log_revid))
258b0013e03SChen Yu pfrt_log_dev->info.log_revid = info.log_revid;
259b0013e03SChen Yu
260b0013e03SChen Yu if (valid_log_level(info.log_level)) {
261b0013e03SChen Yu ret = set_pfrt_log_level(info.log_level, pfrt_log_dev);
262b0013e03SChen Yu if (ret < 0)
263b0013e03SChen Yu return ret;
264b0013e03SChen Yu
265b0013e03SChen Yu pfrt_log_dev->info.log_level = info.log_level;
266b0013e03SChen Yu }
267b0013e03SChen Yu
268b0013e03SChen Yu if (valid_log_type(info.log_type))
269b0013e03SChen Yu pfrt_log_dev->info.log_type = info.log_type;
270b0013e03SChen Yu
271b0013e03SChen Yu return 0;
272b0013e03SChen Yu
273b0013e03SChen Yu case PFRT_LOG_IOC_GET_INFO:
274b0013e03SChen Yu info.log_level = get_pfrt_log_level(pfrt_log_dev);
275b0013e03SChen Yu if (ret < 0)
276b0013e03SChen Yu return ret;
277b0013e03SChen Yu
278b0013e03SChen Yu info.log_type = pfrt_log_dev->info.log_type;
279b0013e03SChen Yu info.log_revid = pfrt_log_dev->info.log_revid;
280b0013e03SChen Yu if (copy_to_user(p, &info, sizeof(info)))
281b0013e03SChen Yu return -EFAULT;
282b0013e03SChen Yu
283b0013e03SChen Yu return 0;
284b0013e03SChen Yu
285b0013e03SChen Yu case PFRT_LOG_IOC_GET_DATA_INFO:
286b0013e03SChen Yu ret = get_pfrt_log_data_info(&data_info, pfrt_log_dev);
287b0013e03SChen Yu if (ret)
288b0013e03SChen Yu return ret;
289b0013e03SChen Yu
290b0013e03SChen Yu if (copy_to_user(p, &data_info, sizeof(struct pfrt_log_data_info)))
291b0013e03SChen Yu return -EFAULT;
292b0013e03SChen Yu
293b0013e03SChen Yu return 0;
294b0013e03SChen Yu
295b0013e03SChen Yu default:
296b0013e03SChen Yu return -ENOTTY;
297b0013e03SChen Yu }
298b0013e03SChen Yu }
299b0013e03SChen Yu
300b0013e03SChen Yu static int
pfrt_log_mmap(struct file * file,struct vm_area_struct * vma)301b0013e03SChen Yu pfrt_log_mmap(struct file *file, struct vm_area_struct *vma)
302b0013e03SChen Yu {
303b0013e03SChen Yu struct pfrt_log_device *pfrt_log_dev;
304b0013e03SChen Yu struct pfrt_log_data_info info;
305b0013e03SChen Yu unsigned long psize, vsize;
306b0013e03SChen Yu phys_addr_t base_addr;
307b0013e03SChen Yu int ret;
308b0013e03SChen Yu
309b0013e03SChen Yu if (vma->vm_flags & VM_WRITE)
310b0013e03SChen Yu return -EROFS;
311b0013e03SChen Yu
312b0013e03SChen Yu /* changing from read to write with mprotect is not allowed */
313*1c71222eSSuren Baghdasaryan vm_flags_clear(vma, VM_MAYWRITE);
314b0013e03SChen Yu
315b0013e03SChen Yu pfrt_log_dev = to_pfrt_log_dev(file);
316b0013e03SChen Yu
317b0013e03SChen Yu ret = get_pfrt_log_data_info(&info, pfrt_log_dev);
318b0013e03SChen Yu if (ret)
319b0013e03SChen Yu return ret;
320b0013e03SChen Yu
321b0013e03SChen Yu base_addr = (phys_addr_t)((info.chunk2_addr_hi << 32) | info.chunk2_addr_lo);
322b0013e03SChen Yu /* pfrt update has not been launched yet */
323b0013e03SChen Yu if (!base_addr)
324b0013e03SChen Yu return -ENODEV;
325b0013e03SChen Yu
326b0013e03SChen Yu psize = info.max_data_size;
327b0013e03SChen Yu /* base address and total buffer size must be page aligned */
328b0013e03SChen Yu if (!PAGE_ALIGNED(base_addr) || !PAGE_ALIGNED(psize))
329b0013e03SChen Yu return -ENODEV;
330b0013e03SChen Yu
331b0013e03SChen Yu vsize = vma->vm_end - vma->vm_start;
332b0013e03SChen Yu if (vsize > psize)
333b0013e03SChen Yu return -EINVAL;
334b0013e03SChen Yu
335b0013e03SChen Yu vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
336b0013e03SChen Yu if (io_remap_pfn_range(vma, vma->vm_start, PFN_DOWN(base_addr),
337b0013e03SChen Yu vsize, vma->vm_page_prot))
338b0013e03SChen Yu return -EAGAIN;
339b0013e03SChen Yu
340b0013e03SChen Yu return 0;
341b0013e03SChen Yu }
342b0013e03SChen Yu
343b0013e03SChen Yu static const struct file_operations acpi_pfrt_log_fops = {
344b0013e03SChen Yu .owner = THIS_MODULE,
345b0013e03SChen Yu .mmap = pfrt_log_mmap,
346b0013e03SChen Yu .unlocked_ioctl = pfrt_log_ioctl,
347b0013e03SChen Yu .llseek = noop_llseek,
348b0013e03SChen Yu };
349b0013e03SChen Yu
acpi_pfrt_log_remove(struct platform_device * pdev)350b0013e03SChen Yu static int acpi_pfrt_log_remove(struct platform_device *pdev)
351b0013e03SChen Yu {
352b0013e03SChen Yu struct pfrt_log_device *pfrt_log_dev = platform_get_drvdata(pdev);
353b0013e03SChen Yu
354b0013e03SChen Yu misc_deregister(&pfrt_log_dev->miscdev);
355b0013e03SChen Yu
356b0013e03SChen Yu return 0;
357b0013e03SChen Yu }
358b0013e03SChen Yu
pfrt_log_put_idx(void * data)359b0013e03SChen Yu static void pfrt_log_put_idx(void *data)
360b0013e03SChen Yu {
361b0013e03SChen Yu struct pfrt_log_device *pfrt_log_dev = data;
362b0013e03SChen Yu
363b0013e03SChen Yu ida_free(&pfrt_log_ida, pfrt_log_dev->index);
364b0013e03SChen Yu }
365b0013e03SChen Yu
acpi_pfrt_log_probe(struct platform_device * pdev)366b0013e03SChen Yu static int acpi_pfrt_log_probe(struct platform_device *pdev)
367b0013e03SChen Yu {
368b0013e03SChen Yu acpi_handle handle = ACPI_HANDLE(&pdev->dev);
369b0013e03SChen Yu struct pfrt_log_device *pfrt_log_dev;
370b0013e03SChen Yu int ret;
371b0013e03SChen Yu
372b0013e03SChen Yu if (!acpi_has_method(handle, "_DSM")) {
373b0013e03SChen Yu dev_dbg(&pdev->dev, "Missing _DSM\n");
374b0013e03SChen Yu return -ENODEV;
375b0013e03SChen Yu }
376b0013e03SChen Yu
377b0013e03SChen Yu pfrt_log_dev = devm_kzalloc(&pdev->dev, sizeof(*pfrt_log_dev), GFP_KERNEL);
378b0013e03SChen Yu if (!pfrt_log_dev)
379b0013e03SChen Yu return -ENOMEM;
380b0013e03SChen Yu
381b0013e03SChen Yu ret = ida_alloc(&pfrt_log_ida, GFP_KERNEL);
382b0013e03SChen Yu if (ret < 0)
383b0013e03SChen Yu return ret;
384b0013e03SChen Yu
385b0013e03SChen Yu pfrt_log_dev->index = ret;
386b0013e03SChen Yu ret = devm_add_action_or_reset(&pdev->dev, pfrt_log_put_idx, pfrt_log_dev);
387b0013e03SChen Yu if (ret)
388b0013e03SChen Yu return ret;
389b0013e03SChen Yu
390b0013e03SChen Yu pfrt_log_dev->info.log_revid = PFRT_DEFAULT_REV_ID;
391b0013e03SChen Yu pfrt_log_dev->parent_dev = &pdev->dev;
392b0013e03SChen Yu
393b0013e03SChen Yu pfrt_log_dev->miscdev.minor = MISC_DYNAMIC_MINOR;
394b0013e03SChen Yu pfrt_log_dev->miscdev.name = devm_kasprintf(&pdev->dev, GFP_KERNEL,
395b0013e03SChen Yu "pfrt%d",
396b0013e03SChen Yu pfrt_log_dev->index);
397b0013e03SChen Yu if (!pfrt_log_dev->miscdev.name)
398b0013e03SChen Yu return -ENOMEM;
399b0013e03SChen Yu
400b0013e03SChen Yu pfrt_log_dev->miscdev.nodename = devm_kasprintf(&pdev->dev, GFP_KERNEL,
401b0013e03SChen Yu "acpi_pfr_telemetry%d",
402b0013e03SChen Yu pfrt_log_dev->index);
403b0013e03SChen Yu if (!pfrt_log_dev->miscdev.nodename)
404b0013e03SChen Yu return -ENOMEM;
405b0013e03SChen Yu
406b0013e03SChen Yu pfrt_log_dev->miscdev.fops = &acpi_pfrt_log_fops;
407b0013e03SChen Yu pfrt_log_dev->miscdev.parent = &pdev->dev;
408b0013e03SChen Yu
409b0013e03SChen Yu ret = misc_register(&pfrt_log_dev->miscdev);
410b0013e03SChen Yu if (ret)
411b0013e03SChen Yu return ret;
412b0013e03SChen Yu
413b0013e03SChen Yu platform_set_drvdata(pdev, pfrt_log_dev);
414b0013e03SChen Yu
415b0013e03SChen Yu return 0;
416b0013e03SChen Yu }
417b0013e03SChen Yu
418b0013e03SChen Yu static const struct acpi_device_id acpi_pfrt_log_ids[] = {
419b0013e03SChen Yu {"INTC1081"},
420b0013e03SChen Yu {}
421b0013e03SChen Yu };
422b0013e03SChen Yu MODULE_DEVICE_TABLE(acpi, acpi_pfrt_log_ids);
423b0013e03SChen Yu
424b0013e03SChen Yu static struct platform_driver acpi_pfrt_log_driver = {
425b0013e03SChen Yu .driver = {
426b0013e03SChen Yu .name = "pfr_telemetry",
427b0013e03SChen Yu .acpi_match_table = acpi_pfrt_log_ids,
428b0013e03SChen Yu },
429b0013e03SChen Yu .probe = acpi_pfrt_log_probe,
430b0013e03SChen Yu .remove = acpi_pfrt_log_remove,
431b0013e03SChen Yu };
432b0013e03SChen Yu module_platform_driver(acpi_pfrt_log_driver);
433b0013e03SChen Yu
434b0013e03SChen Yu MODULE_DESCRIPTION("Platform Firmware Runtime Update Telemetry driver");
435b0013e03SChen Yu MODULE_LICENSE("GPL v2");
436