1 // SPDX-License-Identifier: GPL-2.0-only
2 /* Copyright(c) 2020 Intel Corporation. All rights reserved. */
3 #include <linux/platform_device.h>
4 #include <linux/memregion.h>
5 #include <linux/workqueue.h>
6 #include <linux/debugfs.h>
7 #include <linux/device.h>
8 #include <linux/module.h>
9 #include <linux/pci.h>
10 #include <linux/slab.h>
11 #include <linux/idr.h>
12 #include <linux/node.h>
13 #include <cxl/einj.h>
14 #include <cxlmem.h>
15 #include <cxlpci.h>
16 #include <cxl.h>
17 #include "core.h"
18
19 /**
20 * DOC: cxl core
21 *
22 * The CXL core provides a set of interfaces that can be consumed by CXL aware
23 * drivers. The interfaces allow for creation, modification, and destruction of
24 * regions, memory devices, ports, and decoders. CXL aware drivers must register
25 * with the CXL core via these interfaces in order to be able to participate in
26 * cross-device interleave coordination. The CXL core also establishes and
27 * maintains the bridge to the nvdimm subsystem.
28 *
29 * CXL core introduces sysfs hierarchy to control the devices that are
30 * instantiated by the core.
31 */
32
33 static DEFINE_IDA(cxl_port_ida);
34 static DEFINE_XARRAY(cxl_root_buses);
35
cxl_num_decoders_committed(struct cxl_port * port)36 int cxl_num_decoders_committed(struct cxl_port *port)
37 {
38 lockdep_assert_held(&cxl_rwsem.region);
39
40 return port->commit_end + 1;
41 }
42
devtype_show(struct device * dev,struct device_attribute * attr,char * buf)43 static ssize_t devtype_show(struct device *dev, struct device_attribute *attr,
44 char *buf)
45 {
46 return sysfs_emit(buf, "%s\n", dev->type->name);
47 }
48 static DEVICE_ATTR_RO(devtype);
49
cxl_device_id(const struct device * dev)50 static int cxl_device_id(const struct device *dev)
51 {
52 if (dev->type == &cxl_nvdimm_bridge_type)
53 return CXL_DEVICE_NVDIMM_BRIDGE;
54 if (dev->type == &cxl_nvdimm_type)
55 return CXL_DEVICE_NVDIMM;
56 if (dev->type == CXL_PMEM_REGION_TYPE())
57 return CXL_DEVICE_PMEM_REGION;
58 if (dev->type == CXL_DAX_REGION_TYPE())
59 return CXL_DEVICE_DAX_REGION;
60 if (is_cxl_port(dev)) {
61 if (is_cxl_root(to_cxl_port(dev)))
62 return CXL_DEVICE_ROOT;
63 return CXL_DEVICE_PORT;
64 }
65 if (is_cxl_memdev(dev))
66 return CXL_DEVICE_MEMORY_EXPANDER;
67 if (dev->type == CXL_REGION_TYPE())
68 return CXL_DEVICE_REGION;
69 if (dev->type == &cxl_pmu_type)
70 return CXL_DEVICE_PMU;
71 return 0;
72 }
73
modalias_show(struct device * dev,struct device_attribute * attr,char * buf)74 static ssize_t modalias_show(struct device *dev, struct device_attribute *attr,
75 char *buf)
76 {
77 return sysfs_emit(buf, CXL_MODALIAS_FMT "\n", cxl_device_id(dev));
78 }
79 static DEVICE_ATTR_RO(modalias);
80
81 static struct attribute *cxl_base_attributes[] = {
82 &dev_attr_devtype.attr,
83 &dev_attr_modalias.attr,
84 NULL,
85 };
86
87 struct attribute_group cxl_base_attribute_group = {
88 .attrs = cxl_base_attributes,
89 };
90
start_show(struct device * dev,struct device_attribute * attr,char * buf)91 static ssize_t start_show(struct device *dev, struct device_attribute *attr,
92 char *buf)
93 {
94 struct cxl_decoder *cxld = to_cxl_decoder(dev);
95
96 return sysfs_emit(buf, "%#llx\n", cxld->hpa_range.start);
97 }
98 static DEVICE_ATTR_ADMIN_RO(start);
99
size_show(struct device * dev,struct device_attribute * attr,char * buf)100 static ssize_t size_show(struct device *dev, struct device_attribute *attr,
101 char *buf)
102 {
103 struct cxl_decoder *cxld = to_cxl_decoder(dev);
104
105 return sysfs_emit(buf, "%#llx\n", range_len(&cxld->hpa_range));
106 }
107 static DEVICE_ATTR_RO(size);
108
109 #define CXL_DECODER_FLAG_ATTR(name, flag) \
110 static ssize_t name##_show(struct device *dev, \
111 struct device_attribute *attr, char *buf) \
112 { \
113 struct cxl_decoder *cxld = to_cxl_decoder(dev); \
114 \
115 return sysfs_emit(buf, "%s\n", \
116 (cxld->flags & (flag)) ? "1" : "0"); \
117 } \
118 static DEVICE_ATTR_RO(name)
119
120 CXL_DECODER_FLAG_ATTR(cap_pmem, CXL_DECODER_F_PMEM);
121 CXL_DECODER_FLAG_ATTR(cap_ram, CXL_DECODER_F_RAM);
122 CXL_DECODER_FLAG_ATTR(cap_type2, CXL_DECODER_F_TYPE2);
123 CXL_DECODER_FLAG_ATTR(cap_type3, CXL_DECODER_F_TYPE3);
124 CXL_DECODER_FLAG_ATTR(locked, CXL_DECODER_F_LOCK);
125
target_type_show(struct device * dev,struct device_attribute * attr,char * buf)126 static ssize_t target_type_show(struct device *dev,
127 struct device_attribute *attr, char *buf)
128 {
129 struct cxl_decoder *cxld = to_cxl_decoder(dev);
130
131 switch (cxld->target_type) {
132 case CXL_DECODER_DEVMEM:
133 return sysfs_emit(buf, "accelerator\n");
134 case CXL_DECODER_HOSTONLYMEM:
135 return sysfs_emit(buf, "expander\n");
136 }
137 return -ENXIO;
138 }
139 static DEVICE_ATTR_RO(target_type);
140
emit_target_list(struct cxl_switch_decoder * cxlsd,char * buf)141 static ssize_t emit_target_list(struct cxl_switch_decoder *cxlsd, char *buf)
142 {
143 struct cxl_decoder *cxld = &cxlsd->cxld;
144 ssize_t offset = 0;
145 int i, rc = 0;
146
147 for (i = 0; i < cxld->interleave_ways; i++) {
148 struct cxl_dport *dport = cxlsd->target[i];
149 struct cxl_dport *next = NULL;
150
151 if (!dport)
152 break;
153
154 if (i + 1 < cxld->interleave_ways)
155 next = cxlsd->target[i + 1];
156 rc = sysfs_emit_at(buf, offset, "%d%s", dport->port_id,
157 next ? "," : "");
158 if (rc < 0)
159 return rc;
160 offset += rc;
161 }
162
163 return offset;
164 }
165
target_list_show(struct device * dev,struct device_attribute * attr,char * buf)166 static ssize_t target_list_show(struct device *dev,
167 struct device_attribute *attr, char *buf)
168 {
169 struct cxl_switch_decoder *cxlsd = to_cxl_switch_decoder(dev);
170 ssize_t offset;
171 int rc;
172
173 guard(rwsem_read)(&cxl_rwsem.region);
174 rc = emit_target_list(cxlsd, buf);
175 if (rc < 0)
176 return rc;
177 offset = rc;
178
179 rc = sysfs_emit_at(buf, offset, "\n");
180 if (rc < 0)
181 return rc;
182
183 return offset + rc;
184 }
185 static DEVICE_ATTR_RO(target_list);
186
mode_show(struct device * dev,struct device_attribute * attr,char * buf)187 static ssize_t mode_show(struct device *dev, struct device_attribute *attr,
188 char *buf)
189 {
190 struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev);
191 struct cxl_memdev *cxlmd = cxled_to_memdev(cxled);
192 struct cxl_dev_state *cxlds = cxlmd->cxlds;
193 /* without @cxl_rwsem.dpa, make sure @part is not reloaded */
194 int part = READ_ONCE(cxled->part);
195 const char *desc;
196
197 if (part < 0)
198 desc = "none";
199 else
200 desc = cxlds->part[part].res.name;
201
202 return sysfs_emit(buf, "%s\n", desc);
203 }
204
mode_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t len)205 static ssize_t mode_store(struct device *dev, struct device_attribute *attr,
206 const char *buf, size_t len)
207 {
208 struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev);
209 enum cxl_partition_mode mode;
210 ssize_t rc;
211
212 if (sysfs_streq(buf, "pmem"))
213 mode = CXL_PARTMODE_PMEM;
214 else if (sysfs_streq(buf, "ram"))
215 mode = CXL_PARTMODE_RAM;
216 else
217 return -EINVAL;
218
219 rc = cxl_dpa_set_part(cxled, mode);
220 if (rc)
221 return rc;
222
223 return len;
224 }
225 static DEVICE_ATTR_RW(mode);
226
dpa_resource_show(struct device * dev,struct device_attribute * attr,char * buf)227 static ssize_t dpa_resource_show(struct device *dev, struct device_attribute *attr,
228 char *buf)
229 {
230 struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev);
231
232 guard(rwsem_read)(&cxl_rwsem.dpa);
233 return sysfs_emit(buf, "%#llx\n", (u64)cxl_dpa_resource_start(cxled));
234 }
235 static DEVICE_ATTR_RO(dpa_resource);
236
dpa_size_show(struct device * dev,struct device_attribute * attr,char * buf)237 static ssize_t dpa_size_show(struct device *dev, struct device_attribute *attr,
238 char *buf)
239 {
240 struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev);
241 resource_size_t size = cxl_dpa_size(cxled);
242
243 return sysfs_emit(buf, "%pa\n", &size);
244 }
245
dpa_size_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t len)246 static ssize_t dpa_size_store(struct device *dev, struct device_attribute *attr,
247 const char *buf, size_t len)
248 {
249 struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev);
250 unsigned long long size;
251 ssize_t rc;
252
253 rc = kstrtoull(buf, 0, &size);
254 if (rc)
255 return rc;
256
257 if (!IS_ALIGNED(size, SZ_256M))
258 return -EINVAL;
259
260 rc = cxl_dpa_free(cxled);
261 if (rc)
262 return rc;
263
264 if (size == 0)
265 return len;
266
267 rc = cxl_dpa_alloc(cxled, size);
268 if (rc)
269 return rc;
270
271 return len;
272 }
273 static DEVICE_ATTR_RW(dpa_size);
274
interleave_granularity_show(struct device * dev,struct device_attribute * attr,char * buf)275 static ssize_t interleave_granularity_show(struct device *dev,
276 struct device_attribute *attr,
277 char *buf)
278 {
279 struct cxl_decoder *cxld = to_cxl_decoder(dev);
280
281 return sysfs_emit(buf, "%d\n", cxld->interleave_granularity);
282 }
283
284 static DEVICE_ATTR_RO(interleave_granularity);
285
interleave_ways_show(struct device * dev,struct device_attribute * attr,char * buf)286 static ssize_t interleave_ways_show(struct device *dev,
287 struct device_attribute *attr, char *buf)
288 {
289 struct cxl_decoder *cxld = to_cxl_decoder(dev);
290
291 return sysfs_emit(buf, "%d\n", cxld->interleave_ways);
292 }
293
294 static DEVICE_ATTR_RO(interleave_ways);
295
qos_class_show(struct device * dev,struct device_attribute * attr,char * buf)296 static ssize_t qos_class_show(struct device *dev,
297 struct device_attribute *attr, char *buf)
298 {
299 struct cxl_root_decoder *cxlrd = to_cxl_root_decoder(dev);
300
301 return sysfs_emit(buf, "%d\n", cxlrd->qos_class);
302 }
303 static DEVICE_ATTR_RO(qos_class);
304
305 static struct attribute *cxl_decoder_base_attrs[] = {
306 &dev_attr_start.attr,
307 &dev_attr_size.attr,
308 &dev_attr_locked.attr,
309 &dev_attr_interleave_granularity.attr,
310 &dev_attr_interleave_ways.attr,
311 NULL,
312 };
313
314 static struct attribute_group cxl_decoder_base_attribute_group = {
315 .attrs = cxl_decoder_base_attrs,
316 };
317
318 static struct attribute *cxl_decoder_root_attrs[] = {
319 &dev_attr_cap_pmem.attr,
320 &dev_attr_cap_ram.attr,
321 &dev_attr_cap_type2.attr,
322 &dev_attr_cap_type3.attr,
323 &dev_attr_target_list.attr,
324 &dev_attr_qos_class.attr,
325 SET_CXL_REGION_ATTR(create_pmem_region)
326 SET_CXL_REGION_ATTR(create_ram_region)
327 SET_CXL_REGION_ATTR(delete_region)
328 NULL,
329 };
330
can_create_pmem(struct cxl_root_decoder * cxlrd)331 static bool can_create_pmem(struct cxl_root_decoder *cxlrd)
332 {
333 unsigned long flags = CXL_DECODER_F_TYPE3 | CXL_DECODER_F_PMEM;
334
335 return (cxlrd->cxlsd.cxld.flags & flags) == flags;
336 }
337
can_create_ram(struct cxl_root_decoder * cxlrd)338 static bool can_create_ram(struct cxl_root_decoder *cxlrd)
339 {
340 unsigned long flags = CXL_DECODER_F_TYPE3 | CXL_DECODER_F_RAM;
341
342 return (cxlrd->cxlsd.cxld.flags & flags) == flags;
343 }
344
cxl_root_decoder_visible(struct kobject * kobj,struct attribute * a,int n)345 static umode_t cxl_root_decoder_visible(struct kobject *kobj, struct attribute *a, int n)
346 {
347 struct device *dev = kobj_to_dev(kobj);
348 struct cxl_root_decoder *cxlrd = to_cxl_root_decoder(dev);
349
350 if (a == CXL_REGION_ATTR(create_pmem_region) && !can_create_pmem(cxlrd))
351 return 0;
352
353 if (a == CXL_REGION_ATTR(create_ram_region) && !can_create_ram(cxlrd))
354 return 0;
355
356 if (a == CXL_REGION_ATTR(delete_region) &&
357 !(can_create_pmem(cxlrd) || can_create_ram(cxlrd)))
358 return 0;
359
360 return a->mode;
361 }
362
363 static struct attribute_group cxl_decoder_root_attribute_group = {
364 .attrs = cxl_decoder_root_attrs,
365 .is_visible = cxl_root_decoder_visible,
366 };
367
368 static const struct attribute_group *cxl_decoder_root_attribute_groups[] = {
369 &cxl_decoder_root_attribute_group,
370 &cxl_decoder_base_attribute_group,
371 &cxl_base_attribute_group,
372 NULL,
373 };
374
375 static struct attribute *cxl_decoder_switch_attrs[] = {
376 &dev_attr_target_type.attr,
377 &dev_attr_target_list.attr,
378 SET_CXL_REGION_ATTR(region)
379 NULL,
380 };
381
382 static struct attribute_group cxl_decoder_switch_attribute_group = {
383 .attrs = cxl_decoder_switch_attrs,
384 };
385
386 static const struct attribute_group *cxl_decoder_switch_attribute_groups[] = {
387 &cxl_decoder_switch_attribute_group,
388 &cxl_decoder_base_attribute_group,
389 &cxl_base_attribute_group,
390 NULL,
391 };
392
393 static struct attribute *cxl_decoder_endpoint_attrs[] = {
394 &dev_attr_target_type.attr,
395 &dev_attr_mode.attr,
396 &dev_attr_dpa_size.attr,
397 &dev_attr_dpa_resource.attr,
398 SET_CXL_REGION_ATTR(region)
399 NULL,
400 };
401
402 static struct attribute_group cxl_decoder_endpoint_attribute_group = {
403 .attrs = cxl_decoder_endpoint_attrs,
404 };
405
406 static const struct attribute_group *cxl_decoder_endpoint_attribute_groups[] = {
407 &cxl_decoder_base_attribute_group,
408 &cxl_decoder_endpoint_attribute_group,
409 &cxl_base_attribute_group,
410 NULL,
411 };
412
__cxl_decoder_release(struct cxl_decoder * cxld)413 static void __cxl_decoder_release(struct cxl_decoder *cxld)
414 {
415 struct cxl_port *port = to_cxl_port(cxld->dev.parent);
416
417 ida_free(&port->decoder_ida, cxld->id);
418 put_device(&port->dev);
419 }
420
cxl_endpoint_decoder_release(struct device * dev)421 static void cxl_endpoint_decoder_release(struct device *dev)
422 {
423 struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev);
424
425 __cxl_decoder_release(&cxled->cxld);
426 kfree(cxled);
427 }
428
cxl_switch_decoder_release(struct device * dev)429 static void cxl_switch_decoder_release(struct device *dev)
430 {
431 struct cxl_switch_decoder *cxlsd = to_cxl_switch_decoder(dev);
432
433 __cxl_decoder_release(&cxlsd->cxld);
434 kfree(cxlsd);
435 }
436
to_cxl_root_decoder(struct device * dev)437 struct cxl_root_decoder *to_cxl_root_decoder(struct device *dev)
438 {
439 if (dev_WARN_ONCE(dev, !is_root_decoder(dev),
440 "not a cxl_root_decoder device\n"))
441 return NULL;
442 return container_of(dev, struct cxl_root_decoder, cxlsd.cxld.dev);
443 }
444 EXPORT_SYMBOL_NS_GPL(to_cxl_root_decoder, "CXL");
445
cxl_root_decoder_release(struct device * dev)446 static void cxl_root_decoder_release(struct device *dev)
447 {
448 struct cxl_root_decoder *cxlrd = to_cxl_root_decoder(dev);
449
450 if (atomic_read(&cxlrd->region_id) >= 0)
451 memregion_free(atomic_read(&cxlrd->region_id));
452 __cxl_decoder_release(&cxlrd->cxlsd.cxld);
453 kfree(cxlrd);
454 }
455
456 static const struct device_type cxl_decoder_endpoint_type = {
457 .name = "cxl_decoder_endpoint",
458 .release = cxl_endpoint_decoder_release,
459 .groups = cxl_decoder_endpoint_attribute_groups,
460 };
461
462 static const struct device_type cxl_decoder_switch_type = {
463 .name = "cxl_decoder_switch",
464 .release = cxl_switch_decoder_release,
465 .groups = cxl_decoder_switch_attribute_groups,
466 };
467
468 static const struct device_type cxl_decoder_root_type = {
469 .name = "cxl_decoder_root",
470 .release = cxl_root_decoder_release,
471 .groups = cxl_decoder_root_attribute_groups,
472 };
473
is_endpoint_decoder(struct device * dev)474 bool is_endpoint_decoder(struct device *dev)
475 {
476 return dev->type == &cxl_decoder_endpoint_type;
477 }
478 EXPORT_SYMBOL_NS_GPL(is_endpoint_decoder, "CXL");
479
is_root_decoder(struct device * dev)480 bool is_root_decoder(struct device *dev)
481 {
482 return dev->type == &cxl_decoder_root_type;
483 }
484 EXPORT_SYMBOL_NS_GPL(is_root_decoder, "CXL");
485
is_switch_decoder(struct device * dev)486 bool is_switch_decoder(struct device *dev)
487 {
488 return is_root_decoder(dev) || dev->type == &cxl_decoder_switch_type;
489 }
490 EXPORT_SYMBOL_NS_GPL(is_switch_decoder, "CXL");
491
to_cxl_decoder(struct device * dev)492 struct cxl_decoder *to_cxl_decoder(struct device *dev)
493 {
494 if (dev_WARN_ONCE(dev,
495 !is_switch_decoder(dev) && !is_endpoint_decoder(dev),
496 "not a cxl_decoder device\n"))
497 return NULL;
498 return container_of(dev, struct cxl_decoder, dev);
499 }
500 EXPORT_SYMBOL_NS_GPL(to_cxl_decoder, "CXL");
501
to_cxl_endpoint_decoder(struct device * dev)502 struct cxl_endpoint_decoder *to_cxl_endpoint_decoder(struct device *dev)
503 {
504 if (dev_WARN_ONCE(dev, !is_endpoint_decoder(dev),
505 "not a cxl_endpoint_decoder device\n"))
506 return NULL;
507 return container_of(dev, struct cxl_endpoint_decoder, cxld.dev);
508 }
509 EXPORT_SYMBOL_NS_GPL(to_cxl_endpoint_decoder, "CXL");
510
to_cxl_switch_decoder(struct device * dev)511 struct cxl_switch_decoder *to_cxl_switch_decoder(struct device *dev)
512 {
513 if (dev_WARN_ONCE(dev, !is_switch_decoder(dev),
514 "not a cxl_switch_decoder device\n"))
515 return NULL;
516 return container_of(dev, struct cxl_switch_decoder, cxld.dev);
517 }
518 EXPORT_SYMBOL_NS_GPL(to_cxl_switch_decoder, "CXL");
519
cxl_ep_release(struct cxl_ep * ep)520 static void cxl_ep_release(struct cxl_ep *ep)
521 {
522 put_device(ep->ep);
523 kfree(ep);
524 }
525
cxl_ep_remove(struct cxl_port * port,struct cxl_ep * ep)526 static void cxl_ep_remove(struct cxl_port *port, struct cxl_ep *ep)
527 {
528 if (!ep)
529 return;
530 xa_erase(&port->endpoints, (unsigned long) ep->ep);
531 cxl_ep_release(ep);
532 }
533
cxl_port_release(struct device * dev)534 static void cxl_port_release(struct device *dev)
535 {
536 struct cxl_port *port = to_cxl_port(dev);
537 unsigned long index;
538 struct cxl_ep *ep;
539
540 xa_for_each(&port->endpoints, index, ep)
541 cxl_ep_remove(port, ep);
542 xa_destroy(&port->endpoints);
543 xa_destroy(&port->dports);
544 xa_destroy(&port->regions);
545 ida_free(&cxl_port_ida, port->id);
546 if (is_cxl_root(port))
547 kfree(to_cxl_root(port));
548 else
549 kfree(port);
550 }
551
decoders_committed_show(struct device * dev,struct device_attribute * attr,char * buf)552 static ssize_t decoders_committed_show(struct device *dev,
553 struct device_attribute *attr, char *buf)
554 {
555 struct cxl_port *port = to_cxl_port(dev);
556
557 guard(rwsem_read)(&cxl_rwsem.region);
558 return sysfs_emit(buf, "%d\n", cxl_num_decoders_committed(port));
559 }
560
561 static DEVICE_ATTR_RO(decoders_committed);
562
563 static struct attribute *cxl_port_attrs[] = {
564 &dev_attr_decoders_committed.attr,
565 NULL,
566 };
567
568 static struct attribute_group cxl_port_attribute_group = {
569 .attrs = cxl_port_attrs,
570 };
571
572 static const struct attribute_group *cxl_port_attribute_groups[] = {
573 &cxl_base_attribute_group,
574 &cxl_port_attribute_group,
575 NULL,
576 };
577
578 static const struct device_type cxl_port_type = {
579 .name = "cxl_port",
580 .release = cxl_port_release,
581 .groups = cxl_port_attribute_groups,
582 };
583
is_cxl_port(const struct device * dev)584 bool is_cxl_port(const struct device *dev)
585 {
586 return dev->type == &cxl_port_type;
587 }
588 EXPORT_SYMBOL_NS_GPL(is_cxl_port, "CXL");
589
to_cxl_port(const struct device * dev)590 struct cxl_port *to_cxl_port(const struct device *dev)
591 {
592 if (dev_WARN_ONCE(dev, dev->type != &cxl_port_type,
593 "not a cxl_port device\n"))
594 return NULL;
595 return container_of(dev, struct cxl_port, dev);
596 }
597 EXPORT_SYMBOL_NS_GPL(to_cxl_port, "CXL");
598
parent_port_of(struct cxl_port * port)599 struct cxl_port *parent_port_of(struct cxl_port *port)
600 {
601 if (!port || !port->parent_dport)
602 return NULL;
603 return port->parent_dport->port;
604 }
605
unregister_port(void * _port)606 static void unregister_port(void *_port)
607 {
608 struct cxl_port *port = _port;
609 struct cxl_port *parent = parent_port_of(port);
610 struct device *lock_dev;
611
612 /*
613 * CXL root port's and the first level of ports are unregistered
614 * under the platform firmware device lock, all other ports are
615 * unregistered while holding their parent port lock.
616 */
617 if (!parent)
618 lock_dev = port->uport_dev;
619 else if (is_cxl_root(parent))
620 lock_dev = parent->uport_dev;
621 else
622 lock_dev = &parent->dev;
623
624 device_lock_assert(lock_dev);
625 port->dead = true;
626 device_unregister(&port->dev);
627 }
628
cxl_unlink_uport(void * _port)629 static void cxl_unlink_uport(void *_port)
630 {
631 struct cxl_port *port = _port;
632
633 sysfs_remove_link(&port->dev.kobj, "uport");
634 }
635
devm_cxl_link_uport(struct device * host,struct cxl_port * port)636 static int devm_cxl_link_uport(struct device *host, struct cxl_port *port)
637 {
638 int rc;
639
640 rc = sysfs_create_link(&port->dev.kobj, &port->uport_dev->kobj,
641 "uport");
642 if (rc)
643 return rc;
644 return devm_add_action_or_reset(host, cxl_unlink_uport, port);
645 }
646
cxl_unlink_parent_dport(void * _port)647 static void cxl_unlink_parent_dport(void *_port)
648 {
649 struct cxl_port *port = _port;
650
651 sysfs_remove_link(&port->dev.kobj, "parent_dport");
652 }
653
devm_cxl_link_parent_dport(struct device * host,struct cxl_port * port,struct cxl_dport * parent_dport)654 static int devm_cxl_link_parent_dport(struct device *host,
655 struct cxl_port *port,
656 struct cxl_dport *parent_dport)
657 {
658 int rc;
659
660 if (!parent_dport)
661 return 0;
662
663 rc = sysfs_create_link(&port->dev.kobj, &parent_dport->dport_dev->kobj,
664 "parent_dport");
665 if (rc)
666 return rc;
667 return devm_add_action_or_reset(host, cxl_unlink_parent_dport, port);
668 }
669
670 static struct lock_class_key cxl_port_key;
671
cxl_port_alloc(struct device * uport_dev,struct cxl_dport * parent_dport)672 static struct cxl_port *cxl_port_alloc(struct device *uport_dev,
673 struct cxl_dport *parent_dport)
674 {
675 struct cxl_root *cxl_root __free(kfree) = NULL;
676 struct cxl_port *port, *_port __free(kfree) = NULL;
677 struct device *dev;
678 int rc;
679
680 /* No parent_dport, root cxl_port */
681 if (!parent_dport) {
682 cxl_root = kzalloc(sizeof(*cxl_root), GFP_KERNEL);
683 if (!cxl_root)
684 return ERR_PTR(-ENOMEM);
685 } else {
686 _port = kzalloc(sizeof(*port), GFP_KERNEL);
687 if (!_port)
688 return ERR_PTR(-ENOMEM);
689 }
690
691 rc = ida_alloc(&cxl_port_ida, GFP_KERNEL);
692 if (rc < 0)
693 return ERR_PTR(rc);
694
695 if (cxl_root)
696 port = &no_free_ptr(cxl_root)->port;
697 else
698 port = no_free_ptr(_port);
699
700 port->id = rc;
701 port->uport_dev = uport_dev;
702
703 /*
704 * The top-level cxl_port "cxl_root" does not have a cxl_port as
705 * its parent and it does not have any corresponding component
706 * registers as its decode is described by a fixed platform
707 * description.
708 */
709 dev = &port->dev;
710 if (parent_dport) {
711 struct cxl_port *parent_port = parent_dport->port;
712 struct cxl_port *iter;
713
714 dev->parent = &parent_port->dev;
715 port->depth = parent_port->depth + 1;
716 port->parent_dport = parent_dport;
717
718 /*
719 * walk to the host bridge, or the first ancestor that knows
720 * the host bridge
721 */
722 iter = port;
723 while (!iter->host_bridge &&
724 !is_cxl_root(to_cxl_port(iter->dev.parent)))
725 iter = to_cxl_port(iter->dev.parent);
726 if (iter->host_bridge)
727 port->host_bridge = iter->host_bridge;
728 else if (parent_dport->rch)
729 port->host_bridge = parent_dport->dport_dev;
730 else
731 port->host_bridge = iter->uport_dev;
732 dev_dbg(uport_dev, "host-bridge: %s\n",
733 dev_name(port->host_bridge));
734 } else
735 dev->parent = uport_dev;
736
737 ida_init(&port->decoder_ida);
738 port->hdm_end = -1;
739 port->commit_end = -1;
740 xa_init(&port->dports);
741 xa_init(&port->endpoints);
742 xa_init(&port->regions);
743
744 device_initialize(dev);
745 lockdep_set_class_and_subclass(&dev->mutex, &cxl_port_key, port->depth);
746 device_set_pm_not_required(dev);
747 dev->bus = &cxl_bus_type;
748 dev->type = &cxl_port_type;
749
750 return port;
751 }
752
cxl_setup_comp_regs(struct device * host,struct cxl_register_map * map,resource_size_t component_reg_phys)753 static int cxl_setup_comp_regs(struct device *host, struct cxl_register_map *map,
754 resource_size_t component_reg_phys)
755 {
756 *map = (struct cxl_register_map) {
757 .host = host,
758 .reg_type = CXL_REGLOC_RBI_EMPTY,
759 .resource = component_reg_phys,
760 };
761
762 if (component_reg_phys == CXL_RESOURCE_NONE)
763 return 0;
764
765 map->reg_type = CXL_REGLOC_RBI_COMPONENT;
766 map->max_size = CXL_COMPONENT_REG_BLOCK_SIZE;
767
768 return cxl_setup_regs(map);
769 }
770
cxl_port_setup_regs(struct cxl_port * port,resource_size_t component_reg_phys)771 static int cxl_port_setup_regs(struct cxl_port *port,
772 resource_size_t component_reg_phys)
773 {
774 if (dev_is_platform(port->uport_dev))
775 return 0;
776 return cxl_setup_comp_regs(&port->dev, &port->reg_map,
777 component_reg_phys);
778 }
779
cxl_dport_setup_regs(struct device * host,struct cxl_dport * dport,resource_size_t component_reg_phys)780 static int cxl_dport_setup_regs(struct device *host, struct cxl_dport *dport,
781 resource_size_t component_reg_phys)
782 {
783 int rc;
784
785 if (dev_is_platform(dport->dport_dev))
786 return 0;
787
788 /*
789 * use @dport->dport_dev for the context for error messages during
790 * register probing, and fixup @host after the fact, since @host may be
791 * NULL.
792 */
793 rc = cxl_setup_comp_regs(dport->dport_dev, &dport->reg_map,
794 component_reg_phys);
795 dport->reg_map.host = host;
796 return rc;
797 }
798
799 DEFINE_SHOW_ATTRIBUTE(einj_cxl_available_error_type);
800
cxl_einj_inject(void * data,u64 type)801 static int cxl_einj_inject(void *data, u64 type)
802 {
803 struct cxl_dport *dport = data;
804
805 if (dport->rch)
806 return einj_cxl_inject_rch_error(dport->rcrb.base, type);
807
808 return einj_cxl_inject_error(to_pci_dev(dport->dport_dev), type);
809 }
810 DEFINE_DEBUGFS_ATTRIBUTE(cxl_einj_inject_fops, NULL, cxl_einj_inject,
811 "0x%llx\n");
812
cxl_debugfs_create_dport_dir(struct cxl_dport * dport)813 static void cxl_debugfs_create_dport_dir(struct cxl_dport *dport)
814 {
815 struct dentry *dir;
816
817 if (!einj_cxl_is_initialized())
818 return;
819
820 /*
821 * dport_dev needs to be a PCIe port for CXL 2.0+ ports because
822 * EINJ expects a dport SBDF to be specified for 2.0 error injection.
823 */
824 if (!dport->rch && !dev_is_pci(dport->dport_dev))
825 return;
826
827 dir = cxl_debugfs_create_dir(dev_name(dport->dport_dev));
828
829 debugfs_create_file("einj_inject", 0200, dir, dport,
830 &cxl_einj_inject_fops);
831 }
832
cxl_port_add(struct cxl_port * port,resource_size_t component_reg_phys,struct cxl_dport * parent_dport)833 static int cxl_port_add(struct cxl_port *port,
834 resource_size_t component_reg_phys,
835 struct cxl_dport *parent_dport)
836 {
837 struct device *dev __free(put_device) = &port->dev;
838 int rc;
839
840 if (is_cxl_memdev(port->uport_dev)) {
841 struct cxl_memdev *cxlmd = to_cxl_memdev(port->uport_dev);
842 struct cxl_dev_state *cxlds = cxlmd->cxlds;
843
844 rc = dev_set_name(dev, "endpoint%d", port->id);
845 if (rc)
846 return rc;
847
848 /*
849 * The endpoint driver already enumerated the component and RAS
850 * registers. Reuse that enumeration while prepping them to be
851 * mapped by the cxl_port driver.
852 */
853 port->reg_map = cxlds->reg_map;
854 port->reg_map.host = &port->dev;
855 cxlmd->endpoint = port;
856 } else if (parent_dport) {
857 rc = dev_set_name(dev, "port%d", port->id);
858 if (rc)
859 return rc;
860
861 rc = cxl_port_setup_regs(port, component_reg_phys);
862 if (rc)
863 return rc;
864 } else {
865 rc = dev_set_name(dev, "root%d", port->id);
866 if (rc)
867 return rc;
868 }
869
870 rc = device_add(dev);
871 if (rc)
872 return rc;
873
874 /* Inhibit the cleanup function invoked */
875 dev = NULL;
876 return 0;
877 }
878
__devm_cxl_add_port(struct device * host,struct device * uport_dev,resource_size_t component_reg_phys,struct cxl_dport * parent_dport)879 static struct cxl_port *__devm_cxl_add_port(struct device *host,
880 struct device *uport_dev,
881 resource_size_t component_reg_phys,
882 struct cxl_dport *parent_dport)
883 {
884 struct cxl_port *port;
885 int rc;
886
887 port = cxl_port_alloc(uport_dev, parent_dport);
888 if (IS_ERR(port))
889 return port;
890
891 rc = cxl_port_add(port, component_reg_phys, parent_dport);
892 if (rc)
893 return ERR_PTR(rc);
894
895 rc = devm_add_action_or_reset(host, unregister_port, port);
896 if (rc)
897 return ERR_PTR(rc);
898
899 rc = devm_cxl_link_uport(host, port);
900 if (rc)
901 return ERR_PTR(rc);
902
903 rc = devm_cxl_link_parent_dport(host, port, parent_dport);
904 if (rc)
905 return ERR_PTR(rc);
906
907 if (parent_dport && dev_is_pci(uport_dev))
908 port->pci_latency = cxl_pci_get_latency(to_pci_dev(uport_dev));
909
910 return port;
911 }
912
913 /**
914 * devm_cxl_add_port - register a cxl_port in CXL memory decode hierarchy
915 * @host: host device for devm operations
916 * @uport_dev: "physical" device implementing this upstream port
917 * @component_reg_phys: (optional) for configurable cxl_port instances
918 * @parent_dport: next hop up in the CXL memory decode hierarchy
919 */
devm_cxl_add_port(struct device * host,struct device * uport_dev,resource_size_t component_reg_phys,struct cxl_dport * parent_dport)920 struct cxl_port *devm_cxl_add_port(struct device *host,
921 struct device *uport_dev,
922 resource_size_t component_reg_phys,
923 struct cxl_dport *parent_dport)
924 {
925 struct cxl_port *port, *parent_port;
926
927 port = __devm_cxl_add_port(host, uport_dev, component_reg_phys,
928 parent_dport);
929
930 parent_port = parent_dport ? parent_dport->port : NULL;
931 if (IS_ERR(port)) {
932 dev_dbg(uport_dev, "Failed to add%s%s%s: %ld\n",
933 parent_port ? " port to " : "",
934 parent_port ? dev_name(&parent_port->dev) : "",
935 parent_port ? "" : " root port",
936 PTR_ERR(port));
937 } else {
938 dev_dbg(uport_dev, "%s added%s%s%s\n",
939 dev_name(&port->dev),
940 parent_port ? " to " : "",
941 parent_port ? dev_name(&parent_port->dev) : "",
942 parent_port ? "" : " (root port)");
943 }
944
945 return port;
946 }
947 EXPORT_SYMBOL_NS_GPL(devm_cxl_add_port, "CXL");
948
devm_cxl_add_root(struct device * host,const struct cxl_root_ops * ops)949 struct cxl_root *devm_cxl_add_root(struct device *host,
950 const struct cxl_root_ops *ops)
951 {
952 struct cxl_root *cxl_root;
953 struct cxl_port *port;
954
955 port = devm_cxl_add_port(host, host, CXL_RESOURCE_NONE, NULL);
956 if (IS_ERR(port))
957 return ERR_CAST(port);
958
959 cxl_root = to_cxl_root(port);
960 cxl_root->ops = ops;
961 return cxl_root;
962 }
963 EXPORT_SYMBOL_NS_GPL(devm_cxl_add_root, "CXL");
964
cxl_port_to_pci_bus(struct cxl_port * port)965 struct pci_bus *cxl_port_to_pci_bus(struct cxl_port *port)
966 {
967 /* There is no pci_bus associated with a CXL platform-root port */
968 if (is_cxl_root(port))
969 return NULL;
970
971 if (dev_is_pci(port->uport_dev)) {
972 struct pci_dev *pdev = to_pci_dev(port->uport_dev);
973
974 return pdev->subordinate;
975 }
976
977 return xa_load(&cxl_root_buses, (unsigned long)port->uport_dev);
978 }
979 EXPORT_SYMBOL_NS_GPL(cxl_port_to_pci_bus, "CXL");
980
unregister_pci_bus(void * uport_dev)981 static void unregister_pci_bus(void *uport_dev)
982 {
983 xa_erase(&cxl_root_buses, (unsigned long)uport_dev);
984 }
985
devm_cxl_register_pci_bus(struct device * host,struct device * uport_dev,struct pci_bus * bus)986 int devm_cxl_register_pci_bus(struct device *host, struct device *uport_dev,
987 struct pci_bus *bus)
988 {
989 int rc;
990
991 if (dev_is_pci(uport_dev))
992 return -EINVAL;
993
994 rc = xa_insert(&cxl_root_buses, (unsigned long)uport_dev, bus,
995 GFP_KERNEL);
996 if (rc)
997 return rc;
998 return devm_add_action_or_reset(host, unregister_pci_bus, uport_dev);
999 }
1000 EXPORT_SYMBOL_NS_GPL(devm_cxl_register_pci_bus, "CXL");
1001
dev_is_cxl_root_child(struct device * dev)1002 static bool dev_is_cxl_root_child(struct device *dev)
1003 {
1004 struct cxl_port *port, *parent;
1005
1006 if (!is_cxl_port(dev))
1007 return false;
1008
1009 port = to_cxl_port(dev);
1010 if (is_cxl_root(port))
1011 return false;
1012
1013 parent = to_cxl_port(port->dev.parent);
1014 if (is_cxl_root(parent))
1015 return true;
1016
1017 return false;
1018 }
1019
find_cxl_root(struct cxl_port * port)1020 struct cxl_root *find_cxl_root(struct cxl_port *port)
1021 {
1022 struct cxl_port *iter = port;
1023
1024 while (iter && !is_cxl_root(iter))
1025 iter = to_cxl_port(iter->dev.parent);
1026
1027 if (!iter)
1028 return NULL;
1029 get_device(&iter->dev);
1030 return to_cxl_root(iter);
1031 }
1032 EXPORT_SYMBOL_NS_GPL(find_cxl_root, "CXL");
1033
find_dport(struct cxl_port * port,int id)1034 static struct cxl_dport *find_dport(struct cxl_port *port, int id)
1035 {
1036 struct cxl_dport *dport;
1037 unsigned long index;
1038
1039 device_lock_assert(&port->dev);
1040 xa_for_each(&port->dports, index, dport)
1041 if (dport->port_id == id)
1042 return dport;
1043 return NULL;
1044 }
1045
add_dport(struct cxl_port * port,struct cxl_dport * dport)1046 static int add_dport(struct cxl_port *port, struct cxl_dport *dport)
1047 {
1048 struct cxl_dport *dup;
1049 int rc;
1050
1051 device_lock_assert(&port->dev);
1052 dup = find_dport(port, dport->port_id);
1053 if (dup) {
1054 dev_err(&port->dev,
1055 "unable to add dport%d-%s non-unique port id (%s)\n",
1056 dport->port_id, dev_name(dport->dport_dev),
1057 dev_name(dup->dport_dev));
1058 return -EBUSY;
1059 }
1060
1061 rc = xa_insert(&port->dports, (unsigned long)dport->dport_dev, dport,
1062 GFP_KERNEL);
1063 if (rc)
1064 return rc;
1065
1066 port->nr_dports++;
1067 return 0;
1068 }
1069
1070 /*
1071 * Since root-level CXL dports cannot be enumerated by PCI they are not
1072 * enumerated by the common port driver that acquires the port lock over
1073 * dport add/remove. Instead, root dports are manually added by a
1074 * platform driver and cond_cxl_root_lock() is used to take the missing
1075 * port lock in that case.
1076 */
cond_cxl_root_lock(struct cxl_port * port)1077 static void cond_cxl_root_lock(struct cxl_port *port)
1078 {
1079 if (is_cxl_root(port))
1080 device_lock(&port->dev);
1081 }
1082
cond_cxl_root_unlock(struct cxl_port * port)1083 static void cond_cxl_root_unlock(struct cxl_port *port)
1084 {
1085 if (is_cxl_root(port))
1086 device_unlock(&port->dev);
1087 }
1088
cxl_dport_remove(void * data)1089 static void cxl_dport_remove(void *data)
1090 {
1091 struct cxl_dport *dport = data;
1092 struct cxl_port *port = dport->port;
1093
1094 xa_erase(&port->dports, (unsigned long) dport->dport_dev);
1095 put_device(dport->dport_dev);
1096 }
1097
cxl_dport_unlink(void * data)1098 static void cxl_dport_unlink(void *data)
1099 {
1100 struct cxl_dport *dport = data;
1101 struct cxl_port *port = dport->port;
1102 char link_name[CXL_TARGET_STRLEN];
1103
1104 sprintf(link_name, "dport%d", dport->port_id);
1105 sysfs_remove_link(&port->dev.kobj, link_name);
1106 }
1107
1108 static struct cxl_dport *
__devm_cxl_add_dport(struct cxl_port * port,struct device * dport_dev,int port_id,resource_size_t component_reg_phys,resource_size_t rcrb)1109 __devm_cxl_add_dport(struct cxl_port *port, struct device *dport_dev,
1110 int port_id, resource_size_t component_reg_phys,
1111 resource_size_t rcrb)
1112 {
1113 char link_name[CXL_TARGET_STRLEN];
1114 struct cxl_dport *dport;
1115 struct device *host;
1116 int rc;
1117
1118 if (is_cxl_root(port))
1119 host = port->uport_dev;
1120 else
1121 host = &port->dev;
1122
1123 if (!host->driver) {
1124 dev_WARN_ONCE(&port->dev, 1, "dport:%s bad devm context\n",
1125 dev_name(dport_dev));
1126 return ERR_PTR(-ENXIO);
1127 }
1128
1129 if (snprintf(link_name, CXL_TARGET_STRLEN, "dport%d", port_id) >=
1130 CXL_TARGET_STRLEN)
1131 return ERR_PTR(-EINVAL);
1132
1133 dport = devm_kzalloc(host, sizeof(*dport), GFP_KERNEL);
1134 if (!dport)
1135 return ERR_PTR(-ENOMEM);
1136
1137 dport->dport_dev = dport_dev;
1138 dport->port_id = port_id;
1139 dport->port = port;
1140
1141 if (rcrb == CXL_RESOURCE_NONE) {
1142 rc = cxl_dport_setup_regs(&port->dev, dport,
1143 component_reg_phys);
1144 if (rc)
1145 return ERR_PTR(rc);
1146 } else {
1147 dport->rcrb.base = rcrb;
1148 component_reg_phys = __rcrb_to_component(dport_dev, &dport->rcrb,
1149 CXL_RCRB_DOWNSTREAM);
1150 if (component_reg_phys == CXL_RESOURCE_NONE) {
1151 dev_warn(dport_dev, "Invalid Component Registers in RCRB");
1152 return ERR_PTR(-ENXIO);
1153 }
1154
1155 /*
1156 * RCH @dport is not ready to map until associated with its
1157 * memdev
1158 */
1159 rc = cxl_dport_setup_regs(NULL, dport, component_reg_phys);
1160 if (rc)
1161 return ERR_PTR(rc);
1162
1163 dport->rch = true;
1164 }
1165
1166 if (component_reg_phys != CXL_RESOURCE_NONE)
1167 dev_dbg(dport_dev, "Component Registers found for dport: %pa\n",
1168 &component_reg_phys);
1169
1170 cond_cxl_root_lock(port);
1171 rc = add_dport(port, dport);
1172 cond_cxl_root_unlock(port);
1173 if (rc)
1174 return ERR_PTR(rc);
1175
1176 get_device(dport_dev);
1177 rc = devm_add_action_or_reset(host, cxl_dport_remove, dport);
1178 if (rc)
1179 return ERR_PTR(rc);
1180
1181 rc = sysfs_create_link(&port->dev.kobj, &dport_dev->kobj, link_name);
1182 if (rc)
1183 return ERR_PTR(rc);
1184
1185 rc = devm_add_action_or_reset(host, cxl_dport_unlink, dport);
1186 if (rc)
1187 return ERR_PTR(rc);
1188
1189 if (dev_is_pci(dport_dev))
1190 dport->link_latency = cxl_pci_get_latency(to_pci_dev(dport_dev));
1191
1192 cxl_debugfs_create_dport_dir(dport);
1193
1194 return dport;
1195 }
1196
1197 /**
1198 * devm_cxl_add_dport - append VH downstream port data to a cxl_port
1199 * @port: the cxl_port that references this dport
1200 * @dport_dev: firmware or PCI device representing the dport
1201 * @port_id: identifier for this dport in a decoder's target list
1202 * @component_reg_phys: optional location of CXL component registers
1203 *
1204 * Note that dports are appended to the devm release action's of the
1205 * either the port's host (for root ports), or the port itself (for
1206 * switch ports)
1207 */
devm_cxl_add_dport(struct cxl_port * port,struct device * dport_dev,int port_id,resource_size_t component_reg_phys)1208 struct cxl_dport *devm_cxl_add_dport(struct cxl_port *port,
1209 struct device *dport_dev, int port_id,
1210 resource_size_t component_reg_phys)
1211 {
1212 struct cxl_dport *dport;
1213
1214 dport = __devm_cxl_add_dport(port, dport_dev, port_id,
1215 component_reg_phys, CXL_RESOURCE_NONE);
1216 if (IS_ERR(dport)) {
1217 dev_dbg(dport_dev, "failed to add dport to %s: %ld\n",
1218 dev_name(&port->dev), PTR_ERR(dport));
1219 } else {
1220 dev_dbg(dport_dev, "dport added to %s\n",
1221 dev_name(&port->dev));
1222 }
1223
1224 return dport;
1225 }
1226 EXPORT_SYMBOL_NS_GPL(devm_cxl_add_dport, "CXL");
1227
1228 /**
1229 * devm_cxl_add_rch_dport - append RCH downstream port data to a cxl_port
1230 * @port: the cxl_port that references this dport
1231 * @dport_dev: firmware or PCI device representing the dport
1232 * @port_id: identifier for this dport in a decoder's target list
1233 * @rcrb: mandatory location of a Root Complex Register Block
1234 *
1235 * See CXL 3.0 9.11.8 CXL Devices Attached to an RCH
1236 */
devm_cxl_add_rch_dport(struct cxl_port * port,struct device * dport_dev,int port_id,resource_size_t rcrb)1237 struct cxl_dport *devm_cxl_add_rch_dport(struct cxl_port *port,
1238 struct device *dport_dev, int port_id,
1239 resource_size_t rcrb)
1240 {
1241 struct cxl_dport *dport;
1242
1243 if (rcrb == CXL_RESOURCE_NONE) {
1244 dev_dbg(&port->dev, "failed to add RCH dport, missing RCRB\n");
1245 return ERR_PTR(-EINVAL);
1246 }
1247
1248 dport = __devm_cxl_add_dport(port, dport_dev, port_id,
1249 CXL_RESOURCE_NONE, rcrb);
1250 if (IS_ERR(dport)) {
1251 dev_dbg(dport_dev, "failed to add RCH dport to %s: %ld\n",
1252 dev_name(&port->dev), PTR_ERR(dport));
1253 } else {
1254 dev_dbg(dport_dev, "RCH dport added to %s\n",
1255 dev_name(&port->dev));
1256 }
1257
1258 return dport;
1259 }
1260 EXPORT_SYMBOL_NS_GPL(devm_cxl_add_rch_dport, "CXL");
1261
add_ep(struct cxl_ep * new)1262 static int add_ep(struct cxl_ep *new)
1263 {
1264 struct cxl_port *port = new->dport->port;
1265
1266 guard(device)(&port->dev);
1267 if (port->dead)
1268 return -ENXIO;
1269
1270 return xa_insert(&port->endpoints, (unsigned long)new->ep,
1271 new, GFP_KERNEL);
1272 }
1273
1274 /**
1275 * cxl_add_ep - register an endpoint's interest in a port
1276 * @dport: the dport that routes to @ep_dev
1277 * @ep_dev: device representing the endpoint
1278 *
1279 * Intermediate CXL ports are scanned based on the arrival of endpoints.
1280 * When those endpoints depart the port can be destroyed once all
1281 * endpoints that care about that port have been removed.
1282 */
cxl_add_ep(struct cxl_dport * dport,struct device * ep_dev)1283 static int cxl_add_ep(struct cxl_dport *dport, struct device *ep_dev)
1284 {
1285 struct cxl_ep *ep;
1286 int rc;
1287
1288 ep = kzalloc(sizeof(*ep), GFP_KERNEL);
1289 if (!ep)
1290 return -ENOMEM;
1291
1292 ep->ep = get_device(ep_dev);
1293 ep->dport = dport;
1294
1295 rc = add_ep(ep);
1296 if (rc)
1297 cxl_ep_release(ep);
1298 return rc;
1299 }
1300
1301 struct cxl_find_port_ctx {
1302 const struct device *dport_dev;
1303 const struct cxl_port *parent_port;
1304 struct cxl_dport **dport;
1305 };
1306
match_port_by_dport(struct device * dev,const void * data)1307 static int match_port_by_dport(struct device *dev, const void *data)
1308 {
1309 const struct cxl_find_port_ctx *ctx = data;
1310 struct cxl_dport *dport;
1311 struct cxl_port *port;
1312
1313 if (!is_cxl_port(dev))
1314 return 0;
1315 if (ctx->parent_port && dev->parent != &ctx->parent_port->dev)
1316 return 0;
1317
1318 port = to_cxl_port(dev);
1319 dport = cxl_find_dport_by_dev(port, ctx->dport_dev);
1320 if (ctx->dport)
1321 *ctx->dport = dport;
1322 return dport != NULL;
1323 }
1324
__find_cxl_port(struct cxl_find_port_ctx * ctx)1325 static struct cxl_port *__find_cxl_port(struct cxl_find_port_ctx *ctx)
1326 {
1327 struct device *dev;
1328
1329 if (!ctx->dport_dev)
1330 return NULL;
1331
1332 dev = bus_find_device(&cxl_bus_type, NULL, ctx, match_port_by_dport);
1333 if (dev)
1334 return to_cxl_port(dev);
1335 return NULL;
1336 }
1337
find_cxl_port(struct device * dport_dev,struct cxl_dport ** dport)1338 static struct cxl_port *find_cxl_port(struct device *dport_dev,
1339 struct cxl_dport **dport)
1340 {
1341 struct cxl_find_port_ctx ctx = {
1342 .dport_dev = dport_dev,
1343 .dport = dport,
1344 };
1345 struct cxl_port *port;
1346
1347 port = __find_cxl_port(&ctx);
1348 return port;
1349 }
1350
find_cxl_port_at(struct cxl_port * parent_port,struct device * dport_dev,struct cxl_dport ** dport)1351 static struct cxl_port *find_cxl_port_at(struct cxl_port *parent_port,
1352 struct device *dport_dev,
1353 struct cxl_dport **dport)
1354 {
1355 struct cxl_find_port_ctx ctx = {
1356 .dport_dev = dport_dev,
1357 .parent_port = parent_port,
1358 .dport = dport,
1359 };
1360 struct cxl_port *port;
1361
1362 port = __find_cxl_port(&ctx);
1363 return port;
1364 }
1365
1366 /*
1367 * All users of grandparent() are using it to walk PCIe-like switch port
1368 * hierarchy. A PCIe switch is comprised of a bridge device representing the
1369 * upstream switch port and N bridges representing downstream switch ports. When
1370 * bridges stack the grand-parent of a downstream switch port is another
1371 * downstream switch port in the immediate ancestor switch.
1372 */
grandparent(struct device * dev)1373 static struct device *grandparent(struct device *dev)
1374 {
1375 if (dev && dev->parent)
1376 return dev->parent->parent;
1377 return NULL;
1378 }
1379
endpoint_host(struct cxl_port * endpoint)1380 static struct device *endpoint_host(struct cxl_port *endpoint)
1381 {
1382 struct cxl_port *port = to_cxl_port(endpoint->dev.parent);
1383
1384 if (is_cxl_root(port))
1385 return port->uport_dev;
1386 return &port->dev;
1387 }
1388
delete_endpoint(void * data)1389 static void delete_endpoint(void *data)
1390 {
1391 struct cxl_memdev *cxlmd = data;
1392 struct cxl_port *endpoint = cxlmd->endpoint;
1393 struct device *host = endpoint_host(endpoint);
1394
1395 scoped_guard(device, host) {
1396 if (host->driver && !endpoint->dead) {
1397 devm_release_action(host, cxl_unlink_parent_dport, endpoint);
1398 devm_release_action(host, cxl_unlink_uport, endpoint);
1399 devm_release_action(host, unregister_port, endpoint);
1400 }
1401 cxlmd->endpoint = NULL;
1402 }
1403 put_device(&endpoint->dev);
1404 put_device(host);
1405 }
1406
cxl_endpoint_autoremove(struct cxl_memdev * cxlmd,struct cxl_port * endpoint)1407 int cxl_endpoint_autoremove(struct cxl_memdev *cxlmd, struct cxl_port *endpoint)
1408 {
1409 struct device *host = endpoint_host(endpoint);
1410 struct device *dev = &cxlmd->dev;
1411
1412 get_device(host);
1413 get_device(&endpoint->dev);
1414 cxlmd->depth = endpoint->depth;
1415 return devm_add_action_or_reset(dev, delete_endpoint, cxlmd);
1416 }
1417 EXPORT_SYMBOL_NS_GPL(cxl_endpoint_autoremove, "CXL");
1418
1419 /*
1420 * The natural end of life of a non-root 'cxl_port' is when its parent port goes
1421 * through a ->remove() event ("top-down" unregistration). The unnatural trigger
1422 * for a port to be unregistered is when all memdevs beneath that port have gone
1423 * through ->remove(). This "bottom-up" removal selectively removes individual
1424 * child ports manually. This depends on devm_cxl_add_port() to not change is
1425 * devm action registration order, and for dports to have already been
1426 * destroyed by reap_dports().
1427 */
delete_switch_port(struct cxl_port * port)1428 static void delete_switch_port(struct cxl_port *port)
1429 {
1430 devm_release_action(port->dev.parent, cxl_unlink_parent_dport, port);
1431 devm_release_action(port->dev.parent, cxl_unlink_uport, port);
1432 devm_release_action(port->dev.parent, unregister_port, port);
1433 }
1434
reap_dports(struct cxl_port * port)1435 static void reap_dports(struct cxl_port *port)
1436 {
1437 struct cxl_dport *dport;
1438 unsigned long index;
1439
1440 device_lock_assert(&port->dev);
1441
1442 xa_for_each(&port->dports, index, dport) {
1443 devm_release_action(&port->dev, cxl_dport_unlink, dport);
1444 devm_release_action(&port->dev, cxl_dport_remove, dport);
1445 devm_kfree(&port->dev, dport);
1446 }
1447 }
1448
1449 struct detach_ctx {
1450 struct cxl_memdev *cxlmd;
1451 int depth;
1452 };
1453
port_has_memdev(struct device * dev,const void * data)1454 static int port_has_memdev(struct device *dev, const void *data)
1455 {
1456 const struct detach_ctx *ctx = data;
1457 struct cxl_port *port;
1458
1459 if (!is_cxl_port(dev))
1460 return 0;
1461
1462 port = to_cxl_port(dev);
1463 if (port->depth != ctx->depth)
1464 return 0;
1465
1466 return !!cxl_ep_load(port, ctx->cxlmd);
1467 }
1468
cxl_detach_ep(void * data)1469 static void cxl_detach_ep(void *data)
1470 {
1471 struct cxl_memdev *cxlmd = data;
1472
1473 for (int i = cxlmd->depth - 1; i >= 1; i--) {
1474 struct cxl_port *port, *parent_port;
1475 struct detach_ctx ctx = {
1476 .cxlmd = cxlmd,
1477 .depth = i,
1478 };
1479 struct cxl_ep *ep;
1480 bool died = false;
1481
1482 struct device *dev __free(put_device) =
1483 bus_find_device(&cxl_bus_type, NULL, &ctx, port_has_memdev);
1484 if (!dev)
1485 continue;
1486 port = to_cxl_port(dev);
1487
1488 parent_port = to_cxl_port(port->dev.parent);
1489 device_lock(&parent_port->dev);
1490 device_lock(&port->dev);
1491 ep = cxl_ep_load(port, cxlmd);
1492 dev_dbg(&cxlmd->dev, "disconnect %s from %s\n",
1493 ep ? dev_name(ep->ep) : "", dev_name(&port->dev));
1494 cxl_ep_remove(port, ep);
1495 if (ep && !port->dead && xa_empty(&port->endpoints) &&
1496 !is_cxl_root(parent_port) && parent_port->dev.driver) {
1497 /*
1498 * This was the last ep attached to a dynamically
1499 * enumerated port. Block new cxl_add_ep() and garbage
1500 * collect the port.
1501 */
1502 died = true;
1503 port->dead = true;
1504 reap_dports(port);
1505 }
1506 device_unlock(&port->dev);
1507
1508 if (died) {
1509 dev_dbg(&cxlmd->dev, "delete %s\n",
1510 dev_name(&port->dev));
1511 delete_switch_port(port);
1512 }
1513 device_unlock(&parent_port->dev);
1514 }
1515 }
1516
find_component_registers(struct device * dev)1517 static resource_size_t find_component_registers(struct device *dev)
1518 {
1519 struct cxl_register_map map;
1520 struct pci_dev *pdev;
1521
1522 /*
1523 * Theoretically, CXL component registers can be hosted on a
1524 * non-PCI device, in practice, only cxl_test hits this case.
1525 */
1526 if (!dev_is_pci(dev))
1527 return CXL_RESOURCE_NONE;
1528
1529 pdev = to_pci_dev(dev);
1530
1531 cxl_find_regblock(pdev, CXL_REGLOC_RBI_COMPONENT, &map);
1532 return map.resource;
1533 }
1534
add_port_attach_ep(struct cxl_memdev * cxlmd,struct device * uport_dev,struct device * dport_dev)1535 static int add_port_attach_ep(struct cxl_memdev *cxlmd,
1536 struct device *uport_dev,
1537 struct device *dport_dev)
1538 {
1539 struct device *dparent = grandparent(dport_dev);
1540 struct cxl_dport *dport, *parent_dport;
1541 resource_size_t component_reg_phys;
1542 int rc;
1543
1544 if (!dparent) {
1545 /*
1546 * The iteration reached the topology root without finding the
1547 * CXL-root 'cxl_port' on a previous iteration, fail for now to
1548 * be re-probed after platform driver attaches.
1549 */
1550 dev_dbg(&cxlmd->dev, "%s is a root dport\n",
1551 dev_name(dport_dev));
1552 return -ENXIO;
1553 }
1554
1555 struct cxl_port *parent_port __free(put_cxl_port) =
1556 find_cxl_port(dparent, &parent_dport);
1557 if (!parent_port) {
1558 /* iterate to create this parent_port */
1559 return -EAGAIN;
1560 }
1561
1562 /*
1563 * Definition with __free() here to keep the sequence of
1564 * dereferencing the device of the port before the parent_port releasing.
1565 */
1566 struct cxl_port *port __free(put_cxl_port) = NULL;
1567 scoped_guard(device, &parent_port->dev) {
1568 if (!parent_port->dev.driver) {
1569 dev_warn(&cxlmd->dev,
1570 "port %s:%s disabled, failed to enumerate CXL.mem\n",
1571 dev_name(&parent_port->dev), dev_name(uport_dev));
1572 return -ENXIO;
1573 }
1574
1575 port = find_cxl_port_at(parent_port, dport_dev, &dport);
1576 if (!port) {
1577 component_reg_phys = find_component_registers(uport_dev);
1578 port = devm_cxl_add_port(&parent_port->dev, uport_dev,
1579 component_reg_phys, parent_dport);
1580 if (IS_ERR(port))
1581 return PTR_ERR(port);
1582
1583 /* retry find to pick up the new dport information */
1584 port = find_cxl_port_at(parent_port, dport_dev, &dport);
1585 if (!port)
1586 return -ENXIO;
1587 }
1588 }
1589
1590 dev_dbg(&cxlmd->dev, "add to new port %s:%s\n",
1591 dev_name(&port->dev), dev_name(port->uport_dev));
1592 rc = cxl_add_ep(dport, &cxlmd->dev);
1593 if (rc == -EBUSY) {
1594 /*
1595 * "can't" happen, but this error code means
1596 * something to the caller, so translate it.
1597 */
1598 rc = -ENXIO;
1599 }
1600
1601 return rc;
1602 }
1603
devm_cxl_enumerate_ports(struct cxl_memdev * cxlmd)1604 int devm_cxl_enumerate_ports(struct cxl_memdev *cxlmd)
1605 {
1606 struct device *dev = &cxlmd->dev;
1607 struct device *iter;
1608 int rc;
1609
1610 /*
1611 * Skip intermediate port enumeration in the RCH case, there
1612 * are no ports in between a host bridge and an endpoint.
1613 */
1614 if (cxlmd->cxlds->rcd)
1615 return 0;
1616
1617 rc = devm_add_action_or_reset(&cxlmd->dev, cxl_detach_ep, cxlmd);
1618 if (rc)
1619 return rc;
1620
1621 /*
1622 * Scan for and add all cxl_ports in this device's ancestry.
1623 * Repeat until no more ports are added. Abort if a port add
1624 * attempt fails.
1625 */
1626 retry:
1627 for (iter = dev; iter; iter = grandparent(iter)) {
1628 struct device *dport_dev = grandparent(iter);
1629 struct device *uport_dev;
1630 struct cxl_dport *dport;
1631
1632 /*
1633 * The terminal "grandparent" in PCI is NULL and @platform_bus
1634 * for platform devices
1635 */
1636 if (!dport_dev || dport_dev == &platform_bus)
1637 return 0;
1638
1639 uport_dev = dport_dev->parent;
1640 if (!uport_dev) {
1641 dev_warn(dev, "at %s no parent for dport: %s\n",
1642 dev_name(iter), dev_name(dport_dev));
1643 return -ENXIO;
1644 }
1645
1646 dev_dbg(dev, "scan: iter: %s dport_dev: %s parent: %s\n",
1647 dev_name(iter), dev_name(dport_dev),
1648 dev_name(uport_dev));
1649 struct cxl_port *port __free(put_cxl_port) =
1650 find_cxl_port(dport_dev, &dport);
1651 if (port) {
1652 dev_dbg(&cxlmd->dev,
1653 "found already registered port %s:%s\n",
1654 dev_name(&port->dev),
1655 dev_name(port->uport_dev));
1656 rc = cxl_add_ep(dport, &cxlmd->dev);
1657
1658 /*
1659 * If the endpoint already exists in the port's list,
1660 * that's ok, it was added on a previous pass.
1661 * Otherwise, retry in add_port_attach_ep() after taking
1662 * the parent_port lock as the current port may be being
1663 * reaped.
1664 */
1665 if (rc && rc != -EBUSY)
1666 return rc;
1667
1668 cxl_gpf_port_setup(dport);
1669
1670 /* Any more ports to add between this one and the root? */
1671 if (!dev_is_cxl_root_child(&port->dev))
1672 continue;
1673
1674 return 0;
1675 }
1676
1677 rc = add_port_attach_ep(cxlmd, uport_dev, dport_dev);
1678 /* port missing, try to add parent */
1679 if (rc == -EAGAIN)
1680 continue;
1681 /* failed to add ep or port */
1682 if (rc)
1683 return rc;
1684 /* port added, new descendants possible, start over */
1685 goto retry;
1686 }
1687
1688 return 0;
1689 }
1690 EXPORT_SYMBOL_NS_GPL(devm_cxl_enumerate_ports, "CXL");
1691
cxl_pci_find_port(struct pci_dev * pdev,struct cxl_dport ** dport)1692 struct cxl_port *cxl_pci_find_port(struct pci_dev *pdev,
1693 struct cxl_dport **dport)
1694 {
1695 return find_cxl_port(pdev->dev.parent, dport);
1696 }
1697 EXPORT_SYMBOL_NS_GPL(cxl_pci_find_port, "CXL");
1698
cxl_mem_find_port(struct cxl_memdev * cxlmd,struct cxl_dport ** dport)1699 struct cxl_port *cxl_mem_find_port(struct cxl_memdev *cxlmd,
1700 struct cxl_dport **dport)
1701 {
1702 return find_cxl_port(grandparent(&cxlmd->dev), dport);
1703 }
1704 EXPORT_SYMBOL_NS_GPL(cxl_mem_find_port, "CXL");
1705
decoder_populate_targets(struct cxl_switch_decoder * cxlsd,struct cxl_port * port,int * target_map)1706 static int decoder_populate_targets(struct cxl_switch_decoder *cxlsd,
1707 struct cxl_port *port, int *target_map)
1708 {
1709 int i;
1710
1711 if (!target_map)
1712 return 0;
1713
1714 device_lock_assert(&port->dev);
1715
1716 if (xa_empty(&port->dports))
1717 return -EINVAL;
1718
1719 guard(rwsem_write)(&cxl_rwsem.region);
1720 for (i = 0; i < cxlsd->cxld.interleave_ways; i++) {
1721 struct cxl_dport *dport = find_dport(port, target_map[i]);
1722
1723 if (!dport)
1724 return -ENXIO;
1725 cxlsd->target[i] = dport;
1726 }
1727
1728 return 0;
1729 }
1730
1731 static struct lock_class_key cxl_decoder_key;
1732
1733 /**
1734 * cxl_decoder_init - Common decoder setup / initialization
1735 * @port: owning port of this decoder
1736 * @cxld: common decoder properties to initialize
1737 *
1738 * A port may contain one or more decoders. Each of those decoders
1739 * enable some address space for CXL.mem utilization. A decoder is
1740 * expected to be configured by the caller before registering via
1741 * cxl_decoder_add()
1742 */
cxl_decoder_init(struct cxl_port * port,struct cxl_decoder * cxld)1743 static int cxl_decoder_init(struct cxl_port *port, struct cxl_decoder *cxld)
1744 {
1745 struct device *dev;
1746 int rc;
1747
1748 rc = ida_alloc(&port->decoder_ida, GFP_KERNEL);
1749 if (rc < 0)
1750 return rc;
1751
1752 /* need parent to stick around to release the id */
1753 get_device(&port->dev);
1754 cxld->id = rc;
1755
1756 dev = &cxld->dev;
1757 device_initialize(dev);
1758 lockdep_set_class(&dev->mutex, &cxl_decoder_key);
1759 device_set_pm_not_required(dev);
1760 dev->parent = &port->dev;
1761 dev->bus = &cxl_bus_type;
1762
1763 /* Pre initialize an "empty" decoder */
1764 cxld->interleave_ways = 1;
1765 cxld->interleave_granularity = PAGE_SIZE;
1766 cxld->target_type = CXL_DECODER_HOSTONLYMEM;
1767 cxld->hpa_range = (struct range) {
1768 .start = 0,
1769 .end = -1,
1770 };
1771
1772 return 0;
1773 }
1774
cxl_switch_decoder_init(struct cxl_port * port,struct cxl_switch_decoder * cxlsd,int nr_targets)1775 static int cxl_switch_decoder_init(struct cxl_port *port,
1776 struct cxl_switch_decoder *cxlsd,
1777 int nr_targets)
1778 {
1779 if (nr_targets > CXL_DECODER_MAX_INTERLEAVE)
1780 return -EINVAL;
1781
1782 cxlsd->nr_targets = nr_targets;
1783 return cxl_decoder_init(port, &cxlsd->cxld);
1784 }
1785
1786 /**
1787 * cxl_root_decoder_alloc - Allocate a root level decoder
1788 * @port: owning CXL root of this decoder
1789 * @nr_targets: static number of downstream targets
1790 *
1791 * Return: A new cxl decoder to be registered by cxl_decoder_add(). A
1792 * 'CXL root' decoder is one that decodes from a top-level / static platform
1793 * firmware description of CXL resources into a CXL standard decode
1794 * topology.
1795 */
cxl_root_decoder_alloc(struct cxl_port * port,unsigned int nr_targets)1796 struct cxl_root_decoder *cxl_root_decoder_alloc(struct cxl_port *port,
1797 unsigned int nr_targets)
1798 {
1799 struct cxl_root_decoder *cxlrd;
1800 struct cxl_switch_decoder *cxlsd;
1801 struct cxl_decoder *cxld;
1802 int rc;
1803
1804 if (!is_cxl_root(port))
1805 return ERR_PTR(-EINVAL);
1806
1807 cxlrd = kzalloc(struct_size(cxlrd, cxlsd.target, nr_targets),
1808 GFP_KERNEL);
1809 if (!cxlrd)
1810 return ERR_PTR(-ENOMEM);
1811
1812 cxlsd = &cxlrd->cxlsd;
1813 rc = cxl_switch_decoder_init(port, cxlsd, nr_targets);
1814 if (rc) {
1815 kfree(cxlrd);
1816 return ERR_PTR(rc);
1817 }
1818
1819 mutex_init(&cxlrd->range_lock);
1820
1821 cxld = &cxlsd->cxld;
1822 cxld->dev.type = &cxl_decoder_root_type;
1823 /*
1824 * cxl_root_decoder_release() special cases negative ids to
1825 * detect memregion_alloc() failures.
1826 */
1827 atomic_set(&cxlrd->region_id, -1);
1828 rc = memregion_alloc(GFP_KERNEL);
1829 if (rc < 0) {
1830 put_device(&cxld->dev);
1831 return ERR_PTR(rc);
1832 }
1833
1834 atomic_set(&cxlrd->region_id, rc);
1835 cxlrd->qos_class = CXL_QOS_CLASS_INVALID;
1836 return cxlrd;
1837 }
1838 EXPORT_SYMBOL_NS_GPL(cxl_root_decoder_alloc, "CXL");
1839
1840 /**
1841 * cxl_switch_decoder_alloc - Allocate a switch level decoder
1842 * @port: owning CXL switch port of this decoder
1843 * @nr_targets: max number of dynamically addressable downstream targets
1844 *
1845 * Return: A new cxl decoder to be registered by cxl_decoder_add(). A
1846 * 'switch' decoder is any decoder that can be enumerated by PCIe
1847 * topology and the HDM Decoder Capability. This includes the decoders
1848 * that sit between Switch Upstream Ports / Switch Downstream Ports and
1849 * Host Bridges / Root Ports.
1850 */
cxl_switch_decoder_alloc(struct cxl_port * port,unsigned int nr_targets)1851 struct cxl_switch_decoder *cxl_switch_decoder_alloc(struct cxl_port *port,
1852 unsigned int nr_targets)
1853 {
1854 struct cxl_switch_decoder *cxlsd;
1855 struct cxl_decoder *cxld;
1856 int rc;
1857
1858 if (is_cxl_root(port) || is_cxl_endpoint(port))
1859 return ERR_PTR(-EINVAL);
1860
1861 cxlsd = kzalloc(struct_size(cxlsd, target, nr_targets), GFP_KERNEL);
1862 if (!cxlsd)
1863 return ERR_PTR(-ENOMEM);
1864
1865 rc = cxl_switch_decoder_init(port, cxlsd, nr_targets);
1866 if (rc) {
1867 kfree(cxlsd);
1868 return ERR_PTR(rc);
1869 }
1870
1871 cxld = &cxlsd->cxld;
1872 cxld->dev.type = &cxl_decoder_switch_type;
1873 return cxlsd;
1874 }
1875 EXPORT_SYMBOL_NS_GPL(cxl_switch_decoder_alloc, "CXL");
1876
1877 /**
1878 * cxl_endpoint_decoder_alloc - Allocate an endpoint decoder
1879 * @port: owning port of this decoder
1880 *
1881 * Return: A new cxl decoder to be registered by cxl_decoder_add()
1882 */
cxl_endpoint_decoder_alloc(struct cxl_port * port)1883 struct cxl_endpoint_decoder *cxl_endpoint_decoder_alloc(struct cxl_port *port)
1884 {
1885 struct cxl_endpoint_decoder *cxled;
1886 struct cxl_decoder *cxld;
1887 int rc;
1888
1889 if (!is_cxl_endpoint(port))
1890 return ERR_PTR(-EINVAL);
1891
1892 cxled = kzalloc(sizeof(*cxled), GFP_KERNEL);
1893 if (!cxled)
1894 return ERR_PTR(-ENOMEM);
1895
1896 cxled->pos = -1;
1897 cxled->part = -1;
1898 cxld = &cxled->cxld;
1899 rc = cxl_decoder_init(port, cxld);
1900 if (rc) {
1901 kfree(cxled);
1902 return ERR_PTR(rc);
1903 }
1904
1905 cxld->dev.type = &cxl_decoder_endpoint_type;
1906 return cxled;
1907 }
1908 EXPORT_SYMBOL_NS_GPL(cxl_endpoint_decoder_alloc, "CXL");
1909
1910 /**
1911 * cxl_decoder_add_locked - Add a decoder with targets
1912 * @cxld: The cxl decoder allocated by cxl_<type>_decoder_alloc()
1913 * @target_map: A list of downstream ports that this decoder can direct memory
1914 * traffic to. These numbers should correspond with the port number
1915 * in the PCIe Link Capabilities structure.
1916 *
1917 * Certain types of decoders may not have any targets. The main example of this
1918 * is an endpoint device. A more awkward example is a hostbridge whose root
1919 * ports get hot added (technically possible, though unlikely).
1920 *
1921 * This is the locked variant of cxl_decoder_add().
1922 *
1923 * Context: Process context. Expects the device lock of the port that owns the
1924 * @cxld to be held.
1925 *
1926 * Return: Negative error code if the decoder wasn't properly configured; else
1927 * returns 0.
1928 */
cxl_decoder_add_locked(struct cxl_decoder * cxld,int * target_map)1929 int cxl_decoder_add_locked(struct cxl_decoder *cxld, int *target_map)
1930 {
1931 struct cxl_port *port;
1932 struct device *dev;
1933 int rc;
1934
1935 if (WARN_ON_ONCE(!cxld))
1936 return -EINVAL;
1937
1938 if (WARN_ON_ONCE(IS_ERR(cxld)))
1939 return PTR_ERR(cxld);
1940
1941 if (cxld->interleave_ways < 1)
1942 return -EINVAL;
1943
1944 dev = &cxld->dev;
1945
1946 port = to_cxl_port(cxld->dev.parent);
1947 if (!is_endpoint_decoder(dev)) {
1948 struct cxl_switch_decoder *cxlsd = to_cxl_switch_decoder(dev);
1949
1950 rc = decoder_populate_targets(cxlsd, port, target_map);
1951 if (rc && (cxld->flags & CXL_DECODER_F_ENABLE)) {
1952 dev_err(&port->dev,
1953 "Failed to populate active decoder targets\n");
1954 return rc;
1955 }
1956 }
1957
1958 rc = dev_set_name(dev, "decoder%d.%d", port->id, cxld->id);
1959 if (rc)
1960 return rc;
1961
1962 return device_add(dev);
1963 }
1964 EXPORT_SYMBOL_NS_GPL(cxl_decoder_add_locked, "CXL");
1965
1966 /**
1967 * cxl_decoder_add - Add a decoder with targets
1968 * @cxld: The cxl decoder allocated by cxl_<type>_decoder_alloc()
1969 * @target_map: A list of downstream ports that this decoder can direct memory
1970 * traffic to. These numbers should correspond with the port number
1971 * in the PCIe Link Capabilities structure.
1972 *
1973 * This is the unlocked variant of cxl_decoder_add_locked().
1974 * See cxl_decoder_add_locked().
1975 *
1976 * Context: Process context. Takes and releases the device lock of the port that
1977 * owns the @cxld.
1978 */
cxl_decoder_add(struct cxl_decoder * cxld,int * target_map)1979 int cxl_decoder_add(struct cxl_decoder *cxld, int *target_map)
1980 {
1981 struct cxl_port *port;
1982
1983 if (WARN_ON_ONCE(!cxld))
1984 return -EINVAL;
1985
1986 if (WARN_ON_ONCE(IS_ERR(cxld)))
1987 return PTR_ERR(cxld);
1988
1989 port = to_cxl_port(cxld->dev.parent);
1990
1991 guard(device)(&port->dev);
1992 return cxl_decoder_add_locked(cxld, target_map);
1993 }
1994 EXPORT_SYMBOL_NS_GPL(cxl_decoder_add, "CXL");
1995
cxld_unregister(void * dev)1996 static void cxld_unregister(void *dev)
1997 {
1998 if (is_endpoint_decoder(dev))
1999 cxl_decoder_detach(NULL, to_cxl_endpoint_decoder(dev), -1,
2000 DETACH_INVALIDATE);
2001
2002 device_unregister(dev);
2003 }
2004
cxl_decoder_autoremove(struct device * host,struct cxl_decoder * cxld)2005 int cxl_decoder_autoremove(struct device *host, struct cxl_decoder *cxld)
2006 {
2007 return devm_add_action_or_reset(host, cxld_unregister, &cxld->dev);
2008 }
2009 EXPORT_SYMBOL_NS_GPL(cxl_decoder_autoremove, "CXL");
2010
2011 /**
2012 * __cxl_driver_register - register a driver for the cxl bus
2013 * @cxl_drv: cxl driver structure to attach
2014 * @owner: owning module/driver
2015 * @modname: KBUILD_MODNAME for parent driver
2016 */
__cxl_driver_register(struct cxl_driver * cxl_drv,struct module * owner,const char * modname)2017 int __cxl_driver_register(struct cxl_driver *cxl_drv, struct module *owner,
2018 const char *modname)
2019 {
2020 if (!cxl_drv->probe) {
2021 pr_debug("%s ->probe() must be specified\n", modname);
2022 return -EINVAL;
2023 }
2024
2025 if (!cxl_drv->name) {
2026 pr_debug("%s ->name must be specified\n", modname);
2027 return -EINVAL;
2028 }
2029
2030 if (!cxl_drv->id) {
2031 pr_debug("%s ->id must be specified\n", modname);
2032 return -EINVAL;
2033 }
2034
2035 cxl_drv->drv.bus = &cxl_bus_type;
2036 cxl_drv->drv.owner = owner;
2037 cxl_drv->drv.mod_name = modname;
2038 cxl_drv->drv.name = cxl_drv->name;
2039
2040 return driver_register(&cxl_drv->drv);
2041 }
2042 EXPORT_SYMBOL_NS_GPL(__cxl_driver_register, "CXL");
2043
cxl_driver_unregister(struct cxl_driver * cxl_drv)2044 void cxl_driver_unregister(struct cxl_driver *cxl_drv)
2045 {
2046 driver_unregister(&cxl_drv->drv);
2047 }
2048 EXPORT_SYMBOL_NS_GPL(cxl_driver_unregister, "CXL");
2049
cxl_bus_uevent(const struct device * dev,struct kobj_uevent_env * env)2050 static int cxl_bus_uevent(const struct device *dev, struct kobj_uevent_env *env)
2051 {
2052 return add_uevent_var(env, "MODALIAS=" CXL_MODALIAS_FMT,
2053 cxl_device_id(dev));
2054 }
2055
cxl_bus_match(struct device * dev,const struct device_driver * drv)2056 static int cxl_bus_match(struct device *dev, const struct device_driver *drv)
2057 {
2058 return cxl_device_id(dev) == to_cxl_drv(drv)->id;
2059 }
2060
cxl_bus_probe(struct device * dev)2061 static int cxl_bus_probe(struct device *dev)
2062 {
2063 int rc;
2064
2065 rc = to_cxl_drv(dev->driver)->probe(dev);
2066 dev_dbg(dev, "probe: %d\n", rc);
2067 return rc;
2068 }
2069
cxl_bus_remove(struct device * dev)2070 static void cxl_bus_remove(struct device *dev)
2071 {
2072 struct cxl_driver *cxl_drv = to_cxl_drv(dev->driver);
2073
2074 if (cxl_drv->remove)
2075 cxl_drv->remove(dev);
2076 }
2077
2078 static struct workqueue_struct *cxl_bus_wq;
2079
cxl_rescan_attach(struct device * dev,void * data)2080 static int cxl_rescan_attach(struct device *dev, void *data)
2081 {
2082 int rc = device_attach(dev);
2083
2084 dev_vdbg(dev, "rescan: %s\n", rc ? "attach" : "detached");
2085
2086 return 0;
2087 }
2088
cxl_bus_rescan_queue(struct work_struct * w)2089 static void cxl_bus_rescan_queue(struct work_struct *w)
2090 {
2091 bus_for_each_dev(&cxl_bus_type, NULL, NULL, cxl_rescan_attach);
2092 }
2093
cxl_bus_rescan(void)2094 void cxl_bus_rescan(void)
2095 {
2096 static DECLARE_WORK(rescan_work, cxl_bus_rescan_queue);
2097
2098 queue_work(cxl_bus_wq, &rescan_work);
2099 }
2100 EXPORT_SYMBOL_NS_GPL(cxl_bus_rescan, "CXL");
2101
cxl_bus_drain(void)2102 void cxl_bus_drain(void)
2103 {
2104 drain_workqueue(cxl_bus_wq);
2105 }
2106 EXPORT_SYMBOL_NS_GPL(cxl_bus_drain, "CXL");
2107
schedule_cxl_memdev_detach(struct cxl_memdev * cxlmd)2108 bool schedule_cxl_memdev_detach(struct cxl_memdev *cxlmd)
2109 {
2110 return queue_work(cxl_bus_wq, &cxlmd->detach_work);
2111 }
2112 EXPORT_SYMBOL_NS_GPL(schedule_cxl_memdev_detach, "CXL");
2113
add_latency(struct access_coordinate * c,long latency)2114 static void add_latency(struct access_coordinate *c, long latency)
2115 {
2116 for (int i = 0; i < ACCESS_COORDINATE_MAX; i++) {
2117 c[i].write_latency += latency;
2118 c[i].read_latency += latency;
2119 }
2120 }
2121
coordinates_valid(struct access_coordinate * c)2122 static bool coordinates_valid(struct access_coordinate *c)
2123 {
2124 for (int i = 0; i < ACCESS_COORDINATE_MAX; i++) {
2125 if (c[i].read_bandwidth && c[i].write_bandwidth &&
2126 c[i].read_latency && c[i].write_latency)
2127 continue;
2128 return false;
2129 }
2130
2131 return true;
2132 }
2133
set_min_bandwidth(struct access_coordinate * c,unsigned int bw)2134 static void set_min_bandwidth(struct access_coordinate *c, unsigned int bw)
2135 {
2136 for (int i = 0; i < ACCESS_COORDINATE_MAX; i++) {
2137 c[i].write_bandwidth = min(c[i].write_bandwidth, bw);
2138 c[i].read_bandwidth = min(c[i].read_bandwidth, bw);
2139 }
2140 }
2141
set_access_coordinates(struct access_coordinate * out,struct access_coordinate * in)2142 static void set_access_coordinates(struct access_coordinate *out,
2143 struct access_coordinate *in)
2144 {
2145 for (int i = 0; i < ACCESS_COORDINATE_MAX; i++)
2146 out[i] = in[i];
2147 }
2148
parent_port_is_cxl_root(struct cxl_port * port)2149 static bool parent_port_is_cxl_root(struct cxl_port *port)
2150 {
2151 return is_cxl_root(to_cxl_port(port->dev.parent));
2152 }
2153
2154 /**
2155 * cxl_endpoint_get_perf_coordinates - Retrieve performance numbers stored in dports
2156 * of CXL path
2157 * @port: endpoint cxl_port
2158 * @coord: output performance data
2159 *
2160 * Return: errno on failure, 0 on success.
2161 */
cxl_endpoint_get_perf_coordinates(struct cxl_port * port,struct access_coordinate * coord)2162 int cxl_endpoint_get_perf_coordinates(struct cxl_port *port,
2163 struct access_coordinate *coord)
2164 {
2165 struct cxl_memdev *cxlmd = to_cxl_memdev(port->uport_dev);
2166 struct access_coordinate c[] = {
2167 {
2168 .read_bandwidth = UINT_MAX,
2169 .write_bandwidth = UINT_MAX,
2170 },
2171 {
2172 .read_bandwidth = UINT_MAX,
2173 .write_bandwidth = UINT_MAX,
2174 },
2175 };
2176 struct cxl_port *iter = port;
2177 struct cxl_dport *dport;
2178 struct pci_dev *pdev;
2179 struct device *dev;
2180 unsigned int bw;
2181 bool is_cxl_root;
2182
2183 if (!is_cxl_endpoint(port))
2184 return -EINVAL;
2185
2186 /*
2187 * Skip calculation for RCD. Expectation is HMAT already covers RCD case
2188 * since RCH does not support hotplug.
2189 */
2190 if (cxlmd->cxlds->rcd)
2191 return 0;
2192
2193 /*
2194 * Exit the loop when the parent port of the current iter port is cxl
2195 * root. The iterative loop starts at the endpoint and gathers the
2196 * latency of the CXL link from the current device/port to the connected
2197 * downstream port each iteration.
2198 */
2199 do {
2200 dport = iter->parent_dport;
2201 iter = to_cxl_port(iter->dev.parent);
2202 is_cxl_root = parent_port_is_cxl_root(iter);
2203
2204 /*
2205 * There's no valid access_coordinate for a root port since RPs do not
2206 * have CDAT and therefore needs to be skipped.
2207 */
2208 if (!is_cxl_root) {
2209 if (!coordinates_valid(dport->coord))
2210 return -EINVAL;
2211 cxl_coordinates_combine(c, c, dport->coord);
2212 }
2213 add_latency(c, dport->link_latency);
2214 } while (!is_cxl_root);
2215
2216 dport = iter->parent_dport;
2217 /* Retrieve HB coords */
2218 if (!coordinates_valid(dport->coord))
2219 return -EINVAL;
2220 cxl_coordinates_combine(c, c, dport->coord);
2221
2222 dev = port->uport_dev->parent;
2223 if (!dev_is_pci(dev))
2224 return -ENODEV;
2225
2226 /* Get the calculated PCI paths bandwidth */
2227 pdev = to_pci_dev(dev);
2228 bw = pcie_bandwidth_available(pdev, NULL, NULL, NULL);
2229 if (bw == 0)
2230 return -ENXIO;
2231 bw /= BITS_PER_BYTE;
2232
2233 set_min_bandwidth(c, bw);
2234 set_access_coordinates(coord, c);
2235
2236 return 0;
2237 }
2238 EXPORT_SYMBOL_NS_GPL(cxl_endpoint_get_perf_coordinates, "CXL");
2239
cxl_port_get_switch_dport_bandwidth(struct cxl_port * port,struct access_coordinate * c)2240 int cxl_port_get_switch_dport_bandwidth(struct cxl_port *port,
2241 struct access_coordinate *c)
2242 {
2243 struct cxl_dport *dport = port->parent_dport;
2244
2245 /* Check this port is connected to a switch DSP and not an RP */
2246 if (parent_port_is_cxl_root(to_cxl_port(port->dev.parent)))
2247 return -ENODEV;
2248
2249 if (!coordinates_valid(dport->coord))
2250 return -EINVAL;
2251
2252 for (int i = 0; i < ACCESS_COORDINATE_MAX; i++) {
2253 c[i].read_bandwidth = dport->coord[i].read_bandwidth;
2254 c[i].write_bandwidth = dport->coord[i].write_bandwidth;
2255 }
2256
2257 return 0;
2258 }
2259
2260 /* for user tooling to ensure port disable work has completed */
flush_store(const struct bus_type * bus,const char * buf,size_t count)2261 static ssize_t flush_store(const struct bus_type *bus, const char *buf, size_t count)
2262 {
2263 if (sysfs_streq(buf, "1")) {
2264 flush_workqueue(cxl_bus_wq);
2265 return count;
2266 }
2267
2268 return -EINVAL;
2269 }
2270
2271 static BUS_ATTR_WO(flush);
2272
2273 static struct attribute *cxl_bus_attributes[] = {
2274 &bus_attr_flush.attr,
2275 NULL,
2276 };
2277
2278 static struct attribute_group cxl_bus_attribute_group = {
2279 .attrs = cxl_bus_attributes,
2280 };
2281
2282 static const struct attribute_group *cxl_bus_attribute_groups[] = {
2283 &cxl_bus_attribute_group,
2284 NULL,
2285 };
2286
2287 const struct bus_type cxl_bus_type = {
2288 .name = "cxl",
2289 .uevent = cxl_bus_uevent,
2290 .match = cxl_bus_match,
2291 .probe = cxl_bus_probe,
2292 .remove = cxl_bus_remove,
2293 .bus_groups = cxl_bus_attribute_groups,
2294 };
2295 EXPORT_SYMBOL_NS_GPL(cxl_bus_type, "CXL");
2296
2297 static struct dentry *cxl_debugfs;
2298
cxl_debugfs_create_dir(const char * dir)2299 struct dentry *cxl_debugfs_create_dir(const char *dir)
2300 {
2301 return debugfs_create_dir(dir, cxl_debugfs);
2302 }
2303 EXPORT_SYMBOL_NS_GPL(cxl_debugfs_create_dir, "CXL");
2304
cxl_core_init(void)2305 static __init int cxl_core_init(void)
2306 {
2307 int rc;
2308
2309 cxl_debugfs = debugfs_create_dir("cxl", NULL);
2310
2311 if (einj_cxl_is_initialized())
2312 debugfs_create_file("einj_types", 0400, cxl_debugfs, NULL,
2313 &einj_cxl_available_error_type_fops);
2314
2315 cxl_mbox_init();
2316
2317 rc = cxl_memdev_init();
2318 if (rc)
2319 return rc;
2320
2321 cxl_bus_wq = alloc_ordered_workqueue("cxl_port", 0);
2322 if (!cxl_bus_wq) {
2323 rc = -ENOMEM;
2324 goto err_wq;
2325 }
2326
2327 rc = bus_register(&cxl_bus_type);
2328 if (rc)
2329 goto err_bus;
2330
2331 rc = cxl_region_init();
2332 if (rc)
2333 goto err_region;
2334
2335 rc = cxl_ras_init();
2336 if (rc)
2337 goto err_ras;
2338
2339 return 0;
2340
2341 err_ras:
2342 cxl_region_exit();
2343 err_region:
2344 bus_unregister(&cxl_bus_type);
2345 err_bus:
2346 destroy_workqueue(cxl_bus_wq);
2347 err_wq:
2348 cxl_memdev_exit();
2349 return rc;
2350 }
2351
cxl_core_exit(void)2352 static void cxl_core_exit(void)
2353 {
2354 cxl_ras_exit();
2355 cxl_region_exit();
2356 bus_unregister(&cxl_bus_type);
2357 destroy_workqueue(cxl_bus_wq);
2358 cxl_memdev_exit();
2359 debugfs_remove_recursive(cxl_debugfs);
2360 }
2361
2362 subsys_initcall(cxl_core_init);
2363 module_exit(cxl_core_exit);
2364 MODULE_DESCRIPTION("CXL: Core Compute Express Link support");
2365 MODULE_LICENSE("GPL v2");
2366 MODULE_IMPORT_NS("CXL");
2367