xref: /linux/drivers/acpi/pfr_update.c (revision 3382bfbca58c7d5ee3f31a7b37fbeb208e98e656)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * ACPI Platform Firmware Runtime Update Device driver
4  *
5  * Copyright (C) 2021 Intel Corporation
6  * Author: Chen Yu <yu.c.chen@intel.com>
7  *
8  * pfr_update driver is used for Platform Firmware Runtime
9  * Update, which includes the code injection and driver update.
10  */
11 #include <linux/acpi.h>
12 #include <linux/device.h>
13 #include <linux/efi.h>
14 #include <linux/err.h>
15 #include <linux/errno.h>
16 #include <linux/file.h>
17 #include <linux/fs.h>
18 #include <linux/idr.h>
19 #include <linux/miscdevice.h>
20 #include <linux/module.h>
21 #include <linux/platform_device.h>
22 #include <linux/string.h>
23 #include <linux/uaccess.h>
24 #include <linux/uio.h>
25 #include <linux/uuid.h>
26 
27 #include <uapi/linux/pfrut.h>
28 
29 #define PFRU_FUNC_STANDARD_QUERY	0
30 #define PFRU_FUNC_QUERY_UPDATE_CAP	1
31 #define PFRU_FUNC_QUERY_BUF		2
32 #define PFRU_FUNC_START		3
33 
34 #define PFRU_CODE_INJECT_TYPE	1
35 #define PFRU_DRIVER_UPDATE_TYPE	2
36 
37 #define PFRU_REVID_1		1
38 #define PFRU_REVID_2		2
39 #define PFRU_DEFAULT_REV_ID	PFRU_REVID_1
40 
41 enum cap_index {
42 	CAP_STATUS_IDX = 0,
43 	CAP_UPDATE_IDX = 1,
44 	CAP_CODE_TYPE_IDX = 2,
45 	CAP_FW_VER_IDX = 3,
46 	CAP_CODE_RT_VER_IDX = 4,
47 	CAP_DRV_TYPE_IDX = 5,
48 	CAP_DRV_RT_VER_IDX = 6,
49 	CAP_DRV_SVN_IDX = 7,
50 	CAP_PLAT_ID_IDX = 8,
51 	CAP_OEM_ID_IDX = 9,
52 	CAP_OEM_INFO_IDX = 10,
53 	CAP_NR_IDX
54 };
55 
56 enum buf_index {
57 	BUF_STATUS_IDX = 0,
58 	BUF_EXT_STATUS_IDX = 1,
59 	BUF_ADDR_LOW_IDX = 2,
60 	BUF_ADDR_HI_IDX = 3,
61 	BUF_SIZE_IDX = 4,
62 	BUF_NR_IDX
63 };
64 
65 enum update_index {
66 	UPDATE_STATUS_IDX = 0,
67 	UPDATE_EXT_STATUS_IDX = 1,
68 	UPDATE_AUTH_TIME_LOW_IDX = 2,
69 	UPDATE_AUTH_TIME_HI_IDX = 3,
70 	UPDATE_EXEC_TIME_LOW_IDX = 4,
71 	UPDATE_EXEC_TIME_HI_IDX = 5,
72 	UPDATE_NR_IDX
73 };
74 
75 enum pfru_start_action {
76 	START_STAGE = 0,
77 	START_ACTIVATE = 1,
78 	START_STAGE_ACTIVATE = 2,
79 };
80 
81 struct pfru_device {
82 	u32 rev_id, index;
83 	struct device *parent_dev;
84 	struct miscdevice miscdev;
85 };
86 
87 static DEFINE_IDA(pfru_ida);
88 
89 /*
90  * Manual reference:
91  * https://uefi.org/sites/default/files/resources/Intel_MM_OS_Interface_Spec_Rev100.pdf
92  *
93  * pfru_guid is the parameter for _DSM method
94  */
95 static const guid_t pfru_guid =
96 	GUID_INIT(0xECF9533B, 0x4A3C, 0x4E89, 0x93, 0x9E, 0xC7, 0x71,
97 		  0x12, 0x60, 0x1C, 0x6D);
98 
99 /* pfru_code_inj_guid is the UUID to identify code injection EFI capsule file */
100 static const guid_t pfru_code_inj_guid =
101 	GUID_INIT(0xB2F84B79, 0x7B6E, 0x4E45, 0x88, 0x5F, 0x3F, 0xB9,
102 		  0xBB, 0x18, 0x54, 0x02);
103 
104 /* pfru_drv_update_guid is the UUID to identify driver update EFI capsule file */
105 static const guid_t pfru_drv_update_guid =
106 	GUID_INIT(0x4569DD8C, 0x75F1, 0x429A, 0xA3, 0xD6, 0x24, 0xDE,
107 		  0x80, 0x97, 0xA0, 0xDF);
108 
pfru_valid_revid(u32 id)109 static inline int pfru_valid_revid(u32 id)
110 {
111 	return id == PFRU_REVID_1 || id == PFRU_REVID_2;
112 }
113 
to_pfru_dev(struct file * file)114 static inline struct pfru_device *to_pfru_dev(struct file *file)
115 {
116 	return container_of(file->private_data, struct pfru_device, miscdev);
117 }
118 
query_capability(struct pfru_update_cap_info * cap_hdr,struct pfru_device * pfru_dev)119 static int query_capability(struct pfru_update_cap_info *cap_hdr,
120 			    struct pfru_device *pfru_dev)
121 {
122 	acpi_handle handle = ACPI_HANDLE(pfru_dev->parent_dev);
123 	union acpi_object *out_obj, *elem;
124 	int ret = -EINVAL;
125 
126 	out_obj = acpi_evaluate_dsm_typed(handle, &pfru_guid,
127 					  pfru_dev->rev_id,
128 					  PFRU_FUNC_QUERY_UPDATE_CAP,
129 					  NULL, ACPI_TYPE_PACKAGE);
130 	if (!out_obj) {
131 		dev_dbg(pfru_dev->parent_dev,
132 			"Query cap failed with no object\n");
133 		return ret;
134 	}
135 
136 	if (out_obj->package.count < CAP_NR_IDX ||
137 	    out_obj->package.elements[CAP_STATUS_IDX].type != ACPI_TYPE_INTEGER ||
138 	    out_obj->package.elements[CAP_UPDATE_IDX].type != ACPI_TYPE_INTEGER ||
139 	    out_obj->package.elements[CAP_CODE_TYPE_IDX].type != ACPI_TYPE_BUFFER ||
140 	    out_obj->package.elements[CAP_FW_VER_IDX].type != ACPI_TYPE_INTEGER ||
141 	    out_obj->package.elements[CAP_CODE_RT_VER_IDX].type != ACPI_TYPE_INTEGER ||
142 	    out_obj->package.elements[CAP_DRV_TYPE_IDX].type != ACPI_TYPE_BUFFER ||
143 	    out_obj->package.elements[CAP_DRV_RT_VER_IDX].type != ACPI_TYPE_INTEGER ||
144 	    out_obj->package.elements[CAP_DRV_SVN_IDX].type != ACPI_TYPE_INTEGER ||
145 	    out_obj->package.elements[CAP_PLAT_ID_IDX].type != ACPI_TYPE_BUFFER ||
146 	    out_obj->package.elements[CAP_OEM_ID_IDX].type != ACPI_TYPE_BUFFER ||
147 	    out_obj->package.elements[CAP_OEM_INFO_IDX].type != ACPI_TYPE_BUFFER) {
148 		dev_dbg(pfru_dev->parent_dev,
149 			"Query cap failed with invalid package count/type\n");
150 		goto free_acpi_buffer;
151 	}
152 
153 	elem = out_obj->package.elements;
154 
155 	cap_hdr->status = elem[CAP_STATUS_IDX].integer.value;
156 	if (cap_hdr->status != DSM_SUCCEED) {
157 		ret = -EBUSY;
158 		dev_dbg(pfru_dev->parent_dev, "Query cap Error Status:%d\n",
159 			cap_hdr->status);
160 		goto free_acpi_buffer;
161 	}
162 
163 	if (elem[CAP_CODE_TYPE_IDX].buffer.length > sizeof(cap_hdr->code_type) ||
164 	    elem[CAP_DRV_TYPE_IDX].buffer.length > sizeof(cap_hdr->drv_type) ||
165 	    elem[CAP_PLAT_ID_IDX].buffer.length > sizeof(cap_hdr->platform_id) ||
166 	    elem[CAP_OEM_ID_IDX].buffer.length > sizeof(cap_hdr->oem_id))
167 		goto free_acpi_buffer;
168 
169 	cap_hdr->update_cap = elem[CAP_UPDATE_IDX].integer.value;
170 	memcpy(&cap_hdr->code_type,
171 	       elem[CAP_CODE_TYPE_IDX].buffer.pointer,
172 	       elem[CAP_CODE_TYPE_IDX].buffer.length);
173 	cap_hdr->fw_version = elem[CAP_FW_VER_IDX].integer.value;
174 	cap_hdr->code_rt_version = elem[CAP_CODE_RT_VER_IDX].integer.value;
175 	memcpy(&cap_hdr->drv_type,
176 	       elem[CAP_DRV_TYPE_IDX].buffer.pointer,
177 	       elem[CAP_DRV_TYPE_IDX].buffer.length);
178 	cap_hdr->drv_rt_version = elem[CAP_DRV_RT_VER_IDX].integer.value;
179 	cap_hdr->drv_svn = elem[CAP_DRV_SVN_IDX].integer.value;
180 	memcpy(&cap_hdr->platform_id,
181 	       elem[CAP_PLAT_ID_IDX].buffer.pointer,
182 	       elem[CAP_PLAT_ID_IDX].buffer.length);
183 	memcpy(&cap_hdr->oem_id,
184 	       elem[CAP_OEM_ID_IDX].buffer.pointer,
185 	       elem[CAP_OEM_ID_IDX].buffer.length);
186 	cap_hdr->oem_info_len = elem[CAP_OEM_INFO_IDX].buffer.length;
187 
188 	ret = 0;
189 
190 free_acpi_buffer:
191 	ACPI_FREE(out_obj);
192 
193 	return ret;
194 }
195 
query_buffer(struct pfru_com_buf_info * info,struct pfru_device * pfru_dev)196 static int query_buffer(struct pfru_com_buf_info *info,
197 			struct pfru_device *pfru_dev)
198 {
199 	acpi_handle handle = ACPI_HANDLE(pfru_dev->parent_dev);
200 	union acpi_object *out_obj;
201 	int ret = -EINVAL;
202 
203 	out_obj = acpi_evaluate_dsm_typed(handle, &pfru_guid,
204 					  pfru_dev->rev_id, PFRU_FUNC_QUERY_BUF,
205 					  NULL, ACPI_TYPE_PACKAGE);
206 	if (!out_obj) {
207 		dev_dbg(pfru_dev->parent_dev,
208 			"Query buf failed with no object\n");
209 		return ret;
210 	}
211 
212 	if (out_obj->package.count < BUF_NR_IDX ||
213 	    out_obj->package.elements[BUF_STATUS_IDX].type != ACPI_TYPE_INTEGER ||
214 	    out_obj->package.elements[BUF_EXT_STATUS_IDX].type != ACPI_TYPE_INTEGER ||
215 	    out_obj->package.elements[BUF_ADDR_LOW_IDX].type != ACPI_TYPE_INTEGER ||
216 	    out_obj->package.elements[BUF_ADDR_HI_IDX].type != ACPI_TYPE_INTEGER ||
217 	    out_obj->package.elements[BUF_SIZE_IDX].type != ACPI_TYPE_INTEGER) {
218 		dev_dbg(pfru_dev->parent_dev,
219 			"Query buf failed with invalid package count/type\n");
220 		goto free_acpi_buffer;
221 	}
222 
223 	info->status = out_obj->package.elements[BUF_STATUS_IDX].integer.value;
224 	info->ext_status =
225 		out_obj->package.elements[BUF_EXT_STATUS_IDX].integer.value;
226 	if (info->status != DSM_SUCCEED) {
227 		ret = -EBUSY;
228 		dev_dbg(pfru_dev->parent_dev,
229 			"Query buf failed with Error Status:%d\n", info->status);
230 		dev_dbg(pfru_dev->parent_dev,
231 			"Query buf failed with Error Extended Status:%d\n", info->ext_status);
232 
233 		goto free_acpi_buffer;
234 	}
235 
236 	info->addr_lo =
237 		out_obj->package.elements[BUF_ADDR_LOW_IDX].integer.value;
238 	info->addr_hi =
239 		out_obj->package.elements[BUF_ADDR_HI_IDX].integer.value;
240 	info->buf_size = out_obj->package.elements[BUF_SIZE_IDX].integer.value;
241 
242 	ret = 0;
243 
244 free_acpi_buffer:
245 	ACPI_FREE(out_obj);
246 
247 	return ret;
248 }
249 
get_image_type(const struct efi_manage_capsule_image_header * img_hdr,struct pfru_device * pfru_dev)250 static int get_image_type(const struct efi_manage_capsule_image_header *img_hdr,
251 			  struct pfru_device *pfru_dev)
252 {
253 	const efi_guid_t *image_type_id = &img_hdr->image_type_id;
254 
255 	/* check whether this is a code injection or driver update */
256 	if (guid_equal(image_type_id, &pfru_code_inj_guid))
257 		return PFRU_CODE_INJECT_TYPE;
258 
259 	if (guid_equal(image_type_id, &pfru_drv_update_guid))
260 		return PFRU_DRIVER_UPDATE_TYPE;
261 
262 	return -EINVAL;
263 }
264 
adjust_efi_size(const struct efi_manage_capsule_image_header * img_hdr,int size)265 static int adjust_efi_size(const struct efi_manage_capsule_image_header *img_hdr,
266 			   int size)
267 {
268 	/*
269 	 * The (u64 hw_ins) was introduced in UEFI spec version 2,
270 	 * and (u64 capsule_support) was introduced in version 3.
271 	 * The size needs to be adjusted accordingly. That is to
272 	 * say, version 1 should subtract the size of hw_ins+capsule_support,
273 	 * and version 2 should sbstract the size of capsule_support.
274 	 */
275 	size += sizeof(struct efi_manage_capsule_image_header);
276 	switch (img_hdr->ver) {
277 	case 1:
278 		return size - 2 * sizeof(u64);
279 
280 	case 2:
281 		return size - sizeof(u64);
282 
283 	default:
284 		/* only support version 1 and 2 */
285 		return -EINVAL;
286 	}
287 }
288 
applicable_image(const void * data,struct pfru_update_cap_info * cap,struct pfru_device * pfru_dev)289 static bool applicable_image(const void *data, struct pfru_update_cap_info *cap,
290 			     struct pfru_device *pfru_dev)
291 {
292 	struct pfru_payload_hdr *payload_hdr;
293 	const efi_capsule_header_t *cap_hdr = data;
294 	const struct efi_manage_capsule_header *m_hdr;
295 	const struct efi_manage_capsule_image_header *m_img_hdr;
296 	const struct efi_image_auth *auth;
297 	int type, size;
298 
299 	/*
300 	 * If the code in the capsule is older than the current
301 	 * firmware code, the update will be rejected by the firmware,
302 	 * so check the version of it upfront without engaging the
303 	 * Management Mode update mechanism which may be costly.
304 	 */
305 	size = cap_hdr->headersize;
306 	m_hdr = data + size;
307 	/*
308 	 * Current data structure size plus variable array indicated
309 	 * by number of (emb_drv_cnt + payload_cnt)
310 	 */
311 	size += offsetof(struct efi_manage_capsule_header, offset_list) +
312 		(m_hdr->emb_drv_cnt + m_hdr->payload_cnt) * sizeof(u64);
313 	m_img_hdr = data + size;
314 
315 	type = get_image_type(m_img_hdr, pfru_dev);
316 	if (type < 0) {
317 		dev_dbg(pfru_dev->parent_dev, "Invalid image type\n");
318 		return false;
319 	}
320 
321 	size = adjust_efi_size(m_img_hdr, size);
322 	if (size < 0) {
323 		dev_dbg(pfru_dev->parent_dev, "Invalid image size\n");
324 		return false;
325 	}
326 
327 	auth = data + size;
328 	size += sizeof(u64) + auth->auth_info.hdr.len;
329 	payload_hdr = (struct pfru_payload_hdr *)(data + size);
330 
331 	/* finally compare the version */
332 	if (type == PFRU_CODE_INJECT_TYPE)
333 		return payload_hdr->rt_ver >= cap->code_rt_version;
334 
335 	return payload_hdr->svn_ver >= cap->drv_svn;
336 }
337 
print_update_debug_info(struct pfru_updated_result * result,struct pfru_device * pfru_dev)338 static void print_update_debug_info(struct pfru_updated_result *result,
339 				    struct pfru_device *pfru_dev)
340 {
341 	dev_dbg(pfru_dev->parent_dev, "Update result:\n");
342 	dev_dbg(pfru_dev->parent_dev, "Authentication Time Low:%lld\n",
343 		result->low_auth_time);
344 	dev_dbg(pfru_dev->parent_dev, "Authentication Time High:%lld\n",
345 		result->high_auth_time);
346 	dev_dbg(pfru_dev->parent_dev, "Execution Time Low:%lld\n",
347 		result->low_exec_time);
348 	dev_dbg(pfru_dev->parent_dev, "Execution Time High:%lld\n",
349 		result->high_exec_time);
350 }
351 
start_update(int action,struct pfru_device * pfru_dev)352 static int start_update(int action, struct pfru_device *pfru_dev)
353 {
354 	union acpi_object *out_obj, in_obj, in_buf;
355 	struct pfru_updated_result update_result;
356 	acpi_handle handle;
357 	int ret = -EINVAL;
358 
359 	memset(&in_obj, 0, sizeof(in_obj));
360 	memset(&in_buf, 0, sizeof(in_buf));
361 	in_obj.type = ACPI_TYPE_PACKAGE;
362 	in_obj.package.count = 1;
363 	in_obj.package.elements = &in_buf;
364 	in_buf.type = ACPI_TYPE_INTEGER;
365 	in_buf.integer.value = action;
366 
367 	handle = ACPI_HANDLE(pfru_dev->parent_dev);
368 	out_obj = acpi_evaluate_dsm_typed(handle, &pfru_guid,
369 					  pfru_dev->rev_id, PFRU_FUNC_START,
370 					  &in_obj, ACPI_TYPE_PACKAGE);
371 	if (!out_obj) {
372 		dev_dbg(pfru_dev->parent_dev,
373 			"Update failed to start with no object\n");
374 		return ret;
375 	}
376 
377 	if (out_obj->package.count < UPDATE_NR_IDX ||
378 	    out_obj->package.elements[UPDATE_STATUS_IDX].type != ACPI_TYPE_INTEGER ||
379 	    out_obj->package.elements[UPDATE_EXT_STATUS_IDX].type != ACPI_TYPE_INTEGER ||
380 	    out_obj->package.elements[UPDATE_AUTH_TIME_LOW_IDX].type != ACPI_TYPE_INTEGER ||
381 	    out_obj->package.elements[UPDATE_AUTH_TIME_HI_IDX].type != ACPI_TYPE_INTEGER ||
382 	    out_obj->package.elements[UPDATE_EXEC_TIME_LOW_IDX].type != ACPI_TYPE_INTEGER ||
383 	    out_obj->package.elements[UPDATE_EXEC_TIME_HI_IDX].type != ACPI_TYPE_INTEGER) {
384 		dev_dbg(pfru_dev->parent_dev,
385 			"Update failed with invalid package count/type\n");
386 		goto free_acpi_buffer;
387 	}
388 
389 	update_result.status =
390 		out_obj->package.elements[UPDATE_STATUS_IDX].integer.value;
391 	update_result.ext_status =
392 		out_obj->package.elements[UPDATE_EXT_STATUS_IDX].integer.value;
393 
394 	if (update_result.status != DSM_SUCCEED) {
395 		ret = -EBUSY;
396 		dev_dbg(pfru_dev->parent_dev,
397 			"Update failed with Error Status:%d\n", update_result.status);
398 		dev_dbg(pfru_dev->parent_dev,
399 			"Update failed with Error Extended Status:%d\n",
400 			update_result.ext_status);
401 
402 		goto free_acpi_buffer;
403 	}
404 
405 	update_result.low_auth_time =
406 		out_obj->package.elements[UPDATE_AUTH_TIME_LOW_IDX].integer.value;
407 	update_result.high_auth_time =
408 		out_obj->package.elements[UPDATE_AUTH_TIME_HI_IDX].integer.value;
409 	update_result.low_exec_time =
410 		out_obj->package.elements[UPDATE_EXEC_TIME_LOW_IDX].integer.value;
411 	update_result.high_exec_time =
412 		out_obj->package.elements[UPDATE_EXEC_TIME_HI_IDX].integer.value;
413 
414 	print_update_debug_info(&update_result, pfru_dev);
415 	ret = 0;
416 
417 free_acpi_buffer:
418 	ACPI_FREE(out_obj);
419 
420 	return ret;
421 }
422 
pfru_ioctl(struct file * file,unsigned int cmd,unsigned long arg)423 static long pfru_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
424 {
425 	struct pfru_update_cap_info cap_hdr;
426 	struct pfru_device *pfru_dev = to_pfru_dev(file);
427 	void __user *p = (void __user *)arg;
428 	u32 rev;
429 	int ret;
430 
431 	switch (cmd) {
432 	case PFRU_IOC_QUERY_CAP:
433 		ret = query_capability(&cap_hdr, pfru_dev);
434 		if (ret)
435 			return ret;
436 
437 		if (copy_to_user(p, &cap_hdr, sizeof(cap_hdr)))
438 			return -EFAULT;
439 
440 		return 0;
441 
442 	case PFRU_IOC_SET_REV:
443 		if (copy_from_user(&rev, p, sizeof(rev)))
444 			return -EFAULT;
445 
446 		if (!pfru_valid_revid(rev))
447 			return -EINVAL;
448 
449 		pfru_dev->rev_id = rev;
450 
451 		return 0;
452 
453 	case PFRU_IOC_STAGE:
454 		return start_update(START_STAGE, pfru_dev);
455 
456 	case PFRU_IOC_ACTIVATE:
457 		return start_update(START_ACTIVATE, pfru_dev);
458 
459 	case PFRU_IOC_STAGE_ACTIVATE:
460 		return start_update(START_STAGE_ACTIVATE, pfru_dev);
461 
462 	default:
463 		return -ENOTTY;
464 	}
465 }
466 
pfru_write(struct file * file,const char __user * buf,size_t len,loff_t * ppos)467 static ssize_t pfru_write(struct file *file, const char __user *buf,
468 			  size_t len, loff_t *ppos)
469 {
470 	struct pfru_device *pfru_dev = to_pfru_dev(file);
471 	struct pfru_update_cap_info cap;
472 	struct pfru_com_buf_info buf_info;
473 	phys_addr_t phy_addr;
474 	struct iov_iter iter;
475 	struct iovec iov;
476 	char *buf_ptr;
477 	int ret;
478 
479 	ret = query_buffer(&buf_info, pfru_dev);
480 	if (ret)
481 		return ret;
482 
483 	if (len > buf_info.buf_size) {
484 		dev_dbg(pfru_dev->parent_dev, "Capsule image size too large\n");
485 		return -EINVAL;
486 	}
487 
488 	iov.iov_base = (void __user *)buf;
489 	iov.iov_len = len;
490 	iov_iter_init(&iter, ITER_SOURCE, &iov, 1, len);
491 
492 	/* map the communication buffer */
493 	phy_addr = (phys_addr_t)((buf_info.addr_hi << 32) | buf_info.addr_lo);
494 	buf_ptr = memremap(phy_addr, buf_info.buf_size, MEMREMAP_WB);
495 	if (!buf_ptr) {
496 		dev_dbg(pfru_dev->parent_dev, "Failed to remap the buffer\n");
497 		return -ENOMEM;
498 	}
499 
500 	if (!copy_from_iter_full(buf_ptr, len, &iter)) {
501 		dev_dbg(pfru_dev->parent_dev,
502 			"Failed to copy the data from the user space buffer\n");
503 		ret = -EINVAL;
504 		goto unmap;
505 	}
506 
507 	/* check if the capsule header has a valid version number */
508 	ret = query_capability(&cap, pfru_dev);
509 	if (ret)
510 		goto unmap;
511 
512 	if (!applicable_image(buf_ptr, &cap, pfru_dev))
513 		ret = -EINVAL;
514 
515 unmap:
516 	memunmap(buf_ptr);
517 
518 	return ret ?: len;
519 }
520 
521 static const struct file_operations acpi_pfru_fops = {
522 	.owner		= THIS_MODULE,
523 	.write		= pfru_write,
524 	.unlocked_ioctl = pfru_ioctl,
525 	.llseek		= noop_llseek,
526 };
527 
acpi_pfru_remove(struct platform_device * pdev)528 static void acpi_pfru_remove(struct platform_device *pdev)
529 {
530 	struct pfru_device *pfru_dev = platform_get_drvdata(pdev);
531 
532 	misc_deregister(&pfru_dev->miscdev);
533 }
534 
pfru_put_idx(void * data)535 static void pfru_put_idx(void *data)
536 {
537 	struct pfru_device *pfru_dev = data;
538 
539 	ida_free(&pfru_ida, pfru_dev->index);
540 }
541 
acpi_pfru_probe(struct platform_device * pdev)542 static int acpi_pfru_probe(struct platform_device *pdev)
543 {
544 	struct pfru_device *pfru_dev;
545 	acpi_handle handle;
546 	int ret;
547 
548 	handle = ACPI_HANDLE(&pdev->dev);
549 	if (!handle)
550 		return -ENODEV;
551 
552 	if (!acpi_has_method(handle, "_DSM")) {
553 		dev_dbg(&pdev->dev, "Missing _DSM\n");
554 		return -ENODEV;
555 	}
556 
557 	pfru_dev = devm_kzalloc(&pdev->dev, sizeof(*pfru_dev), GFP_KERNEL);
558 	if (!pfru_dev)
559 		return -ENOMEM;
560 
561 	ret = ida_alloc(&pfru_ida, GFP_KERNEL);
562 	if (ret < 0)
563 		return ret;
564 
565 	pfru_dev->index = ret;
566 	ret = devm_add_action_or_reset(&pdev->dev, pfru_put_idx, pfru_dev);
567 	if (ret)
568 		return ret;
569 
570 	pfru_dev->rev_id = PFRU_DEFAULT_REV_ID;
571 	pfru_dev->parent_dev = &pdev->dev;
572 
573 	pfru_dev->miscdev.minor = MISC_DYNAMIC_MINOR;
574 	pfru_dev->miscdev.name = devm_kasprintf(&pdev->dev, GFP_KERNEL,
575 						"pfru%d", pfru_dev->index);
576 	if (!pfru_dev->miscdev.name)
577 		return -ENOMEM;
578 
579 	pfru_dev->miscdev.nodename = devm_kasprintf(&pdev->dev, GFP_KERNEL,
580 						    "acpi_pfr_update%d", pfru_dev->index);
581 	if (!pfru_dev->miscdev.nodename)
582 		return -ENOMEM;
583 
584 	pfru_dev->miscdev.fops = &acpi_pfru_fops;
585 	pfru_dev->miscdev.parent = &pdev->dev;
586 
587 	ret = misc_register(&pfru_dev->miscdev);
588 	if (ret)
589 		return ret;
590 
591 	platform_set_drvdata(pdev, pfru_dev);
592 
593 	return 0;
594 }
595 
596 static const struct acpi_device_id acpi_pfru_ids[] = {
597 	{"INTC1080"},
598 	{}
599 };
600 MODULE_DEVICE_TABLE(acpi, acpi_pfru_ids);
601 
602 static struct platform_driver acpi_pfru_driver = {
603 	.driver = {
604 		.name = "pfr_update",
605 		.acpi_match_table = acpi_pfru_ids,
606 	},
607 	.probe = acpi_pfru_probe,
608 	.remove = acpi_pfru_remove,
609 };
610 module_platform_driver(acpi_pfru_driver);
611 
612 MODULE_DESCRIPTION("Platform Firmware Runtime Update device driver");
613 MODULE_LICENSE("GPL v2");
614