1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * USB Power Delivery sysfs entries
4 *
5 * Copyright (C) 2022, Intel Corporation
6 * Author: Heikki Krogerus <heikki.krogerus@linux.intel.com>
7 */
8
9 #include <linux/slab.h>
10 #include <linux/usb/pd.h>
11
12 #include "pd.h"
13
14 static DEFINE_IDA(pd_ida);
15
16 static struct class pd_class = {
17 .name = "usb_power_delivery",
18 };
19
20 #define to_pdo(o) container_of(o, struct pdo, dev)
21
22 struct pdo {
23 struct device dev;
24 int object_position;
25 u32 pdo;
26 };
27
pdo_release(struct device * dev)28 static void pdo_release(struct device *dev)
29 {
30 kfree(to_pdo(dev));
31 }
32
33 /* -------------------------------------------------------------------------- */
34 /* Fixed Supply */
35
36 static ssize_t
dual_role_power_show(struct device * dev,struct device_attribute * attr,char * buf)37 dual_role_power_show(struct device *dev, struct device_attribute *attr, char *buf)
38 {
39 return sysfs_emit(buf, "%u\n", !!(to_pdo(dev)->pdo & PDO_FIXED_DUAL_ROLE));
40 }
41 static DEVICE_ATTR_RO(dual_role_power);
42
43 static ssize_t
usb_suspend_supported_show(struct device * dev,struct device_attribute * attr,char * buf)44 usb_suspend_supported_show(struct device *dev, struct device_attribute *attr, char *buf)
45 {
46 return sysfs_emit(buf, "%u\n", !!(to_pdo(dev)->pdo & PDO_FIXED_SUSPEND));
47 }
48 static DEVICE_ATTR_RO(usb_suspend_supported);
49
50 static ssize_t
higher_capability_show(struct device * dev,struct device_attribute * attr,char * buf)51 higher_capability_show(struct device *dev, struct device_attribute *attr, char *buf)
52 {
53 return sysfs_emit(buf, "%u\n", !!(to_pdo(dev)->pdo & PDO_FIXED_HIGHER_CAP));
54 }
55 static DEVICE_ATTR_RO(higher_capability);
56
57 static ssize_t
unconstrained_power_show(struct device * dev,struct device_attribute * attr,char * buf)58 unconstrained_power_show(struct device *dev, struct device_attribute *attr, char *buf)
59 {
60 return sysfs_emit(buf, "%u\n", !!(to_pdo(dev)->pdo & PDO_FIXED_EXTPOWER));
61 }
62 static DEVICE_ATTR_RO(unconstrained_power);
63
64 static ssize_t
usb_communication_capable_show(struct device * dev,struct device_attribute * attr,char * buf)65 usb_communication_capable_show(struct device *dev, struct device_attribute *attr, char *buf)
66 {
67 return sysfs_emit(buf, "%u\n", !!(to_pdo(dev)->pdo & PDO_FIXED_USB_COMM));
68 }
69 static DEVICE_ATTR_RO(usb_communication_capable);
70
71 static ssize_t
dual_role_data_show(struct device * dev,struct device_attribute * attr,char * buf)72 dual_role_data_show(struct device *dev, struct device_attribute *attr, char *buf)
73 {
74 return sysfs_emit(buf, "%u\n", !!(to_pdo(dev)->pdo & PDO_FIXED_DATA_SWAP));
75 }
76 static DEVICE_ATTR_RO(dual_role_data);
77
78 static ssize_t
unchunked_extended_messages_supported_show(struct device * dev,struct device_attribute * attr,char * buf)79 unchunked_extended_messages_supported_show(struct device *dev,
80 struct device_attribute *attr, char *buf)
81 {
82 return sysfs_emit(buf, "%u\n", !!(to_pdo(dev)->pdo & PDO_FIXED_UNCHUNK_EXT));
83 }
84 static DEVICE_ATTR_RO(unchunked_extended_messages_supported);
85
86 static ssize_t
peak_current_show(struct device * dev,struct device_attribute * attr,char * buf)87 peak_current_show(struct device *dev, struct device_attribute *attr, char *buf)
88 {
89 return sysfs_emit(buf, "%u\n", (to_pdo(dev)->pdo >> PDO_FIXED_PEAK_CURR_SHIFT) & 3);
90 }
91 static DEVICE_ATTR_RO(peak_current);
92
93 static ssize_t
fast_role_swap_current_show(struct device * dev,struct device_attribute * attr,char * buf)94 fast_role_swap_current_show(struct device *dev, struct device_attribute *attr, char *buf)
95 {
96 return sysfs_emit(buf, "%u\n", (to_pdo(dev)->pdo >> PDO_FIXED_FRS_CURR_SHIFT) & 3);
97 }
98 static DEVICE_ATTR_RO(fast_role_swap_current);
99
voltage_show(struct device * dev,struct device_attribute * attr,char * buf)100 static ssize_t voltage_show(struct device *dev, struct device_attribute *attr, char *buf)
101 {
102 return sysfs_emit(buf, "%umV\n", pdo_fixed_voltage(to_pdo(dev)->pdo));
103 }
104 static DEVICE_ATTR_RO(voltage);
105
106 /* Shared with Variable supplies, both source and sink */
current_show(struct device * dev,struct device_attribute * attr,char * buf)107 static ssize_t current_show(struct device *dev, struct device_attribute *attr, char *buf)
108 {
109 return sysfs_emit(buf, "%umA\n", pdo_max_current(to_pdo(dev)->pdo));
110 }
111
112 /* Shared with Variable type supplies */
113 static struct device_attribute maximum_current_attr = {
114 .attr = {
115 .name = "maximum_current",
116 .mode = 0444,
117 },
118 .show = current_show,
119 };
120
121 static struct device_attribute operational_current_attr = {
122 .attr = {
123 .name = "operational_current",
124 .mode = 0444,
125 },
126 .show = current_show,
127 };
128
129 static struct attribute *source_fixed_supply_attrs[] = {
130 &dev_attr_dual_role_power.attr,
131 &dev_attr_usb_suspend_supported.attr,
132 &dev_attr_unconstrained_power.attr,
133 &dev_attr_usb_communication_capable.attr,
134 &dev_attr_dual_role_data.attr,
135 &dev_attr_unchunked_extended_messages_supported.attr,
136 &dev_attr_peak_current.attr,
137 &dev_attr_voltage.attr,
138 &maximum_current_attr.attr,
139 NULL
140 };
141
fixed_attr_is_visible(struct kobject * kobj,struct attribute * attr,int n)142 static umode_t fixed_attr_is_visible(struct kobject *kobj, struct attribute *attr, int n)
143 {
144 if (to_pdo(kobj_to_dev(kobj))->object_position &&
145 attr != &dev_attr_peak_current.attr &&
146 attr != &dev_attr_voltage.attr &&
147 attr != &maximum_current_attr.attr &&
148 attr != &operational_current_attr.attr)
149 return 0;
150
151 return attr->mode;
152 }
153
154 static const struct attribute_group source_fixed_supply_group = {
155 .is_visible = fixed_attr_is_visible,
156 .attrs = source_fixed_supply_attrs,
157 };
158 __ATTRIBUTE_GROUPS(source_fixed_supply);
159
160 static const struct device_type source_fixed_supply_type = {
161 .name = "pdo",
162 .release = pdo_release,
163 .groups = source_fixed_supply_groups,
164 };
165
166 static struct attribute *sink_fixed_supply_attrs[] = {
167 &dev_attr_dual_role_power.attr,
168 &dev_attr_higher_capability.attr,
169 &dev_attr_unconstrained_power.attr,
170 &dev_attr_usb_communication_capable.attr,
171 &dev_attr_dual_role_data.attr,
172 &dev_attr_unchunked_extended_messages_supported.attr,
173 &dev_attr_fast_role_swap_current.attr,
174 &dev_attr_voltage.attr,
175 &operational_current_attr.attr,
176 NULL
177 };
178
179 static const struct attribute_group sink_fixed_supply_group = {
180 .is_visible = fixed_attr_is_visible,
181 .attrs = sink_fixed_supply_attrs,
182 };
183 __ATTRIBUTE_GROUPS(sink_fixed_supply);
184
185 static const struct device_type sink_fixed_supply_type = {
186 .name = "pdo",
187 .release = pdo_release,
188 .groups = sink_fixed_supply_groups,
189 };
190
191 /* -------------------------------------------------------------------------- */
192 /* Variable Supply */
193
194 static ssize_t
maximum_voltage_show(struct device * dev,struct device_attribute * attr,char * buf)195 maximum_voltage_show(struct device *dev, struct device_attribute *attr, char *buf)
196 {
197 return sysfs_emit(buf, "%umV\n", pdo_max_voltage(to_pdo(dev)->pdo));
198 }
199 static DEVICE_ATTR_RO(maximum_voltage);
200
201 static ssize_t
minimum_voltage_show(struct device * dev,struct device_attribute * attr,char * buf)202 minimum_voltage_show(struct device *dev, struct device_attribute *attr, char *buf)
203 {
204 return sysfs_emit(buf, "%umV\n", pdo_min_voltage(to_pdo(dev)->pdo));
205 }
206 static DEVICE_ATTR_RO(minimum_voltage);
207
208 static struct attribute *source_variable_supply_attrs[] = {
209 &dev_attr_maximum_voltage.attr,
210 &dev_attr_minimum_voltage.attr,
211 &maximum_current_attr.attr,
212 NULL
213 };
214 ATTRIBUTE_GROUPS(source_variable_supply);
215
216 static const struct device_type source_variable_supply_type = {
217 .name = "pdo",
218 .release = pdo_release,
219 .groups = source_variable_supply_groups,
220 };
221
222 static struct attribute *sink_variable_supply_attrs[] = {
223 &dev_attr_maximum_voltage.attr,
224 &dev_attr_minimum_voltage.attr,
225 &operational_current_attr.attr,
226 NULL
227 };
228 ATTRIBUTE_GROUPS(sink_variable_supply);
229
230 static const struct device_type sink_variable_supply_type = {
231 .name = "pdo",
232 .release = pdo_release,
233 .groups = sink_variable_supply_groups,
234 };
235
236 /* -------------------------------------------------------------------------- */
237 /* Battery */
238
239 static ssize_t
maximum_power_show(struct device * dev,struct device_attribute * attr,char * buf)240 maximum_power_show(struct device *dev, struct device_attribute *attr, char *buf)
241 {
242 return sysfs_emit(buf, "%umW\n", pdo_max_power(to_pdo(dev)->pdo));
243 }
244 static DEVICE_ATTR_RO(maximum_power);
245
246 static ssize_t
operational_power_show(struct device * dev,struct device_attribute * attr,char * buf)247 operational_power_show(struct device *dev, struct device_attribute *attr, char *buf)
248 {
249 return sysfs_emit(buf, "%umW\n", pdo_max_power(to_pdo(dev)->pdo));
250 }
251 static DEVICE_ATTR_RO(operational_power);
252
253 static struct attribute *source_battery_attrs[] = {
254 &dev_attr_maximum_voltage.attr,
255 &dev_attr_minimum_voltage.attr,
256 &dev_attr_maximum_power.attr,
257 NULL
258 };
259 ATTRIBUTE_GROUPS(source_battery);
260
261 static const struct device_type source_battery_type = {
262 .name = "pdo",
263 .release = pdo_release,
264 .groups = source_battery_groups,
265 };
266
267 static struct attribute *sink_battery_attrs[] = {
268 &dev_attr_maximum_voltage.attr,
269 &dev_attr_minimum_voltage.attr,
270 &dev_attr_operational_power.attr,
271 NULL
272 };
273 ATTRIBUTE_GROUPS(sink_battery);
274
275 static const struct device_type sink_battery_type = {
276 .name = "pdo",
277 .release = pdo_release,
278 .groups = sink_battery_groups,
279 };
280
281 /* -------------------------------------------------------------------------- */
282 /* Standard Power Range (SPR) Programmable Power Supply (PPS) */
283
284 static ssize_t
pps_power_limited_show(struct device * dev,struct device_attribute * attr,char * buf)285 pps_power_limited_show(struct device *dev, struct device_attribute *attr, char *buf)
286 {
287 return sysfs_emit(buf, "%u\n", !!(to_pdo(dev)->pdo & BIT(27)));
288 }
289 static DEVICE_ATTR_RO(pps_power_limited);
290
291 static ssize_t
pps_max_voltage_show(struct device * dev,struct device_attribute * attr,char * buf)292 pps_max_voltage_show(struct device *dev, struct device_attribute *attr, char *buf)
293 {
294 return sysfs_emit(buf, "%umV\n", pdo_pps_apdo_max_voltage(to_pdo(dev)->pdo));
295 }
296
297 static ssize_t
pps_min_voltage_show(struct device * dev,struct device_attribute * attr,char * buf)298 pps_min_voltage_show(struct device *dev, struct device_attribute *attr, char *buf)
299 {
300 return sysfs_emit(buf, "%umV\n", pdo_pps_apdo_min_voltage(to_pdo(dev)->pdo));
301 }
302
303 static ssize_t
pps_max_current_show(struct device * dev,struct device_attribute * attr,char * buf)304 pps_max_current_show(struct device *dev, struct device_attribute *attr, char *buf)
305 {
306 return sysfs_emit(buf, "%umA\n", pdo_pps_apdo_max_current(to_pdo(dev)->pdo));
307 }
308
309 static struct device_attribute pps_max_voltage_attr = {
310 .attr = {
311 .name = "maximum_voltage",
312 .mode = 0444,
313 },
314 .show = pps_max_voltage_show,
315 };
316
317 static struct device_attribute pps_min_voltage_attr = {
318 .attr = {
319 .name = "minimum_voltage",
320 .mode = 0444,
321 },
322 .show = pps_min_voltage_show,
323 };
324
325 static struct device_attribute pps_max_current_attr = {
326 .attr = {
327 .name = "maximum_current",
328 .mode = 0444,
329 },
330 .show = pps_max_current_show,
331 };
332
333 static struct attribute *source_pps_attrs[] = {
334 &dev_attr_pps_power_limited.attr,
335 &pps_max_voltage_attr.attr,
336 &pps_min_voltage_attr.attr,
337 &pps_max_current_attr.attr,
338 NULL
339 };
340 ATTRIBUTE_GROUPS(source_pps);
341
342 static const struct device_type source_pps_type = {
343 .name = "pdo",
344 .release = pdo_release,
345 .groups = source_pps_groups,
346 };
347
348 static struct attribute *sink_pps_attrs[] = {
349 &pps_max_voltage_attr.attr,
350 &pps_min_voltage_attr.attr,
351 &pps_max_current_attr.attr,
352 NULL
353 };
354 ATTRIBUTE_GROUPS(sink_pps);
355
356 static const struct device_type sink_pps_type = {
357 .name = "pdo",
358 .release = pdo_release,
359 .groups = sink_pps_groups,
360 };
361
362 /* -------------------------------------------------------------------------- */
363 /* Standard Power Range (SPR) Adjustable Voltage Supply (AVS) */
364
365 static ssize_t
spr_avs_9v_to_15v_max_current_show(struct device * dev,struct device_attribute * attr,char * buf)366 spr_avs_9v_to_15v_max_current_show(struct device *dev,
367 struct device_attribute *attr, char *buf)
368 {
369 return sysfs_emit(buf, "%umA\n",
370 pdo_spr_avs_apdo_9v_to_15v_max_current_ma(to_pdo(dev)->pdo));
371 }
372
373 static ssize_t
spr_avs_15v_to_20v_max_current_show(struct device * dev,struct device_attribute * attr,char * buf)374 spr_avs_15v_to_20v_max_current_show(struct device *dev,
375 struct device_attribute *attr, char *buf)
376 {
377 return sysfs_emit(buf, "%umA\n",
378 pdo_spr_avs_apdo_15v_to_20v_max_current_ma(to_pdo(dev)->pdo));
379 }
380
381 static ssize_t
spr_avs_src_peak_current_show(struct device * dev,struct device_attribute * attr,char * buf)382 spr_avs_src_peak_current_show(struct device *dev,
383 struct device_attribute *attr, char *buf)
384 {
385 return sysfs_emit(buf, "%u\n",
386 pdo_spr_avs_apdo_src_peak_current(to_pdo(dev)->pdo));
387 }
388
389 static struct device_attribute spr_avs_9v_to_15v_max_current_attr = {
390 .attr = {
391 .name = "maximum_current_9V_to_15V",
392 .mode = 0444,
393 },
394 .show = spr_avs_9v_to_15v_max_current_show,
395 };
396
397 static struct device_attribute spr_avs_15v_to_20v_max_current_attr = {
398 .attr = {
399 .name = "maximum_current_15V_to_20V",
400 .mode = 0444,
401 },
402 .show = spr_avs_15v_to_20v_max_current_show,
403 };
404
405 static struct device_attribute spr_avs_src_peak_current_attr = {
406 .attr = {
407 .name = "peak_current",
408 .mode = 0444,
409 },
410 .show = spr_avs_src_peak_current_show,
411 };
412
413 static struct attribute *source_spr_avs_attrs[] = {
414 &spr_avs_9v_to_15v_max_current_attr.attr,
415 &spr_avs_15v_to_20v_max_current_attr.attr,
416 &spr_avs_src_peak_current_attr.attr,
417 NULL
418 };
419 ATTRIBUTE_GROUPS(source_spr_avs);
420
421 static const struct device_type source_spr_avs_type = {
422 .name = "pdo",
423 .release = pdo_release,
424 .groups = source_spr_avs_groups,
425 };
426
427 static struct attribute *sink_spr_avs_attrs[] = {
428 &spr_avs_9v_to_15v_max_current_attr.attr,
429 &spr_avs_15v_to_20v_max_current_attr.attr,
430 NULL
431 };
432 ATTRIBUTE_GROUPS(sink_spr_avs);
433
434 static const struct device_type sink_spr_avs_type = {
435 .name = "pdo",
436 .release = pdo_release,
437 .groups = sink_spr_avs_groups,
438 };
439
440 /* -------------------------------------------------------------------------- */
441
442 static const char * const supply_name[] = {
443 [PDO_TYPE_FIXED] = "fixed_supply",
444 [PDO_TYPE_BATT] = "battery",
445 [PDO_TYPE_VAR] = "variable_supply",
446 };
447
448 static const char * const apdo_supply_name[] = {
449 [APDO_TYPE_PPS] = "programmable_supply",
450 [APDO_TYPE_SPR_AVS] = "spr_adjustable_voltage_supply",
451 };
452
453 static const struct device_type *source_type[] = {
454 [PDO_TYPE_FIXED] = &source_fixed_supply_type,
455 [PDO_TYPE_BATT] = &source_battery_type,
456 [PDO_TYPE_VAR] = &source_variable_supply_type,
457 };
458
459 static const struct device_type *source_apdo_type[] = {
460 [APDO_TYPE_PPS] = &source_pps_type,
461 [APDO_TYPE_SPR_AVS] = &source_spr_avs_type,
462 };
463
464 static const struct device_type *sink_type[] = {
465 [PDO_TYPE_FIXED] = &sink_fixed_supply_type,
466 [PDO_TYPE_BATT] = &sink_battery_type,
467 [PDO_TYPE_VAR] = &sink_variable_supply_type,
468 };
469
470 static const struct device_type *sink_apdo_type[] = {
471 [APDO_TYPE_PPS] = &sink_pps_type,
472 [APDO_TYPE_SPR_AVS] = &sink_spr_avs_type,
473 };
474
475 /* REVISIT: Export when EPR_*_Capabilities need to be supported. */
add_pdo(struct usb_power_delivery_capabilities * cap,u32 pdo,int position)476 static int add_pdo(struct usb_power_delivery_capabilities *cap, u32 pdo, int position)
477 {
478 const struct device_type *type;
479 const char *name;
480 struct pdo *p;
481 int ret;
482
483 p = kzalloc(sizeof(*p), GFP_KERNEL);
484 if (!p)
485 return -ENOMEM;
486
487 p->pdo = pdo;
488 p->object_position = position;
489
490 if (pdo_type(pdo) == PDO_TYPE_APDO) {
491 /*
492 * FIXME: Only PPS, SPR_AVS supported for now!
493 * Skipping others.
494 */
495 if (pdo_apdo_type(pdo) != APDO_TYPE_PPS &&
496 pdo_apdo_type(pdo) != APDO_TYPE_SPR_AVS) {
497 dev_warn(&cap->dev, "Unknown APDO type. PDO 0x%08x\n", pdo);
498 kfree(p);
499 return 0;
500 }
501
502 if (is_source(cap->role))
503 type = source_apdo_type[pdo_apdo_type(pdo)];
504 else
505 type = sink_apdo_type[pdo_apdo_type(pdo)];
506
507 name = apdo_supply_name[pdo_apdo_type(pdo)];
508 } else {
509 if (is_source(cap->role))
510 type = source_type[pdo_type(pdo)];
511 else
512 type = sink_type[pdo_type(pdo)];
513
514 name = supply_name[pdo_type(pdo)];
515 }
516
517 p->dev.parent = &cap->dev;
518 p->dev.type = type;
519 dev_set_name(&p->dev, "%u:%s", position + 1, name);
520
521 ret = device_register(&p->dev);
522 if (ret) {
523 put_device(&p->dev);
524 return ret;
525 }
526
527 return 0;
528 }
529
remove_pdo(struct device * dev,void * data)530 static int remove_pdo(struct device *dev, void *data)
531 {
532 device_unregister(dev);
533 return 0;
534 }
535
536 /* -------------------------------------------------------------------------- */
537
538 static const char * const cap_name[] = {
539 [TYPEC_SINK] = "sink-capabilities",
540 [TYPEC_SOURCE] = "source-capabilities",
541 };
542
pd_capabilities_release(struct device * dev)543 static void pd_capabilities_release(struct device *dev)
544 {
545 kfree(to_usb_power_delivery_capabilities(dev));
546 }
547
548 static const struct device_type pd_capabilities_type = {
549 .name = "capabilities",
550 .release = pd_capabilities_release,
551 };
552
553 /**
554 * usb_power_delivery_register_capabilities - Register a set of capabilities.
555 * @pd: The USB PD instance that the capabilities belong to.
556 * @desc: Description of the Capabilities Message.
557 *
558 * This function registers a Capabilities Message described in @desc. The
559 * capabilities will have their own sub-directory under @pd in sysfs.
560 *
561 * The function returns pointer to struct usb_power_delivery_capabilities, or
562 * ERR_PRT(errno).
563 */
564 struct usb_power_delivery_capabilities *
usb_power_delivery_register_capabilities(struct usb_power_delivery * pd,struct usb_power_delivery_capabilities_desc * desc)565 usb_power_delivery_register_capabilities(struct usb_power_delivery *pd,
566 struct usb_power_delivery_capabilities_desc *desc)
567 {
568 struct usb_power_delivery_capabilities *cap;
569 int ret;
570 int i;
571
572 cap = kzalloc(sizeof(*cap), GFP_KERNEL);
573 if (!cap)
574 return ERR_PTR(-ENOMEM);
575
576 cap->pd = pd;
577 cap->role = desc->role;
578
579 cap->dev.parent = &pd->dev;
580 cap->dev.type = &pd_capabilities_type;
581 dev_set_name(&cap->dev, "%s", cap_name[cap->role]);
582
583 ret = device_register(&cap->dev);
584 if (ret) {
585 put_device(&cap->dev);
586 return ERR_PTR(ret);
587 }
588
589 for (i = 0; i < PDO_MAX_OBJECTS && desc->pdo[i]; i++) {
590 ret = add_pdo(cap, desc->pdo[i], i);
591 if (ret) {
592 usb_power_delivery_unregister_capabilities(cap);
593 return ERR_PTR(ret);
594 }
595 }
596
597 return cap;
598 }
599 EXPORT_SYMBOL_GPL(usb_power_delivery_register_capabilities);
600
601 /**
602 * usb_power_delivery_unregister_capabilities - Unregister a set of capabilities
603 * @cap: The capabilities
604 */
usb_power_delivery_unregister_capabilities(struct usb_power_delivery_capabilities * cap)605 void usb_power_delivery_unregister_capabilities(struct usb_power_delivery_capabilities *cap)
606 {
607 if (!cap)
608 return;
609
610 device_for_each_child(&cap->dev, NULL, remove_pdo);
611 device_unregister(&cap->dev);
612 }
613 EXPORT_SYMBOL_GPL(usb_power_delivery_unregister_capabilities);
614
615 /* -------------------------------------------------------------------------- */
616
revision_show(struct device * dev,struct device_attribute * attr,char * buf)617 static ssize_t revision_show(struct device *dev, struct device_attribute *attr, char *buf)
618 {
619 struct usb_power_delivery *pd = to_usb_power_delivery(dev);
620
621 return sysfs_emit(buf, "%u.%u\n", (pd->revision >> 8) & 0xff, (pd->revision >> 4) & 0xf);
622 }
623 static DEVICE_ATTR_RO(revision);
624
version_show(struct device * dev,struct device_attribute * attr,char * buf)625 static ssize_t version_show(struct device *dev, struct device_attribute *attr, char *buf)
626 {
627 struct usb_power_delivery *pd = to_usb_power_delivery(dev);
628
629 return sysfs_emit(buf, "%u.%u\n", (pd->version >> 8) & 0xff, (pd->version >> 4) & 0xf);
630 }
631 static DEVICE_ATTR_RO(version);
632
633 static struct attribute *pd_attrs[] = {
634 &dev_attr_revision.attr,
635 &dev_attr_version.attr,
636 NULL
637 };
638
pd_attr_is_visible(struct kobject * kobj,struct attribute * attr,int n)639 static umode_t pd_attr_is_visible(struct kobject *kobj, struct attribute *attr, int n)
640 {
641 struct usb_power_delivery *pd = to_usb_power_delivery(kobj_to_dev(kobj));
642
643 if (attr == &dev_attr_version.attr && !pd->version)
644 return 0;
645
646 return attr->mode;
647 }
648
649 static const struct attribute_group pd_group = {
650 .is_visible = pd_attr_is_visible,
651 .attrs = pd_attrs,
652 };
653 __ATTRIBUTE_GROUPS(pd);
654
pd_release(struct device * dev)655 static void pd_release(struct device *dev)
656 {
657 struct usb_power_delivery *pd = to_usb_power_delivery(dev);
658
659 ida_free(&pd_ida, pd->id);
660 kfree(pd);
661 }
662
663 static const struct device_type pd_type = {
664 .name = "usb_power_delivery",
665 .release = pd_release,
666 .groups = pd_groups,
667 };
668
usb_power_delivery_find(const char * name)669 struct usb_power_delivery *usb_power_delivery_find(const char *name)
670 {
671 struct device *dev;
672
673 dev = class_find_device_by_name(&pd_class, name);
674
675 return dev ? to_usb_power_delivery(dev) : NULL;
676 }
677
678 /**
679 * usb_power_delivery_register - Register USB Power Delivery Support.
680 * @parent: Parent device.
681 * @desc: Description of the USB PD contract.
682 *
683 * This routine can be used to register USB Power Delivery capabilities that a
684 * device or devices can support. These capabilities represent all the
685 * capabilities that can be negotiated with a partner, so not only the Power
686 * Capabilities that are negotiated using the USB PD Capabilities Message.
687 *
688 * The USB Power Delivery Support object that this routine generates can be used
689 * as the parent object for all the actual USB Power Delivery Messages and
690 * objects that can be negotiated with the partner.
691 *
692 * Returns handle to struct usb_power_delivery or ERR_PTR.
693 */
694 struct usb_power_delivery *
usb_power_delivery_register(struct device * parent,struct usb_power_delivery_desc * desc)695 usb_power_delivery_register(struct device *parent, struct usb_power_delivery_desc *desc)
696 {
697 struct usb_power_delivery *pd;
698 int ret;
699
700 pd = kzalloc(sizeof(*pd), GFP_KERNEL);
701 if (!pd)
702 return ERR_PTR(-ENOMEM);
703
704 ret = ida_alloc(&pd_ida, GFP_KERNEL);
705 if (ret < 0) {
706 kfree(pd);
707 return ERR_PTR(ret);
708 }
709
710 pd->id = ret;
711 pd->revision = desc->revision;
712 pd->version = desc->version;
713
714 pd->dev.parent = parent;
715 pd->dev.type = &pd_type;
716 pd->dev.class = &pd_class;
717 dev_set_name(&pd->dev, "pd%d", pd->id);
718
719 ret = device_register(&pd->dev);
720 if (ret) {
721 put_device(&pd->dev);
722 return ERR_PTR(ret);
723 }
724
725 return pd;
726 }
727 EXPORT_SYMBOL_GPL(usb_power_delivery_register);
728
729 /**
730 * usb_power_delivery_unregister - Unregister USB Power Delivery Support.
731 * @pd: The USB PD contract.
732 */
usb_power_delivery_unregister(struct usb_power_delivery * pd)733 void usb_power_delivery_unregister(struct usb_power_delivery *pd)
734 {
735 if (IS_ERR_OR_NULL(pd))
736 return;
737
738 device_unregister(&pd->dev);
739 }
740 EXPORT_SYMBOL_GPL(usb_power_delivery_unregister);
741
742 /**
743 * usb_power_delivery_link_device - Link device to its USB PD object.
744 * @pd: The USB PD instance.
745 * @dev: The device.
746 *
747 * This function can be used to create a symlink named "usb_power_delivery" for
748 * @dev that points to @pd.
749 */
usb_power_delivery_link_device(struct usb_power_delivery * pd,struct device * dev)750 int usb_power_delivery_link_device(struct usb_power_delivery *pd, struct device *dev)
751 {
752 int ret;
753
754 if (IS_ERR_OR_NULL(pd) || !dev)
755 return 0;
756
757 ret = sysfs_create_link(&dev->kobj, &pd->dev.kobj, "usb_power_delivery");
758 if (ret)
759 return ret;
760
761 get_device(&pd->dev);
762 get_device(dev);
763
764 return 0;
765 }
766 EXPORT_SYMBOL_GPL(usb_power_delivery_link_device);
767
768 /**
769 * usb_power_delivery_unlink_device - Unlink device from its USB PD object.
770 * @pd: The USB PD instance.
771 * @dev: The device.
772 *
773 * Remove the symlink that was previously created with pd_link_device().
774 */
usb_power_delivery_unlink_device(struct usb_power_delivery * pd,struct device * dev)775 void usb_power_delivery_unlink_device(struct usb_power_delivery *pd, struct device *dev)
776 {
777 if (IS_ERR_OR_NULL(pd) || !dev)
778 return;
779
780 sysfs_remove_link(&dev->kobj, "usb_power_delivery");
781 put_device(&pd->dev);
782 put_device(dev);
783 }
784 EXPORT_SYMBOL_GPL(usb_power_delivery_unlink_device);
785
786 /* -------------------------------------------------------------------------- */
787
usb_power_delivery_init(void)788 int __init usb_power_delivery_init(void)
789 {
790 return class_register(&pd_class);
791 }
792
usb_power_delivery_exit(void)793 void __exit usb_power_delivery_exit(void)
794 {
795 ida_destroy(&pd_ida);
796 class_unregister(&pd_class);
797 }
798