1 // SPDX-License-Identifier: GPL-2.0-only
2 // Copyright (c) 2021 Intel Corporation
3 
4 #include <linux/auxiliary_bus.h>
5 #include <linux/module.h>
6 #include <linux/peci.h>
7 #include <linux/peci-cpu.h>
8 #include <linux/slab.h>
9 
10 #include "internal.h"
11 
12 /**
13  * peci_temp_read() - read the maximum die temperature from PECI target device
14  * @device: PECI device to which request is going to be sent
15  * @temp_raw: where to store the read temperature
16  *
17  * It uses GetTemp PECI command.
18  *
19  * Return: 0 if succeeded, other values in case errors.
20  */
peci_temp_read(struct peci_device * device,s16 * temp_raw)21 int peci_temp_read(struct peci_device *device, s16 *temp_raw)
22 {
23 	struct peci_request *req;
24 
25 	req = peci_xfer_get_temp(device);
26 	if (IS_ERR(req))
27 		return PTR_ERR(req);
28 
29 	*temp_raw = peci_request_temp_read(req);
30 
31 	peci_request_free(req);
32 
33 	return 0;
34 }
35 EXPORT_SYMBOL_NS_GPL(peci_temp_read, PECI_CPU);
36 
37 /**
38  * peci_pcs_read() - read PCS register
39  * @device: PECI device to which request is going to be sent
40  * @index: PCS index
41  * @param: PCS parameter
42  * @data: where to store the read data
43  *
44  * It uses RdPkgConfig PECI command.
45  *
46  * Return: 0 if succeeded, other values in case errors.
47  */
peci_pcs_read(struct peci_device * device,u8 index,u16 param,u32 * data)48 int peci_pcs_read(struct peci_device *device, u8 index, u16 param, u32 *data)
49 {
50 	struct peci_request *req;
51 	int ret;
52 
53 	req = peci_xfer_pkg_cfg_readl(device, index, param);
54 	if (IS_ERR(req))
55 		return PTR_ERR(req);
56 
57 	ret = peci_request_status(req);
58 	if (ret)
59 		goto out_req_free;
60 
61 	*data = peci_request_data_readl(req);
62 out_req_free:
63 	peci_request_free(req);
64 
65 	return ret;
66 }
67 EXPORT_SYMBOL_NS_GPL(peci_pcs_read, PECI_CPU);
68 
69 /**
70  * peci_pci_local_read() - read 32-bit memory location using raw address
71  * @device: PECI device to which request is going to be sent
72  * @bus: bus
73  * @dev: device
74  * @func: function
75  * @reg: register
76  * @data: where to store the read data
77  *
78  * It uses RdPCIConfigLocal PECI command.
79  *
80  * Return: 0 if succeeded, other values in case errors.
81  */
peci_pci_local_read(struct peci_device * device,u8 bus,u8 dev,u8 func,u16 reg,u32 * data)82 int peci_pci_local_read(struct peci_device *device, u8 bus, u8 dev, u8 func,
83 			u16 reg, u32 *data)
84 {
85 	struct peci_request *req;
86 	int ret;
87 
88 	req = peci_xfer_pci_cfg_local_readl(device, bus, dev, func, reg);
89 	if (IS_ERR(req))
90 		return PTR_ERR(req);
91 
92 	ret = peci_request_status(req);
93 	if (ret)
94 		goto out_req_free;
95 
96 	*data = peci_request_data_readl(req);
97 out_req_free:
98 	peci_request_free(req);
99 
100 	return ret;
101 }
102 EXPORT_SYMBOL_NS_GPL(peci_pci_local_read, PECI_CPU);
103 
104 /**
105  * peci_ep_pci_local_read() - read 32-bit memory location using raw address
106  * @device: PECI device to which request is going to be sent
107  * @seg: PCI segment
108  * @bus: bus
109  * @dev: device
110  * @func: function
111  * @reg: register
112  * @data: where to store the read data
113  *
114  * Like &peci_pci_local_read, but it uses RdEndpointConfig PECI command.
115  *
116  * Return: 0 if succeeded, other values in case errors.
117  */
peci_ep_pci_local_read(struct peci_device * device,u8 seg,u8 bus,u8 dev,u8 func,u16 reg,u32 * data)118 int peci_ep_pci_local_read(struct peci_device *device, u8 seg,
119 			   u8 bus, u8 dev, u8 func, u16 reg, u32 *data)
120 {
121 	struct peci_request *req;
122 	int ret;
123 
124 	req = peci_xfer_ep_pci_cfg_local_readl(device, seg, bus, dev, func, reg);
125 	if (IS_ERR(req))
126 		return PTR_ERR(req);
127 
128 	ret = peci_request_status(req);
129 	if (ret)
130 		goto out_req_free;
131 
132 	*data = peci_request_data_readl(req);
133 out_req_free:
134 	peci_request_free(req);
135 
136 	return ret;
137 }
138 EXPORT_SYMBOL_NS_GPL(peci_ep_pci_local_read, PECI_CPU);
139 
140 /**
141  * peci_mmio_read() - read 32-bit memory location using 64-bit bar offset address
142  * @device: PECI device to which request is going to be sent
143  * @bar: PCI bar
144  * @seg: PCI segment
145  * @bus: bus
146  * @dev: device
147  * @func: function
148  * @address: 64-bit MMIO address
149  * @data: where to store the read data
150  *
151  * It uses RdEndpointConfig PECI command.
152  *
153  * Return: 0 if succeeded, other values in case errors.
154  */
peci_mmio_read(struct peci_device * device,u8 bar,u8 seg,u8 bus,u8 dev,u8 func,u64 address,u32 * data)155 int peci_mmio_read(struct peci_device *device, u8 bar, u8 seg,
156 		   u8 bus, u8 dev, u8 func, u64 address, u32 *data)
157 {
158 	struct peci_request *req;
159 	int ret;
160 
161 	req = peci_xfer_ep_mmio64_readl(device, bar, seg, bus, dev, func, address);
162 	if (IS_ERR(req))
163 		return PTR_ERR(req);
164 
165 	ret = peci_request_status(req);
166 	if (ret)
167 		goto out_req_free;
168 
169 	*data = peci_request_data_readl(req);
170 out_req_free:
171 	peci_request_free(req);
172 
173 	return ret;
174 }
175 EXPORT_SYMBOL_NS_GPL(peci_mmio_read, PECI_CPU);
176 
177 static const char * const peci_adev_types[] = {
178 	"cputemp",
179 	"dimmtemp",
180 };
181 
182 struct peci_cpu {
183 	struct peci_device *device;
184 	const struct peci_device_id *id;
185 };
186 
adev_release(struct device * dev)187 static void adev_release(struct device *dev)
188 {
189 	struct auxiliary_device *adev = to_auxiliary_dev(dev);
190 
191 	kfree(adev->name);
192 	kfree(adev);
193 }
194 
adev_alloc(struct peci_cpu * priv,int idx)195 static struct auxiliary_device *adev_alloc(struct peci_cpu *priv, int idx)
196 {
197 	struct peci_controller *controller = to_peci_controller(priv->device->dev.parent);
198 	struct auxiliary_device *adev;
199 	const char *name;
200 	int ret;
201 
202 	adev = kzalloc(sizeof(*adev), GFP_KERNEL);
203 	if (!adev)
204 		return ERR_PTR(-ENOMEM);
205 
206 	name = kasprintf(GFP_KERNEL, "%s.%s", peci_adev_types[idx], (const char *)priv->id->data);
207 	if (!name) {
208 		ret = -ENOMEM;
209 		goto free_adev;
210 	}
211 
212 	adev->name = name;
213 	adev->dev.parent = &priv->device->dev;
214 	adev->dev.release = adev_release;
215 	adev->id = (controller->id << 16) | (priv->device->addr);
216 
217 	ret = auxiliary_device_init(adev);
218 	if (ret)
219 		goto free_name;
220 
221 	return adev;
222 
223 free_name:
224 	kfree(name);
225 free_adev:
226 	kfree(adev);
227 	return ERR_PTR(ret);
228 }
229 
unregister_adev(void * _adev)230 static void unregister_adev(void *_adev)
231 {
232 	struct auxiliary_device *adev = _adev;
233 
234 	auxiliary_device_delete(adev);
235 	auxiliary_device_uninit(adev);
236 }
237 
devm_adev_add(struct device * dev,int idx)238 static int devm_adev_add(struct device *dev, int idx)
239 {
240 	struct peci_cpu *priv = dev_get_drvdata(dev);
241 	struct auxiliary_device *adev;
242 	int ret;
243 
244 	adev = adev_alloc(priv, idx);
245 	if (IS_ERR(adev))
246 		return PTR_ERR(adev);
247 
248 	ret = auxiliary_device_add(adev);
249 	if (ret) {
250 		auxiliary_device_uninit(adev);
251 		return ret;
252 	}
253 
254 	ret = devm_add_action_or_reset(&priv->device->dev, unregister_adev, adev);
255 	if (ret)
256 		return ret;
257 
258 	return 0;
259 }
260 
peci_cpu_add_adevices(struct peci_cpu * priv)261 static void peci_cpu_add_adevices(struct peci_cpu *priv)
262 {
263 	struct device *dev = &priv->device->dev;
264 	int ret, i;
265 
266 	for (i = 0; i < ARRAY_SIZE(peci_adev_types); i++) {
267 		ret = devm_adev_add(dev, i);
268 		if (ret) {
269 			dev_warn(dev, "Failed to register PECI auxiliary: %s, ret = %d\n",
270 				 peci_adev_types[i], ret);
271 			continue;
272 		}
273 	}
274 }
275 
276 static int
peci_cpu_probe(struct peci_device * device,const struct peci_device_id * id)277 peci_cpu_probe(struct peci_device *device, const struct peci_device_id *id)
278 {
279 	struct device *dev = &device->dev;
280 	struct peci_cpu *priv;
281 
282 	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
283 	if (!priv)
284 		return -ENOMEM;
285 
286 	dev_set_drvdata(dev, priv);
287 	priv->device = device;
288 	priv->id = id;
289 
290 	peci_cpu_add_adevices(priv);
291 
292 	return 0;
293 }
294 
295 static const struct peci_device_id peci_cpu_device_ids[] = {
296 	{ /* Haswell Xeon */
297 		.family	= 6,
298 		.model	= INTEL_FAM6_HASWELL_X,
299 		.data	= "hsx",
300 	},
301 	{ /* Broadwell Xeon */
302 		.family	= 6,
303 		.model	= INTEL_FAM6_BROADWELL_X,
304 		.data	= "bdx",
305 	},
306 	{ /* Broadwell Xeon D */
307 		.family	= 6,
308 		.model	= INTEL_FAM6_BROADWELL_D,
309 		.data	= "bdxd",
310 	},
311 	{ /* Skylake Xeon */
312 		.family	= 6,
313 		.model	= INTEL_FAM6_SKYLAKE_X,
314 		.data	= "skx",
315 	},
316 	{ /* Icelake Xeon */
317 		.family	= 6,
318 		.model	= INTEL_FAM6_ICELAKE_X,
319 		.data	= "icx",
320 	},
321 	{ /* Icelake Xeon D */
322 		.family	= 6,
323 		.model	= INTEL_FAM6_ICELAKE_D,
324 		.data	= "icxd",
325 	},
326 	{ }
327 };
328 MODULE_DEVICE_TABLE(peci, peci_cpu_device_ids);
329 
330 static struct peci_driver peci_cpu_driver = {
331 	.probe		= peci_cpu_probe,
332 	.id_table	= peci_cpu_device_ids,
333 	.driver		= {
334 		.name		= "peci-cpu",
335 	},
336 };
337 module_peci_driver(peci_cpu_driver);
338 
339 MODULE_AUTHOR("Iwona Winiarska <iwona.winiarska@intel.com>");
340 MODULE_DESCRIPTION("PECI CPU driver");
341 MODULE_LICENSE("GPL");
342 MODULE_IMPORT_NS(PECI);
343