1 // SPDX-License-Identifier: GPL-2.0-only
2 // Copyright (c) 2018-2021 Intel Corporation
6 #include <linux/peci-cpu.h>
12  * PECI device can be removed using sysfs, but the removal can also happen as
14  * Mutex is used to protect PECI device from being double-deleted.
19 static int peci_get_revision(struct peci_device *device, u8 *revision)  in peci_get_revision()  argument
24 	req = peci_xfer_get_dib(device);  in peci_get_revision()
29 	 * PECI device may be in a state where it is unable to return a proper  in peci_get_revision()
37 		return -EIO;  in peci_get_revision()
47 static int peci_get_cpu_id(struct peci_device *device, u32 *cpu_id)  in peci_get_cpu_id()  argument
52 	req = peci_xfer_pkg_cfg_readl(device, PECI_PCS_PKG_ID, PECI_PKG_ID_CPU_ID);  in peci_get_cpu_id()
93 static int peci_device_info_init(struct peci_device *device)  in peci_device_info_init()  argument
99 	ret = peci_get_cpu_id(device, &cpu_id);  in peci_device_info_init()
103 	device->info.family = peci_x86_cpu_family(cpu_id);  in peci_device_info_init()
104 	device->info.model = peci_x86_cpu_model(cpu_id);  in peci_device_info_init()
106 	ret = peci_get_revision(device, &revision);  in peci_device_info_init()
109 	device->info.peci_revision = revision;  in peci_device_info_init()
111 	device->info.socket_id = device->addr - PECI_BASE_ADDR;  in peci_device_info_init()
116 static int peci_detect(struct peci_controller *controller, u8 addr)  in peci_detect()  argument
120 	 * We expect correct Write FCS if the device at the target address  in peci_detect()
126 	mutex_lock(&controller->bus_lock);  in peci_detect()
127 	ret = controller->ops->xfer(controller, addr, &req);  in peci_detect()
128 	mutex_unlock(&controller->bus_lock);  in peci_detect()
133 static bool peci_addr_valid(u8 addr)  in peci_addr_valid()  argument
135 	return addr >= PECI_BASE_ADDR && addr < PECI_BASE_ADDR + PECI_DEVICE_NUM_MAX;  in peci_addr_valid()
138 static int peci_dev_exists(struct device *dev, void *data)  in peci_dev_exists()
140 	struct peci_device *device = to_peci_device(dev);  in peci_dev_exists()  local
141 	u8 *addr = data;  in peci_dev_exists()  local
143 	if (device->addr == *addr)  in peci_dev_exists()
144 		return -EBUSY;  in peci_dev_exists()
149 int peci_device_create(struct peci_controller *controller, u8 addr)  in peci_device_create()  argument
151 	struct peci_device *device;  in peci_device_create()  local
154 	if (!peci_addr_valid(addr))  in peci_device_create()
155 		return -EINVAL;  in peci_device_create()
157 	/* Check if we have already detected this device before. */  in peci_device_create()
158 	ret = device_for_each_child(&controller->dev, &addr, peci_dev_exists);  in peci_device_create()
162 	ret = peci_detect(controller, addr);  in peci_device_create()
165 		 * Device not present or host state doesn't allow successful  in peci_device_create()
168 		if (ret == -EIO || ret == -ETIMEDOUT)  in peci_device_create()
174 	device = kzalloc(sizeof(*device), GFP_KERNEL);  in peci_device_create()
175 	if (!device)  in peci_device_create()
176 		return -ENOMEM;  in peci_device_create()
178 	device_initialize(&device->dev);  in peci_device_create()
180 	device->addr = addr;  in peci_device_create()
181 	device->dev.parent = &controller->dev;  in peci_device_create()
182 	device->dev.bus = &peci_bus_type;  in peci_device_create()
183 	device->dev.type = &peci_device_type;  in peci_device_create()
185 	ret = peci_device_info_init(device);  in peci_device_create()
189 	ret = dev_set_name(&device->dev, "%d-%02x", controller->id, device->addr);  in peci_device_create()
193 	ret = device_add(&device->dev);  in peci_device_create()
200 	put_device(&device->dev);  in peci_device_create()
205 void peci_device_destroy(struct peci_device *device)  in peci_device_destroy()  argument
208 	if (!device->deleted) {  in peci_device_destroy()
209 		device_unregister(&device->dev);  in peci_device_destroy()
210 		device->deleted = true;  in peci_device_destroy()
218 	driver->driver.bus = &peci_bus_type;  in __peci_driver_register()
219 	driver->driver.owner = owner;  in __peci_driver_register()
220 	driver->driver.mod_name = mod_name;  in __peci_driver_register()
222 	if (!driver->probe) {  in __peci_driver_register()
224 		return -EINVAL;  in __peci_driver_register()
227 	if (!driver->id_table) {  in __peci_driver_register()
228 		pr_err("peci: trying to register driver without device id table\n");  in __peci_driver_register()
229 		return -EINVAL;  in __peci_driver_register()
232 	return driver_register(&driver->driver);  in __peci_driver_register()
238 	driver_unregister(&driver->driver);  in peci_driver_unregister()
242 static void peci_device_release(struct device *dev)  in peci_device_release()
244 	struct peci_device *device = to_peci_device(dev);  in peci_device_release()  local
246 	kfree(device);  in peci_device_release()