at v6.11-rc4 2561 lines 66 kB view raw
1// SPDX-License-Identifier: GPL-2.0 2/* 3 * USB Type-C Connector Class 4 * 5 * Copyright (C) 2017, Intel Corporation 6 * Author: Heikki Krogerus <heikki.krogerus@linux.intel.com> 7 */ 8 9#include <linux/module.h> 10#include <linux/mutex.h> 11#include <linux/property.h> 12#include <linux/slab.h> 13#include <linux/usb/pd_vdo.h> 14#include <linux/usb/typec_mux.h> 15#include <linux/usb/typec_retimer.h> 16#include <linux/usb.h> 17 18#include "bus.h" 19#include "class.h" 20#include "pd.h" 21 22static DEFINE_IDA(typec_index_ida); 23 24const struct class typec_class = { 25 .name = "typec", 26}; 27 28/* ------------------------------------------------------------------------- */ 29/* Common attributes */ 30 31static const char * const typec_accessory_modes[] = { 32 [TYPEC_ACCESSORY_NONE] = "none", 33 [TYPEC_ACCESSORY_AUDIO] = "analog_audio", 34 [TYPEC_ACCESSORY_DEBUG] = "debug", 35}; 36 37/* Product types defined in USB PD Specification R3.0 V2.0 */ 38static const char * const product_type_ufp[8] = { 39 [IDH_PTYPE_NOT_UFP] = "not_ufp", 40 [IDH_PTYPE_HUB] = "hub", 41 [IDH_PTYPE_PERIPH] = "peripheral", 42 [IDH_PTYPE_PSD] = "psd", 43 [IDH_PTYPE_AMA] = "ama", 44}; 45 46static const char * const product_type_dfp[8] = { 47 [IDH_PTYPE_NOT_DFP] = "not_dfp", 48 [IDH_PTYPE_DFP_HUB] = "hub", 49 [IDH_PTYPE_DFP_HOST] = "host", 50 [IDH_PTYPE_DFP_PB] = "power_brick", 51}; 52 53static const char * const product_type_cable[8] = { 54 [IDH_PTYPE_NOT_CABLE] = "not_cable", 55 [IDH_PTYPE_PCABLE] = "passive", 56 [IDH_PTYPE_ACABLE] = "active", 57 [IDH_PTYPE_VPD] = "vpd", 58}; 59 60static struct usb_pd_identity *get_pd_identity(struct device *dev) 61{ 62 if (is_typec_partner(dev)) { 63 struct typec_partner *partner = to_typec_partner(dev); 64 65 return partner->identity; 66 } else if (is_typec_cable(dev)) { 67 struct typec_cable *cable = to_typec_cable(dev); 68 69 return cable->identity; 70 } 71 return NULL; 72} 73 74static const char *get_pd_product_type(struct device *dev) 75{ 76 struct typec_port *port = to_typec_port(dev->parent); 77 struct usb_pd_identity *id = get_pd_identity(dev); 78 const char *ptype = NULL; 79 80 if (is_typec_partner(dev)) { 81 if (!id) 82 return NULL; 83 84 if (port->data_role == TYPEC_HOST) 85 ptype = product_type_ufp[PD_IDH_PTYPE(id->id_header)]; 86 else 87 ptype = product_type_dfp[PD_IDH_DFP_PTYPE(id->id_header)]; 88 } else if (is_typec_cable(dev)) { 89 if (id) 90 ptype = product_type_cable[PD_IDH_PTYPE(id->id_header)]; 91 else 92 ptype = to_typec_cable(dev)->active ? 93 product_type_cable[IDH_PTYPE_ACABLE] : 94 product_type_cable[IDH_PTYPE_PCABLE]; 95 } 96 97 return ptype; 98} 99 100static ssize_t id_header_show(struct device *dev, struct device_attribute *attr, 101 char *buf) 102{ 103 struct usb_pd_identity *id = get_pd_identity(dev); 104 105 return sprintf(buf, "0x%08x\n", id->id_header); 106} 107static DEVICE_ATTR_RO(id_header); 108 109static ssize_t cert_stat_show(struct device *dev, struct device_attribute *attr, 110 char *buf) 111{ 112 struct usb_pd_identity *id = get_pd_identity(dev); 113 114 return sprintf(buf, "0x%08x\n", id->cert_stat); 115} 116static DEVICE_ATTR_RO(cert_stat); 117 118static ssize_t product_show(struct device *dev, struct device_attribute *attr, 119 char *buf) 120{ 121 struct usb_pd_identity *id = get_pd_identity(dev); 122 123 return sprintf(buf, "0x%08x\n", id->product); 124} 125static DEVICE_ATTR_RO(product); 126 127static ssize_t product_type_vdo1_show(struct device *dev, struct device_attribute *attr, 128 char *buf) 129{ 130 struct usb_pd_identity *id = get_pd_identity(dev); 131 132 return sysfs_emit(buf, "0x%08x\n", id->vdo[0]); 133} 134static DEVICE_ATTR_RO(product_type_vdo1); 135 136static ssize_t product_type_vdo2_show(struct device *dev, struct device_attribute *attr, 137 char *buf) 138{ 139 struct usb_pd_identity *id = get_pd_identity(dev); 140 141 return sysfs_emit(buf, "0x%08x\n", id->vdo[1]); 142} 143static DEVICE_ATTR_RO(product_type_vdo2); 144 145static ssize_t product_type_vdo3_show(struct device *dev, struct device_attribute *attr, 146 char *buf) 147{ 148 struct usb_pd_identity *id = get_pd_identity(dev); 149 150 return sysfs_emit(buf, "0x%08x\n", id->vdo[2]); 151} 152static DEVICE_ATTR_RO(product_type_vdo3); 153 154static struct attribute *usb_pd_id_attrs[] = { 155 &dev_attr_id_header.attr, 156 &dev_attr_cert_stat.attr, 157 &dev_attr_product.attr, 158 &dev_attr_product_type_vdo1.attr, 159 &dev_attr_product_type_vdo2.attr, 160 &dev_attr_product_type_vdo3.attr, 161 NULL 162}; 163 164static const struct attribute_group usb_pd_id_group = { 165 .name = "identity", 166 .attrs = usb_pd_id_attrs, 167}; 168 169static const struct attribute_group *usb_pd_id_groups[] = { 170 &usb_pd_id_group, 171 NULL, 172}; 173 174static void typec_product_type_notify(struct device *dev) 175{ 176 char *envp[2] = { }; 177 const char *ptype; 178 179 ptype = get_pd_product_type(dev); 180 if (!ptype) 181 return; 182 183 sysfs_notify(&dev->kobj, NULL, "type"); 184 185 envp[0] = kasprintf(GFP_KERNEL, "PRODUCT_TYPE=%s", ptype); 186 if (!envp[0]) 187 return; 188 189 kobject_uevent_env(&dev->kobj, KOBJ_CHANGE, envp); 190 kfree(envp[0]); 191} 192 193static void typec_report_identity(struct device *dev) 194{ 195 sysfs_notify(&dev->kobj, "identity", "id_header"); 196 sysfs_notify(&dev->kobj, "identity", "cert_stat"); 197 sysfs_notify(&dev->kobj, "identity", "product"); 198 sysfs_notify(&dev->kobj, "identity", "product_type_vdo1"); 199 sysfs_notify(&dev->kobj, "identity", "product_type_vdo2"); 200 sysfs_notify(&dev->kobj, "identity", "product_type_vdo3"); 201 typec_product_type_notify(dev); 202} 203 204static ssize_t 205type_show(struct device *dev, struct device_attribute *attr, char *buf) 206{ 207 const char *ptype; 208 209 ptype = get_pd_product_type(dev); 210 if (!ptype) 211 return 0; 212 213 return sysfs_emit(buf, "%s\n", ptype); 214} 215static DEVICE_ATTR_RO(type); 216 217static ssize_t usb_power_delivery_revision_show(struct device *dev, 218 struct device_attribute *attr, 219 char *buf); 220static DEVICE_ATTR_RO(usb_power_delivery_revision); 221 222/* ------------------------------------------------------------------------- */ 223/* Alternate Modes */ 224 225static int altmode_match(struct device *dev, void *data) 226{ 227 struct typec_altmode *adev = to_typec_altmode(dev); 228 struct typec_device_id *id = data; 229 230 if (!is_typec_altmode(dev)) 231 return 0; 232 233 return ((adev->svid == id->svid) && (adev->mode == id->mode)); 234} 235 236static void typec_altmode_set_partner(struct altmode *altmode) 237{ 238 struct typec_altmode *adev = &altmode->adev; 239 struct typec_device_id id = { adev->svid, adev->mode, }; 240 struct typec_port *port = typec_altmode2port(adev); 241 struct altmode *partner; 242 struct device *dev; 243 244 dev = device_find_child(&port->dev, &id, altmode_match); 245 if (!dev) 246 return; 247 248 /* Bind the port alt mode to the partner/plug alt mode. */ 249 partner = to_altmode(to_typec_altmode(dev)); 250 altmode->partner = partner; 251 252 /* Bind the partner/plug alt mode to the port alt mode. */ 253 if (is_typec_plug(adev->dev.parent)) { 254 struct typec_plug *plug = to_typec_plug(adev->dev.parent); 255 256 partner->plug[plug->index] = altmode; 257 } else { 258 partner->partner = altmode; 259 } 260} 261 262static void typec_altmode_put_partner(struct altmode *altmode) 263{ 264 struct altmode *partner = altmode->partner; 265 struct typec_altmode *adev; 266 struct typec_altmode *partner_adev; 267 268 if (!partner) 269 return; 270 271 adev = &altmode->adev; 272 partner_adev = &partner->adev; 273 274 if (is_typec_plug(adev->dev.parent)) { 275 struct typec_plug *plug = to_typec_plug(adev->dev.parent); 276 277 partner->plug[plug->index] = NULL; 278 } else { 279 partner->partner = NULL; 280 } 281 put_device(&partner_adev->dev); 282} 283 284/** 285 * typec_altmode_update_active - Report Enter/Exit mode 286 * @adev: Handle to the alternate mode 287 * @active: True when the mode has been entered 288 * 289 * If a partner or cable plug executes Enter/Exit Mode command successfully, the 290 * drivers use this routine to report the updated state of the mode. 291 */ 292void typec_altmode_update_active(struct typec_altmode *adev, bool active) 293{ 294 char dir[6]; 295 296 if (adev->active == active) 297 return; 298 299 if (!is_typec_port(adev->dev.parent) && adev->dev.driver) { 300 if (!active) 301 module_put(adev->dev.driver->owner); 302 else 303 WARN_ON(!try_module_get(adev->dev.driver->owner)); 304 } 305 306 adev->active = active; 307 snprintf(dir, sizeof(dir), "mode%d", adev->mode); 308 sysfs_notify(&adev->dev.kobj, dir, "active"); 309 sysfs_notify(&adev->dev.kobj, NULL, "active"); 310 kobject_uevent(&adev->dev.kobj, KOBJ_CHANGE); 311} 312EXPORT_SYMBOL_GPL(typec_altmode_update_active); 313 314/** 315 * typec_altmode2port - Alternate Mode to USB Type-C port 316 * @alt: The Alternate Mode 317 * 318 * Returns handle to the port that a cable plug or partner with @alt is 319 * connected to. 320 */ 321struct typec_port *typec_altmode2port(struct typec_altmode *alt) 322{ 323 if (is_typec_plug(alt->dev.parent)) 324 return to_typec_port(alt->dev.parent->parent->parent); 325 if (is_typec_partner(alt->dev.parent)) 326 return to_typec_port(alt->dev.parent->parent); 327 if (is_typec_port(alt->dev.parent)) 328 return to_typec_port(alt->dev.parent); 329 330 return NULL; 331} 332EXPORT_SYMBOL_GPL(typec_altmode2port); 333 334static ssize_t 335vdo_show(struct device *dev, struct device_attribute *attr, char *buf) 336{ 337 struct typec_altmode *alt = to_typec_altmode(dev); 338 339 return sprintf(buf, "0x%08x\n", alt->vdo); 340} 341static DEVICE_ATTR_RO(vdo); 342 343static ssize_t 344description_show(struct device *dev, struct device_attribute *attr, char *buf) 345{ 346 struct typec_altmode *alt = to_typec_altmode(dev); 347 348 return sprintf(buf, "%s\n", alt->desc ? alt->desc : ""); 349} 350static DEVICE_ATTR_RO(description); 351 352static ssize_t 353active_show(struct device *dev, struct device_attribute *attr, char *buf) 354{ 355 struct typec_altmode *alt = to_typec_altmode(dev); 356 357 return sprintf(buf, "%s\n", alt->active ? "yes" : "no"); 358} 359 360static ssize_t active_store(struct device *dev, struct device_attribute *attr, 361 const char *buf, size_t size) 362{ 363 struct typec_altmode *adev = to_typec_altmode(dev); 364 struct altmode *altmode = to_altmode(adev); 365 bool enter; 366 int ret; 367 368 ret = kstrtobool(buf, &enter); 369 if (ret) 370 return ret; 371 372 if (adev->active == enter) 373 return size; 374 375 if (is_typec_port(adev->dev.parent)) { 376 typec_altmode_update_active(adev, enter); 377 378 /* Make sure that the partner exits the mode before disabling */ 379 if (altmode->partner && !enter && altmode->partner->adev.active) 380 typec_altmode_exit(&altmode->partner->adev); 381 } else if (altmode->partner) { 382 if (enter && !altmode->partner->adev.active) { 383 dev_warn(dev, "port has the mode disabled\n"); 384 return -EPERM; 385 } 386 } 387 388 /* Note: If there is no driver, the mode will not be entered */ 389 if (adev->ops && adev->ops->activate) { 390 ret = adev->ops->activate(adev, enter); 391 if (ret) 392 return ret; 393 } 394 395 return size; 396} 397static DEVICE_ATTR_RW(active); 398 399static ssize_t 400supported_roles_show(struct device *dev, struct device_attribute *attr, 401 char *buf) 402{ 403 struct altmode *alt = to_altmode(to_typec_altmode(dev)); 404 ssize_t ret; 405 406 switch (alt->roles) { 407 case TYPEC_PORT_SRC: 408 ret = sprintf(buf, "source\n"); 409 break; 410 case TYPEC_PORT_SNK: 411 ret = sprintf(buf, "sink\n"); 412 break; 413 case TYPEC_PORT_DRP: 414 default: 415 ret = sprintf(buf, "source sink\n"); 416 break; 417 } 418 return ret; 419} 420static DEVICE_ATTR_RO(supported_roles); 421 422static ssize_t 423mode_show(struct device *dev, struct device_attribute *attr, char *buf) 424{ 425 struct typec_altmode *adev = to_typec_altmode(dev); 426 427 return sprintf(buf, "%u\n", adev->mode); 428} 429static DEVICE_ATTR_RO(mode); 430 431static ssize_t 432svid_show(struct device *dev, struct device_attribute *attr, char *buf) 433{ 434 struct typec_altmode *adev = to_typec_altmode(dev); 435 436 return sprintf(buf, "%04x\n", adev->svid); 437} 438static DEVICE_ATTR_RO(svid); 439 440static struct attribute *typec_altmode_attrs[] = { 441 &dev_attr_active.attr, 442 &dev_attr_mode.attr, 443 &dev_attr_svid.attr, 444 &dev_attr_vdo.attr, 445 NULL 446}; 447 448static umode_t typec_altmode_attr_is_visible(struct kobject *kobj, 449 struct attribute *attr, int n) 450{ 451 struct typec_altmode *adev = to_typec_altmode(kobj_to_dev(kobj)); 452 453 if (attr == &dev_attr_active.attr) 454 if (!adev->ops || !adev->ops->activate) 455 return 0444; 456 457 return attr->mode; 458} 459 460static const struct attribute_group typec_altmode_group = { 461 .is_visible = typec_altmode_attr_is_visible, 462 .attrs = typec_altmode_attrs, 463}; 464 465static const struct attribute_group *typec_altmode_groups[] = { 466 &typec_altmode_group, 467 NULL 468}; 469 470/** 471 * typec_altmode_set_ops - Set ops for altmode 472 * @adev: Handle to the alternate mode 473 * @ops: Ops for the alternate mode 474 * 475 * After setting ops, attribute visiblity needs to be refreshed if the alternate 476 * mode can be activated. 477 */ 478void typec_altmode_set_ops(struct typec_altmode *adev, 479 const struct typec_altmode_ops *ops) 480{ 481 adev->ops = ops; 482 sysfs_update_group(&adev->dev.kobj, &typec_altmode_group); 483} 484EXPORT_SYMBOL_GPL(typec_altmode_set_ops); 485 486static int altmode_id_get(struct device *dev) 487{ 488 struct ida *ids; 489 490 if (is_typec_partner(dev)) 491 ids = &to_typec_partner(dev)->mode_ids; 492 else if (is_typec_plug(dev)) 493 ids = &to_typec_plug(dev)->mode_ids; 494 else 495 ids = &to_typec_port(dev)->mode_ids; 496 497 return ida_alloc(ids, GFP_KERNEL); 498} 499 500static void altmode_id_remove(struct device *dev, int id) 501{ 502 struct ida *ids; 503 504 if (is_typec_partner(dev)) 505 ids = &to_typec_partner(dev)->mode_ids; 506 else if (is_typec_plug(dev)) 507 ids = &to_typec_plug(dev)->mode_ids; 508 else 509 ids = &to_typec_port(dev)->mode_ids; 510 511 ida_free(ids, id); 512} 513 514static void typec_altmode_release(struct device *dev) 515{ 516 struct altmode *alt = to_altmode(to_typec_altmode(dev)); 517 518 if (!is_typec_port(dev->parent)) 519 typec_altmode_put_partner(alt); 520 521 altmode_id_remove(alt->adev.dev.parent, alt->id); 522 kfree(alt); 523} 524 525const struct device_type typec_altmode_dev_type = { 526 .name = "typec_alternate_mode", 527 .groups = typec_altmode_groups, 528 .release = typec_altmode_release, 529}; 530 531static struct typec_altmode * 532typec_register_altmode(struct device *parent, 533 const struct typec_altmode_desc *desc) 534{ 535 unsigned int id = altmode_id_get(parent); 536 bool is_port = is_typec_port(parent); 537 struct altmode *alt; 538 int ret; 539 540 alt = kzalloc(sizeof(*alt), GFP_KERNEL); 541 if (!alt) { 542 altmode_id_remove(parent, id); 543 return ERR_PTR(-ENOMEM); 544 } 545 546 alt->adev.svid = desc->svid; 547 alt->adev.mode = desc->mode; 548 alt->adev.vdo = desc->vdo; 549 alt->roles = desc->roles; 550 alt->id = id; 551 552 alt->attrs[0] = &dev_attr_vdo.attr; 553 alt->attrs[1] = &dev_attr_description.attr; 554 alt->attrs[2] = &dev_attr_active.attr; 555 556 if (is_port) { 557 alt->attrs[3] = &dev_attr_supported_roles.attr; 558 alt->adev.active = true; /* Enabled by default */ 559 } 560 561 sprintf(alt->group_name, "mode%d", desc->mode); 562 alt->group.name = alt->group_name; 563 alt->group.attrs = alt->attrs; 564 alt->groups[0] = &alt->group; 565 566 alt->adev.dev.parent = parent; 567 alt->adev.dev.groups = alt->groups; 568 alt->adev.dev.type = &typec_altmode_dev_type; 569 dev_set_name(&alt->adev.dev, "%s.%u", dev_name(parent), id); 570 571 /* Link partners and plugs with the ports */ 572 if (!is_port) 573 typec_altmode_set_partner(alt); 574 575 /* The partners are bind to drivers */ 576 if (is_typec_partner(parent)) 577 alt->adev.dev.bus = &typec_bus; 578 579 /* Plug alt modes need a class to generate udev events. */ 580 if (is_typec_plug(parent)) 581 alt->adev.dev.class = &typec_class; 582 583 ret = device_register(&alt->adev.dev); 584 if (ret) { 585 dev_err(parent, "failed to register alternate mode (%d)\n", 586 ret); 587 put_device(&alt->adev.dev); 588 return ERR_PTR(ret); 589 } 590 591 return &alt->adev; 592} 593 594/** 595 * typec_unregister_altmode - Unregister Alternate Mode 596 * @adev: The alternate mode to be unregistered 597 * 598 * Unregister device created with typec_partner_register_altmode(), 599 * typec_plug_register_altmode() or typec_port_register_altmode(). 600 */ 601void typec_unregister_altmode(struct typec_altmode *adev) 602{ 603 if (IS_ERR_OR_NULL(adev)) 604 return; 605 typec_retimer_put(to_altmode(adev)->retimer); 606 typec_mux_put(to_altmode(adev)->mux); 607 device_unregister(&adev->dev); 608} 609EXPORT_SYMBOL_GPL(typec_unregister_altmode); 610 611/* ------------------------------------------------------------------------- */ 612/* Type-C Partners */ 613 614static ssize_t accessory_mode_show(struct device *dev, 615 struct device_attribute *attr, 616 char *buf) 617{ 618 struct typec_partner *p = to_typec_partner(dev); 619 620 return sprintf(buf, "%s\n", typec_accessory_modes[p->accessory]); 621} 622static DEVICE_ATTR_RO(accessory_mode); 623 624static ssize_t supports_usb_power_delivery_show(struct device *dev, 625 struct device_attribute *attr, 626 char *buf) 627{ 628 struct typec_partner *p = to_typec_partner(dev); 629 630 return sprintf(buf, "%s\n", p->usb_pd ? "yes" : "no"); 631} 632static DEVICE_ATTR_RO(supports_usb_power_delivery); 633 634static ssize_t number_of_alternate_modes_show(struct device *dev, struct device_attribute *attr, 635 char *buf) 636{ 637 struct typec_partner *partner; 638 struct typec_plug *plug; 639 int num_altmodes; 640 641 if (is_typec_partner(dev)) { 642 partner = to_typec_partner(dev); 643 num_altmodes = partner->num_altmodes; 644 } else if (is_typec_plug(dev)) { 645 plug = to_typec_plug(dev); 646 num_altmodes = plug->num_altmodes; 647 } else { 648 return 0; 649 } 650 651 return sysfs_emit(buf, "%d\n", num_altmodes); 652} 653static DEVICE_ATTR_RO(number_of_alternate_modes); 654 655static struct attribute *typec_partner_attrs[] = { 656 &dev_attr_accessory_mode.attr, 657 &dev_attr_supports_usb_power_delivery.attr, 658 &dev_attr_number_of_alternate_modes.attr, 659 &dev_attr_type.attr, 660 &dev_attr_usb_power_delivery_revision.attr, 661 NULL 662}; 663 664static umode_t typec_partner_attr_is_visible(struct kobject *kobj, struct attribute *attr, int n) 665{ 666 struct typec_partner *partner = to_typec_partner(kobj_to_dev(kobj)); 667 668 if (attr == &dev_attr_number_of_alternate_modes.attr) { 669 if (partner->num_altmodes < 0) 670 return 0; 671 } 672 673 if (attr == &dev_attr_type.attr) 674 if (!get_pd_product_type(kobj_to_dev(kobj))) 675 return 0; 676 677 return attr->mode; 678} 679 680static const struct attribute_group typec_partner_group = { 681 .is_visible = typec_partner_attr_is_visible, 682 .attrs = typec_partner_attrs 683}; 684 685static const struct attribute_group *typec_partner_groups[] = { 686 &typec_partner_group, 687 NULL 688}; 689 690static void typec_partner_release(struct device *dev) 691{ 692 struct typec_partner *partner = to_typec_partner(dev); 693 694 ida_destroy(&partner->mode_ids); 695 kfree(partner); 696} 697 698const struct device_type typec_partner_dev_type = { 699 .name = "typec_partner", 700 .groups = typec_partner_groups, 701 .release = typec_partner_release, 702}; 703 704static void typec_partner_link_device(struct typec_partner *partner, struct device *dev) 705{ 706 int ret; 707 708 ret = sysfs_create_link(&dev->kobj, &partner->dev.kobj, "typec"); 709 if (ret) 710 return; 711 712 ret = sysfs_create_link(&partner->dev.kobj, &dev->kobj, dev_name(dev)); 713 if (ret) { 714 sysfs_remove_link(&dev->kobj, "typec"); 715 return; 716 } 717 718 if (partner->attach) 719 partner->attach(partner, dev); 720} 721 722static void typec_partner_unlink_device(struct typec_partner *partner, struct device *dev) 723{ 724 sysfs_remove_link(&partner->dev.kobj, dev_name(dev)); 725 sysfs_remove_link(&dev->kobj, "typec"); 726 727 if (partner->deattach) 728 partner->deattach(partner, dev); 729} 730 731/** 732 * typec_partner_set_identity - Report result from Discover Identity command 733 * @partner: The partner updated identity values 734 * 735 * This routine is used to report that the result of Discover Identity USB power 736 * delivery command has become available. 737 */ 738int typec_partner_set_identity(struct typec_partner *partner) 739{ 740 if (!partner->identity) 741 return -EINVAL; 742 743 typec_report_identity(&partner->dev); 744 return 0; 745} 746EXPORT_SYMBOL_GPL(typec_partner_set_identity); 747 748/** 749 * typec_partner_set_pd_revision - Set the PD revision supported by the partner 750 * @partner: The partner to be updated. 751 * @pd_revision: USB Power Delivery Specification Revision supported by partner 752 * 753 * This routine is used to report that the PD revision of the port partner has 754 * become available. 755 */ 756void typec_partner_set_pd_revision(struct typec_partner *partner, u16 pd_revision) 757{ 758 if (partner->pd_revision == pd_revision) 759 return; 760 761 partner->pd_revision = pd_revision; 762 sysfs_notify(&partner->dev.kobj, NULL, "usb_power_delivery_revision"); 763 if (pd_revision != 0 && !partner->usb_pd) { 764 partner->usb_pd = 1; 765 sysfs_notify(&partner->dev.kobj, NULL, 766 "supports_usb_power_delivery"); 767 } 768 kobject_uevent(&partner->dev.kobj, KOBJ_CHANGE); 769} 770EXPORT_SYMBOL_GPL(typec_partner_set_pd_revision); 771 772/** 773 * typec_partner_set_usb_power_delivery - Declare USB Power Delivery Contract. 774 * @partner: The partner device. 775 * @pd: The USB PD instance. 776 * 777 * This routine can be used to declare USB Power Delivery Contract with @partner 778 * by linking @partner to @pd which contains the objects that were used during the 779 * negotiation of the contract. 780 * 781 * If @pd is NULL, the link is removed and the contract with @partner has ended. 782 */ 783int typec_partner_set_usb_power_delivery(struct typec_partner *partner, 784 struct usb_power_delivery *pd) 785{ 786 int ret; 787 788 if (IS_ERR_OR_NULL(partner) || partner->pd == pd) 789 return 0; 790 791 if (pd) { 792 ret = usb_power_delivery_link_device(pd, &partner->dev); 793 if (ret) 794 return ret; 795 } else { 796 usb_power_delivery_unlink_device(partner->pd, &partner->dev); 797 } 798 799 partner->pd = pd; 800 801 return 0; 802} 803EXPORT_SYMBOL_GPL(typec_partner_set_usb_power_delivery); 804 805/** 806 * typec_partner_set_num_altmodes - Set the number of available partner altmodes 807 * @partner: The partner to be updated. 808 * @num_altmodes: The number of altmodes we want to specify as available. 809 * 810 * This routine is used to report the number of alternate modes supported by the 811 * partner. This value is *not* enforced in alternate mode registration routines. 812 * 813 * @partner.num_altmodes is set to -1 on partner registration, denoting that 814 * a valid value has not been set for it yet. 815 * 816 * Returns 0 on success or negative error number on failure. 817 */ 818int typec_partner_set_num_altmodes(struct typec_partner *partner, int num_altmodes) 819{ 820 int ret; 821 822 if (num_altmodes < 0) 823 return -EINVAL; 824 825 partner->num_altmodes = num_altmodes; 826 ret = sysfs_update_group(&partner->dev.kobj, &typec_partner_group); 827 if (ret < 0) 828 return ret; 829 830 sysfs_notify(&partner->dev.kobj, NULL, "number_of_alternate_modes"); 831 kobject_uevent(&partner->dev.kobj, KOBJ_CHANGE); 832 833 return 0; 834} 835EXPORT_SYMBOL_GPL(typec_partner_set_num_altmodes); 836 837/** 838 * typec_partner_register_altmode - Register USB Type-C Partner Alternate Mode 839 * @partner: USB Type-C Partner that supports the alternate mode 840 * @desc: Description of the alternate mode 841 * 842 * This routine is used to register each alternate mode individually that 843 * @partner has listed in response to Discover SVIDs command. The modes for a 844 * SVID listed in response to Discover Modes command need to be listed in an 845 * array in @desc. 846 * 847 * Returns handle to the alternate mode on success or ERR_PTR on failure. 848 */ 849struct typec_altmode * 850typec_partner_register_altmode(struct typec_partner *partner, 851 const struct typec_altmode_desc *desc) 852{ 853 return typec_register_altmode(&partner->dev, desc); 854} 855EXPORT_SYMBOL_GPL(typec_partner_register_altmode); 856 857/** 858 * typec_partner_set_svdm_version - Set negotiated Structured VDM (SVDM) Version 859 * @partner: USB Type-C Partner that supports SVDM 860 * @svdm_version: Negotiated SVDM Version 861 * 862 * This routine is used to save the negotiated SVDM Version. 863 */ 864void typec_partner_set_svdm_version(struct typec_partner *partner, 865 enum usb_pd_svdm_ver svdm_version) 866{ 867 partner->svdm_version = svdm_version; 868} 869EXPORT_SYMBOL_GPL(typec_partner_set_svdm_version); 870 871/** 872 * typec_partner_usb_power_delivery_register - Register Type-C partner USB Power Delivery Support 873 * @partner: Type-C partner device. 874 * @desc: Description of the USB PD contract. 875 * 876 * This routine is a wrapper around usb_power_delivery_register(). It registers 877 * USB Power Delivery Capabilities for a Type-C partner device. Specifically, 878 * it sets the Type-C partner device as a parent for the resulting USB Power Delivery object. 879 * 880 * Returns handle to struct usb_power_delivery or ERR_PTR. 881 */ 882struct usb_power_delivery * 883typec_partner_usb_power_delivery_register(struct typec_partner *partner, 884 struct usb_power_delivery_desc *desc) 885{ 886 return usb_power_delivery_register(&partner->dev, desc); 887} 888EXPORT_SYMBOL_GPL(typec_partner_usb_power_delivery_register); 889 890/** 891 * typec_register_partner - Register a USB Type-C Partner 892 * @port: The USB Type-C Port the partner is connected to 893 * @desc: Description of the partner 894 * 895 * Registers a device for USB Type-C Partner described in @desc. 896 * 897 * Returns handle to the partner on success or ERR_PTR on failure. 898 */ 899struct typec_partner *typec_register_partner(struct typec_port *port, 900 struct typec_partner_desc *desc) 901{ 902 struct typec_partner *partner; 903 int ret; 904 905 partner = kzalloc(sizeof(*partner), GFP_KERNEL); 906 if (!partner) 907 return ERR_PTR(-ENOMEM); 908 909 ida_init(&partner->mode_ids); 910 partner->usb_pd = desc->usb_pd; 911 partner->accessory = desc->accessory; 912 partner->num_altmodes = -1; 913 partner->pd_revision = desc->pd_revision; 914 partner->svdm_version = port->cap->svdm_version; 915 partner->attach = desc->attach; 916 partner->deattach = desc->deattach; 917 918 if (desc->identity) { 919 /* 920 * Creating directory for the identity only if the driver is 921 * able to provide data to it. 922 */ 923 partner->dev.groups = usb_pd_id_groups; 924 partner->identity = desc->identity; 925 } 926 927 partner->dev.class = &typec_class; 928 partner->dev.parent = &port->dev; 929 partner->dev.type = &typec_partner_dev_type; 930 dev_set_name(&partner->dev, "%s-partner", dev_name(&port->dev)); 931 932 ret = device_register(&partner->dev); 933 if (ret) { 934 dev_err(&port->dev, "failed to register partner (%d)\n", ret); 935 put_device(&partner->dev); 936 return ERR_PTR(ret); 937 } 938 939 if (port->usb2_dev) 940 typec_partner_link_device(partner, port->usb2_dev); 941 if (port->usb3_dev) 942 typec_partner_link_device(partner, port->usb3_dev); 943 944 return partner; 945} 946EXPORT_SYMBOL_GPL(typec_register_partner); 947 948/** 949 * typec_unregister_partner - Unregister a USB Type-C Partner 950 * @partner: The partner to be unregistered 951 * 952 * Unregister device created with typec_register_partner(). 953 */ 954void typec_unregister_partner(struct typec_partner *partner) 955{ 956 struct typec_port *port; 957 958 if (IS_ERR_OR_NULL(partner)) 959 return; 960 961 port = to_typec_port(partner->dev.parent); 962 963 if (port->usb2_dev) 964 typec_partner_unlink_device(partner, port->usb2_dev); 965 if (port->usb3_dev) 966 typec_partner_unlink_device(partner, port->usb3_dev); 967 968 device_unregister(&partner->dev); 969} 970EXPORT_SYMBOL_GPL(typec_unregister_partner); 971 972/* ------------------------------------------------------------------------- */ 973/* Type-C Cable Plugs */ 974 975static void typec_plug_release(struct device *dev) 976{ 977 struct typec_plug *plug = to_typec_plug(dev); 978 979 ida_destroy(&plug->mode_ids); 980 kfree(plug); 981} 982 983static struct attribute *typec_plug_attrs[] = { 984 &dev_attr_number_of_alternate_modes.attr, 985 NULL 986}; 987 988static umode_t typec_plug_attr_is_visible(struct kobject *kobj, struct attribute *attr, int n) 989{ 990 struct typec_plug *plug = to_typec_plug(kobj_to_dev(kobj)); 991 992 if (attr == &dev_attr_number_of_alternate_modes.attr) { 993 if (plug->num_altmodes < 0) 994 return 0; 995 } 996 997 return attr->mode; 998} 999 1000static const struct attribute_group typec_plug_group = { 1001 .is_visible = typec_plug_attr_is_visible, 1002 .attrs = typec_plug_attrs 1003}; 1004 1005static const struct attribute_group *typec_plug_groups[] = { 1006 &typec_plug_group, 1007 NULL 1008}; 1009 1010const struct device_type typec_plug_dev_type = { 1011 .name = "typec_plug", 1012 .groups = typec_plug_groups, 1013 .release = typec_plug_release, 1014}; 1015 1016/** 1017 * typec_plug_set_num_altmodes - Set the number of available plug altmodes 1018 * @plug: The plug to be updated. 1019 * @num_altmodes: The number of altmodes we want to specify as available. 1020 * 1021 * This routine is used to report the number of alternate modes supported by the 1022 * plug. This value is *not* enforced in alternate mode registration routines. 1023 * 1024 * @plug.num_altmodes is set to -1 on plug registration, denoting that 1025 * a valid value has not been set for it yet. 1026 * 1027 * Returns 0 on success or negative error number on failure. 1028 */ 1029int typec_plug_set_num_altmodes(struct typec_plug *plug, int num_altmodes) 1030{ 1031 int ret; 1032 1033 if (num_altmodes < 0) 1034 return -EINVAL; 1035 1036 plug->num_altmodes = num_altmodes; 1037 ret = sysfs_update_group(&plug->dev.kobj, &typec_plug_group); 1038 if (ret < 0) 1039 return ret; 1040 1041 sysfs_notify(&plug->dev.kobj, NULL, "number_of_alternate_modes"); 1042 kobject_uevent(&plug->dev.kobj, KOBJ_CHANGE); 1043 1044 return 0; 1045} 1046EXPORT_SYMBOL_GPL(typec_plug_set_num_altmodes); 1047 1048/** 1049 * typec_plug_register_altmode - Register USB Type-C Cable Plug Alternate Mode 1050 * @plug: USB Type-C Cable Plug that supports the alternate mode 1051 * @desc: Description of the alternate mode 1052 * 1053 * This routine is used to register each alternate mode individually that @plug 1054 * has listed in response to Discover SVIDs command. The modes for a SVID that 1055 * the plug lists in response to Discover Modes command need to be listed in an 1056 * array in @desc. 1057 * 1058 * Returns handle to the alternate mode on success or ERR_PTR on failure. 1059 */ 1060struct typec_altmode * 1061typec_plug_register_altmode(struct typec_plug *plug, 1062 const struct typec_altmode_desc *desc) 1063{ 1064 return typec_register_altmode(&plug->dev, desc); 1065} 1066EXPORT_SYMBOL_GPL(typec_plug_register_altmode); 1067 1068/** 1069 * typec_register_plug - Register a USB Type-C Cable Plug 1070 * @cable: USB Type-C Cable with the plug 1071 * @desc: Description of the cable plug 1072 * 1073 * Registers a device for USB Type-C Cable Plug described in @desc. A USB Type-C 1074 * Cable Plug represents a plug with electronics in it that can response to USB 1075 * Power Delivery SOP Prime or SOP Double Prime packages. 1076 * 1077 * Returns handle to the cable plug on success or ERR_PTR on failure. 1078 */ 1079struct typec_plug *typec_register_plug(struct typec_cable *cable, 1080 struct typec_plug_desc *desc) 1081{ 1082 struct typec_plug *plug; 1083 char name[8]; 1084 int ret; 1085 1086 plug = kzalloc(sizeof(*plug), GFP_KERNEL); 1087 if (!plug) 1088 return ERR_PTR(-ENOMEM); 1089 1090 sprintf(name, "plug%d", desc->index); 1091 1092 ida_init(&plug->mode_ids); 1093 plug->num_altmodes = -1; 1094 plug->index = desc->index; 1095 plug->dev.class = &typec_class; 1096 plug->dev.parent = &cable->dev; 1097 plug->dev.type = &typec_plug_dev_type; 1098 dev_set_name(&plug->dev, "%s-%s", dev_name(cable->dev.parent), name); 1099 1100 ret = device_register(&plug->dev); 1101 if (ret) { 1102 dev_err(&cable->dev, "failed to register plug (%d)\n", ret); 1103 put_device(&plug->dev); 1104 return ERR_PTR(ret); 1105 } 1106 1107 return plug; 1108} 1109EXPORT_SYMBOL_GPL(typec_register_plug); 1110 1111/** 1112 * typec_unregister_plug - Unregister a USB Type-C Cable Plug 1113 * @plug: The cable plug to be unregistered 1114 * 1115 * Unregister device created with typec_register_plug(). 1116 */ 1117void typec_unregister_plug(struct typec_plug *plug) 1118{ 1119 if (!IS_ERR_OR_NULL(plug)) 1120 device_unregister(&plug->dev); 1121} 1122EXPORT_SYMBOL_GPL(typec_unregister_plug); 1123 1124/* Type-C Cables */ 1125 1126static const char * const typec_plug_types[] = { 1127 [USB_PLUG_NONE] = "unknown", 1128 [USB_PLUG_TYPE_A] = "type-a", 1129 [USB_PLUG_TYPE_B] = "type-b", 1130 [USB_PLUG_TYPE_C] = "type-c", 1131 [USB_PLUG_CAPTIVE] = "captive", 1132}; 1133 1134static ssize_t plug_type_show(struct device *dev, 1135 struct device_attribute *attr, char *buf) 1136{ 1137 struct typec_cable *cable = to_typec_cable(dev); 1138 1139 return sprintf(buf, "%s\n", typec_plug_types[cable->type]); 1140} 1141static DEVICE_ATTR_RO(plug_type); 1142 1143static struct attribute *typec_cable_attrs[] = { 1144 &dev_attr_type.attr, 1145 &dev_attr_plug_type.attr, 1146 &dev_attr_usb_power_delivery_revision.attr, 1147 NULL 1148}; 1149ATTRIBUTE_GROUPS(typec_cable); 1150 1151static void typec_cable_release(struct device *dev) 1152{ 1153 struct typec_cable *cable = to_typec_cable(dev); 1154 1155 kfree(cable); 1156} 1157 1158const struct device_type typec_cable_dev_type = { 1159 .name = "typec_cable", 1160 .groups = typec_cable_groups, 1161 .release = typec_cable_release, 1162}; 1163 1164static int cable_match(struct device *dev, void *data) 1165{ 1166 return is_typec_cable(dev); 1167} 1168 1169/** 1170 * typec_cable_get - Get a reference to the USB Type-C cable 1171 * @port: The USB Type-C Port the cable is connected to 1172 * 1173 * The caller must decrement the reference count with typec_cable_put() after 1174 * use. 1175 */ 1176struct typec_cable *typec_cable_get(struct typec_port *port) 1177{ 1178 struct device *dev; 1179 1180 dev = device_find_child(&port->dev, NULL, cable_match); 1181 if (!dev) 1182 return NULL; 1183 1184 return to_typec_cable(dev); 1185} 1186EXPORT_SYMBOL_GPL(typec_cable_get); 1187 1188/** 1189 * typec_cable_put - Decrement the reference count on USB Type-C cable 1190 * @cable: The USB Type-C cable 1191 */ 1192void typec_cable_put(struct typec_cable *cable) 1193{ 1194 put_device(&cable->dev); 1195} 1196EXPORT_SYMBOL_GPL(typec_cable_put); 1197 1198/** 1199 * typec_cable_is_active - Check is the USB Type-C cable active or passive 1200 * @cable: The USB Type-C Cable 1201 * 1202 * Return 1 if the cable is active or 0 if it's passive. 1203 */ 1204int typec_cable_is_active(struct typec_cable *cable) 1205{ 1206 return cable->active; 1207} 1208EXPORT_SYMBOL_GPL(typec_cable_is_active); 1209 1210/** 1211 * typec_cable_set_identity - Report result from Discover Identity command 1212 * @cable: The cable updated identity values 1213 * 1214 * This routine is used to report that the result of Discover Identity USB power 1215 * delivery command has become available. 1216 */ 1217int typec_cable_set_identity(struct typec_cable *cable) 1218{ 1219 if (!cable->identity) 1220 return -EINVAL; 1221 1222 typec_report_identity(&cable->dev); 1223 return 0; 1224} 1225EXPORT_SYMBOL_GPL(typec_cable_set_identity); 1226 1227/** 1228 * typec_register_cable - Register a USB Type-C Cable 1229 * @port: The USB Type-C Port the cable is connected to 1230 * @desc: Description of the cable 1231 * 1232 * Registers a device for USB Type-C Cable described in @desc. The cable will be 1233 * parent for the optional cable plug devises. 1234 * 1235 * Returns handle to the cable on success or ERR_PTR on failure. 1236 */ 1237struct typec_cable *typec_register_cable(struct typec_port *port, 1238 struct typec_cable_desc *desc) 1239{ 1240 struct typec_cable *cable; 1241 int ret; 1242 1243 cable = kzalloc(sizeof(*cable), GFP_KERNEL); 1244 if (!cable) 1245 return ERR_PTR(-ENOMEM); 1246 1247 cable->type = desc->type; 1248 cable->active = desc->active; 1249 cable->pd_revision = desc->pd_revision; 1250 1251 if (desc->identity) { 1252 /* 1253 * Creating directory for the identity only if the driver is 1254 * able to provide data to it. 1255 */ 1256 cable->dev.groups = usb_pd_id_groups; 1257 cable->identity = desc->identity; 1258 } 1259 1260 cable->dev.class = &typec_class; 1261 cable->dev.parent = &port->dev; 1262 cable->dev.type = &typec_cable_dev_type; 1263 dev_set_name(&cable->dev, "%s-cable", dev_name(&port->dev)); 1264 1265 ret = device_register(&cable->dev); 1266 if (ret) { 1267 dev_err(&port->dev, "failed to register cable (%d)\n", ret); 1268 put_device(&cable->dev); 1269 return ERR_PTR(ret); 1270 } 1271 1272 return cable; 1273} 1274EXPORT_SYMBOL_GPL(typec_register_cable); 1275 1276/** 1277 * typec_unregister_cable - Unregister a USB Type-C Cable 1278 * @cable: The cable to be unregistered 1279 * 1280 * Unregister device created with typec_register_cable(). 1281 */ 1282void typec_unregister_cable(struct typec_cable *cable) 1283{ 1284 if (!IS_ERR_OR_NULL(cable)) 1285 device_unregister(&cable->dev); 1286} 1287EXPORT_SYMBOL_GPL(typec_unregister_cable); 1288 1289/* ------------------------------------------------------------------------- */ 1290/* USB Type-C ports */ 1291 1292/** 1293 * typec_port_set_usb_power_delivery - Assign USB PD for port. 1294 * @port: USB Type-C port. 1295 * @pd: USB PD instance. 1296 * 1297 * This routine can be used to set the USB Power Delivery Capabilities for @port 1298 * that it will advertise to the partner. 1299 * 1300 * If @pd is NULL, the assignment is removed. 1301 */ 1302int typec_port_set_usb_power_delivery(struct typec_port *port, struct usb_power_delivery *pd) 1303{ 1304 int ret; 1305 1306 if (IS_ERR_OR_NULL(port) || port->pd == pd) 1307 return 0; 1308 1309 if (pd) { 1310 ret = usb_power_delivery_link_device(pd, &port->dev); 1311 if (ret) 1312 return ret; 1313 } else { 1314 usb_power_delivery_unlink_device(port->pd, &port->dev); 1315 } 1316 1317 port->pd = pd; 1318 1319 return 0; 1320} 1321EXPORT_SYMBOL_GPL(typec_port_set_usb_power_delivery); 1322 1323static ssize_t select_usb_power_delivery_store(struct device *dev, 1324 struct device_attribute *attr, 1325 const char *buf, size_t size) 1326{ 1327 struct typec_port *port = to_typec_port(dev); 1328 struct usb_power_delivery *pd; 1329 int ret; 1330 1331 if (!port->ops || !port->ops->pd_set) 1332 return -EOPNOTSUPP; 1333 1334 pd = usb_power_delivery_find(buf); 1335 if (!pd) 1336 return -EINVAL; 1337 1338 ret = port->ops->pd_set(port, pd); 1339 if (ret) 1340 return ret; 1341 1342 return size; 1343} 1344 1345static ssize_t select_usb_power_delivery_show(struct device *dev, 1346 struct device_attribute *attr, char *buf) 1347{ 1348 struct typec_port *port = to_typec_port(dev); 1349 struct usb_power_delivery **pds; 1350 int i, ret = 0; 1351 1352 if (!port->ops || !port->ops->pd_get) 1353 return -EOPNOTSUPP; 1354 1355 pds = port->ops->pd_get(port); 1356 if (!pds) 1357 return 0; 1358 1359 for (i = 0; pds[i]; i++) { 1360 if (pds[i] == port->pd) 1361 ret += sysfs_emit_at(buf, ret, "[%s] ", dev_name(&pds[i]->dev)); 1362 else 1363 ret += sysfs_emit_at(buf, ret, "%s ", dev_name(&pds[i]->dev)); 1364 } 1365 1366 buf[ret - 1] = '\n'; 1367 1368 return ret; 1369} 1370static DEVICE_ATTR_RW(select_usb_power_delivery); 1371 1372static struct attribute *port_attrs[] = { 1373 &dev_attr_select_usb_power_delivery.attr, 1374 NULL 1375}; 1376 1377static umode_t port_attr_is_visible(struct kobject *kobj, struct attribute *attr, int n) 1378{ 1379 struct typec_port *port = to_typec_port(kobj_to_dev(kobj)); 1380 1381 if (!port->pd || !port->ops || !port->ops->pd_get) 1382 return 0; 1383 if (!port->ops->pd_set) 1384 return 0444; 1385 1386 return attr->mode; 1387} 1388 1389static const struct attribute_group pd_group = { 1390 .is_visible = port_attr_is_visible, 1391 .attrs = port_attrs, 1392}; 1393 1394static const char * const typec_orientations[] = { 1395 [TYPEC_ORIENTATION_NONE] = "unknown", 1396 [TYPEC_ORIENTATION_NORMAL] = "normal", 1397 [TYPEC_ORIENTATION_REVERSE] = "reverse", 1398}; 1399 1400static const char * const typec_roles[] = { 1401 [TYPEC_SINK] = "sink", 1402 [TYPEC_SOURCE] = "source", 1403}; 1404 1405static const char * const typec_data_roles[] = { 1406 [TYPEC_DEVICE] = "device", 1407 [TYPEC_HOST] = "host", 1408}; 1409 1410static const char * const typec_port_power_roles[] = { 1411 [TYPEC_PORT_SRC] = "source", 1412 [TYPEC_PORT_SNK] = "sink", 1413 [TYPEC_PORT_DRP] = "dual", 1414}; 1415 1416static const char * const typec_port_data_roles[] = { 1417 [TYPEC_PORT_DFP] = "host", 1418 [TYPEC_PORT_UFP] = "device", 1419 [TYPEC_PORT_DRD] = "dual", 1420}; 1421 1422static const char * const typec_port_types_drp[] = { 1423 [TYPEC_PORT_SRC] = "dual [source] sink", 1424 [TYPEC_PORT_SNK] = "dual source [sink]", 1425 [TYPEC_PORT_DRP] = "[dual] source sink", 1426}; 1427 1428static ssize_t 1429preferred_role_store(struct device *dev, struct device_attribute *attr, 1430 const char *buf, size_t size) 1431{ 1432 struct typec_port *port = to_typec_port(dev); 1433 int role; 1434 int ret; 1435 1436 if (port->cap->type != TYPEC_PORT_DRP) { 1437 dev_dbg(dev, "Preferred role only supported with DRP ports\n"); 1438 return -EOPNOTSUPP; 1439 } 1440 1441 if (!port->ops || !port->ops->try_role) { 1442 dev_dbg(dev, "Setting preferred role not supported\n"); 1443 return -EOPNOTSUPP; 1444 } 1445 1446 role = sysfs_match_string(typec_roles, buf); 1447 if (role < 0) { 1448 if (sysfs_streq(buf, "none")) 1449 role = TYPEC_NO_PREFERRED_ROLE; 1450 else 1451 return -EINVAL; 1452 } 1453 1454 ret = port->ops->try_role(port, role); 1455 if (ret) 1456 return ret; 1457 1458 port->prefer_role = role; 1459 return size; 1460} 1461 1462static ssize_t 1463preferred_role_show(struct device *dev, struct device_attribute *attr, 1464 char *buf) 1465{ 1466 struct typec_port *port = to_typec_port(dev); 1467 1468 if (port->cap->type != TYPEC_PORT_DRP) 1469 return 0; 1470 1471 if (port->prefer_role < 0) 1472 return 0; 1473 1474 return sprintf(buf, "%s\n", typec_roles[port->prefer_role]); 1475} 1476static DEVICE_ATTR_RW(preferred_role); 1477 1478static ssize_t data_role_store(struct device *dev, 1479 struct device_attribute *attr, 1480 const char *buf, size_t size) 1481{ 1482 struct typec_port *port = to_typec_port(dev); 1483 int ret; 1484 1485 if (!port->ops || !port->ops->dr_set) { 1486 dev_dbg(dev, "data role swapping not supported\n"); 1487 return -EOPNOTSUPP; 1488 } 1489 1490 ret = sysfs_match_string(typec_data_roles, buf); 1491 if (ret < 0) 1492 return ret; 1493 1494 mutex_lock(&port->port_type_lock); 1495 if (port->cap->data != TYPEC_PORT_DRD) { 1496 ret = -EOPNOTSUPP; 1497 goto unlock_and_ret; 1498 } 1499 1500 ret = port->ops->dr_set(port, ret); 1501 if (ret) 1502 goto unlock_and_ret; 1503 1504 ret = size; 1505unlock_and_ret: 1506 mutex_unlock(&port->port_type_lock); 1507 return ret; 1508} 1509 1510static ssize_t data_role_show(struct device *dev, 1511 struct device_attribute *attr, char *buf) 1512{ 1513 struct typec_port *port = to_typec_port(dev); 1514 1515 if (port->cap->data == TYPEC_PORT_DRD) 1516 return sprintf(buf, "%s\n", port->data_role == TYPEC_HOST ? 1517 "[host] device" : "host [device]"); 1518 1519 return sprintf(buf, "[%s]\n", typec_data_roles[port->data_role]); 1520} 1521static DEVICE_ATTR_RW(data_role); 1522 1523static ssize_t power_role_store(struct device *dev, 1524 struct device_attribute *attr, 1525 const char *buf, size_t size) 1526{ 1527 struct typec_port *port = to_typec_port(dev); 1528 int ret; 1529 1530 if (!port->ops || !port->ops->pr_set) { 1531 dev_dbg(dev, "power role swapping not supported\n"); 1532 return -EOPNOTSUPP; 1533 } 1534 1535 if (port->pwr_opmode != TYPEC_PWR_MODE_PD) { 1536 dev_dbg(dev, "partner unable to swap power role\n"); 1537 return -EIO; 1538 } 1539 1540 ret = sysfs_match_string(typec_roles, buf); 1541 if (ret < 0) 1542 return ret; 1543 1544 mutex_lock(&port->port_type_lock); 1545 if (port->port_type != TYPEC_PORT_DRP) { 1546 dev_dbg(dev, "port type fixed at \"%s\"", 1547 typec_port_power_roles[port->port_type]); 1548 ret = -EOPNOTSUPP; 1549 goto unlock_and_ret; 1550 } 1551 1552 ret = port->ops->pr_set(port, ret); 1553 if (ret) 1554 goto unlock_and_ret; 1555 1556 ret = size; 1557unlock_and_ret: 1558 mutex_unlock(&port->port_type_lock); 1559 return ret; 1560} 1561 1562static ssize_t power_role_show(struct device *dev, 1563 struct device_attribute *attr, char *buf) 1564{ 1565 struct typec_port *port = to_typec_port(dev); 1566 1567 if (port->cap->type == TYPEC_PORT_DRP) 1568 return sprintf(buf, "%s\n", port->pwr_role == TYPEC_SOURCE ? 1569 "[source] sink" : "source [sink]"); 1570 1571 return sprintf(buf, "[%s]\n", typec_roles[port->pwr_role]); 1572} 1573static DEVICE_ATTR_RW(power_role); 1574 1575static ssize_t 1576port_type_store(struct device *dev, struct device_attribute *attr, 1577 const char *buf, size_t size) 1578{ 1579 struct typec_port *port = to_typec_port(dev); 1580 int ret; 1581 enum typec_port_type type; 1582 1583 if (port->cap->type != TYPEC_PORT_DRP || 1584 !port->ops || !port->ops->port_type_set) { 1585 dev_dbg(dev, "changing port type not supported\n"); 1586 return -EOPNOTSUPP; 1587 } 1588 1589 ret = sysfs_match_string(typec_port_power_roles, buf); 1590 if (ret < 0) 1591 return ret; 1592 1593 type = ret; 1594 mutex_lock(&port->port_type_lock); 1595 1596 if (port->port_type == type) { 1597 ret = size; 1598 goto unlock_and_ret; 1599 } 1600 1601 ret = port->ops->port_type_set(port, type); 1602 if (ret) 1603 goto unlock_and_ret; 1604 1605 port->port_type = type; 1606 ret = size; 1607 1608unlock_and_ret: 1609 mutex_unlock(&port->port_type_lock); 1610 return ret; 1611} 1612 1613static ssize_t 1614port_type_show(struct device *dev, struct device_attribute *attr, 1615 char *buf) 1616{ 1617 struct typec_port *port = to_typec_port(dev); 1618 1619 if (port->cap->type == TYPEC_PORT_DRP) 1620 return sprintf(buf, "%s\n", 1621 typec_port_types_drp[port->port_type]); 1622 1623 return sprintf(buf, "[%s]\n", typec_port_power_roles[port->cap->type]); 1624} 1625static DEVICE_ATTR_RW(port_type); 1626 1627static const char * const typec_pwr_opmodes[] = { 1628 [TYPEC_PWR_MODE_USB] = "default", 1629 [TYPEC_PWR_MODE_1_5A] = "1.5A", 1630 [TYPEC_PWR_MODE_3_0A] = "3.0A", 1631 [TYPEC_PWR_MODE_PD] = "usb_power_delivery", 1632}; 1633 1634static ssize_t power_operation_mode_show(struct device *dev, 1635 struct device_attribute *attr, 1636 char *buf) 1637{ 1638 struct typec_port *port = to_typec_port(dev); 1639 1640 return sprintf(buf, "%s\n", typec_pwr_opmodes[port->pwr_opmode]); 1641} 1642static DEVICE_ATTR_RO(power_operation_mode); 1643 1644static ssize_t vconn_source_store(struct device *dev, 1645 struct device_attribute *attr, 1646 const char *buf, size_t size) 1647{ 1648 struct typec_port *port = to_typec_port(dev); 1649 bool source; 1650 int ret; 1651 1652 if (!port->cap->pd_revision) { 1653 dev_dbg(dev, "VCONN swap depends on USB Power Delivery\n"); 1654 return -EOPNOTSUPP; 1655 } 1656 1657 if (!port->ops || !port->ops->vconn_set) { 1658 dev_dbg(dev, "VCONN swapping not supported\n"); 1659 return -EOPNOTSUPP; 1660 } 1661 1662 ret = kstrtobool(buf, &source); 1663 if (ret) 1664 return ret; 1665 1666 ret = port->ops->vconn_set(port, (enum typec_role)source); 1667 if (ret) 1668 return ret; 1669 1670 return size; 1671} 1672 1673static ssize_t vconn_source_show(struct device *dev, 1674 struct device_attribute *attr, char *buf) 1675{ 1676 struct typec_port *port = to_typec_port(dev); 1677 1678 return sprintf(buf, "%s\n", 1679 port->vconn_role == TYPEC_SOURCE ? "yes" : "no"); 1680} 1681static DEVICE_ATTR_RW(vconn_source); 1682 1683static ssize_t supported_accessory_modes_show(struct device *dev, 1684 struct device_attribute *attr, 1685 char *buf) 1686{ 1687 struct typec_port *port = to_typec_port(dev); 1688 ssize_t ret = 0; 1689 int i; 1690 1691 for (i = 0; i < ARRAY_SIZE(port->cap->accessory); i++) { 1692 if (port->cap->accessory[i]) 1693 ret += sprintf(buf + ret, "%s ", 1694 typec_accessory_modes[port->cap->accessory[i]]); 1695 } 1696 1697 if (!ret) 1698 return sprintf(buf, "none\n"); 1699 1700 buf[ret - 1] = '\n'; 1701 1702 return ret; 1703} 1704static DEVICE_ATTR_RO(supported_accessory_modes); 1705 1706static ssize_t usb_typec_revision_show(struct device *dev, 1707 struct device_attribute *attr, 1708 char *buf) 1709{ 1710 struct typec_port *port = to_typec_port(dev); 1711 u16 rev = port->cap->revision; 1712 1713 return sprintf(buf, "%d.%d\n", (rev >> 8) & 0xff, (rev >> 4) & 0xf); 1714} 1715static DEVICE_ATTR_RO(usb_typec_revision); 1716 1717static ssize_t usb_power_delivery_revision_show(struct device *dev, 1718 struct device_attribute *attr, 1719 char *buf) 1720{ 1721 u16 rev = 0; 1722 1723 if (is_typec_partner(dev)) { 1724 struct typec_partner *partner = to_typec_partner(dev); 1725 1726 rev = partner->pd_revision; 1727 } else if (is_typec_cable(dev)) { 1728 struct typec_cable *cable = to_typec_cable(dev); 1729 1730 rev = cable->pd_revision; 1731 } else if (is_typec_port(dev)) { 1732 struct typec_port *p = to_typec_port(dev); 1733 1734 rev = p->cap->pd_revision; 1735 } 1736 return sysfs_emit(buf, "%d.%d\n", (rev >> 8) & 0xff, (rev >> 4) & 0xf); 1737} 1738 1739static ssize_t orientation_show(struct device *dev, 1740 struct device_attribute *attr, 1741 char *buf) 1742{ 1743 struct typec_port *port = to_typec_port(dev); 1744 1745 return sprintf(buf, "%s\n", typec_orientations[port->orientation]); 1746} 1747static DEVICE_ATTR_RO(orientation); 1748 1749static struct attribute *typec_attrs[] = { 1750 &dev_attr_data_role.attr, 1751 &dev_attr_power_operation_mode.attr, 1752 &dev_attr_power_role.attr, 1753 &dev_attr_preferred_role.attr, 1754 &dev_attr_supported_accessory_modes.attr, 1755 &dev_attr_usb_power_delivery_revision.attr, 1756 &dev_attr_usb_typec_revision.attr, 1757 &dev_attr_vconn_source.attr, 1758 &dev_attr_port_type.attr, 1759 &dev_attr_orientation.attr, 1760 NULL, 1761}; 1762 1763static umode_t typec_attr_is_visible(struct kobject *kobj, 1764 struct attribute *attr, int n) 1765{ 1766 struct typec_port *port = to_typec_port(kobj_to_dev(kobj)); 1767 1768 if (attr == &dev_attr_data_role.attr) { 1769 if (port->cap->data != TYPEC_PORT_DRD || 1770 !port->ops || !port->ops->dr_set) 1771 return 0444; 1772 } else if (attr == &dev_attr_power_role.attr) { 1773 if (port->cap->type != TYPEC_PORT_DRP || 1774 !port->ops || !port->ops->pr_set) 1775 return 0444; 1776 } else if (attr == &dev_attr_vconn_source.attr) { 1777 if (!port->cap->pd_revision || 1778 !port->ops || !port->ops->vconn_set) 1779 return 0444; 1780 } else if (attr == &dev_attr_preferred_role.attr) { 1781 if (port->cap->type != TYPEC_PORT_DRP || 1782 !port->ops || !port->ops->try_role) 1783 return 0444; 1784 } else if (attr == &dev_attr_port_type.attr) { 1785 if (!port->ops || !port->ops->port_type_set) 1786 return 0; 1787 if (port->cap->type != TYPEC_PORT_DRP) 1788 return 0444; 1789 } else if (attr == &dev_attr_orientation.attr) { 1790 if (port->cap->orientation_aware) 1791 return 0444; 1792 return 0; 1793 } 1794 1795 return attr->mode; 1796} 1797 1798static const struct attribute_group typec_group = { 1799 .is_visible = typec_attr_is_visible, 1800 .attrs = typec_attrs, 1801}; 1802 1803static const struct attribute_group *typec_groups[] = { 1804 &typec_group, 1805 &pd_group, 1806 NULL 1807}; 1808 1809static int typec_uevent(const struct device *dev, struct kobj_uevent_env *env) 1810{ 1811 int ret; 1812 1813 ret = add_uevent_var(env, "TYPEC_PORT=%s", dev_name(dev)); 1814 if (ret) 1815 dev_err(dev, "failed to add uevent TYPEC_PORT\n"); 1816 1817 return ret; 1818} 1819 1820static void typec_release(struct device *dev) 1821{ 1822 struct typec_port *port = to_typec_port(dev); 1823 1824 ida_free(&typec_index_ida, port->id); 1825 ida_destroy(&port->mode_ids); 1826 typec_switch_put(port->sw); 1827 typec_mux_put(port->mux); 1828 typec_retimer_put(port->retimer); 1829 kfree(port->cap); 1830 kfree(port); 1831} 1832 1833const struct device_type typec_port_dev_type = { 1834 .name = "typec_port", 1835 .groups = typec_groups, 1836 .uevent = typec_uevent, 1837 .release = typec_release, 1838}; 1839 1840/* --------------------------------------- */ 1841/* Driver callbacks to report role updates */ 1842 1843static int partner_match(struct device *dev, void *data) 1844{ 1845 return is_typec_partner(dev); 1846} 1847 1848static struct typec_partner *typec_get_partner(struct typec_port *port) 1849{ 1850 struct device *dev; 1851 1852 dev = device_find_child(&port->dev, NULL, partner_match); 1853 if (!dev) 1854 return NULL; 1855 1856 return to_typec_partner(dev); 1857} 1858 1859static void typec_partner_attach(struct typec_connector *con, struct device *dev) 1860{ 1861 struct typec_port *port = container_of(con, struct typec_port, con); 1862 struct typec_partner *partner = typec_get_partner(port); 1863 struct usb_device *udev = to_usb_device(dev); 1864 1865 if (udev->speed < USB_SPEED_SUPER) 1866 port->usb2_dev = dev; 1867 else 1868 port->usb3_dev = dev; 1869 1870 if (partner) { 1871 typec_partner_link_device(partner, dev); 1872 put_device(&partner->dev); 1873 } 1874} 1875 1876static void typec_partner_deattach(struct typec_connector *con, struct device *dev) 1877{ 1878 struct typec_port *port = container_of(con, struct typec_port, con); 1879 struct typec_partner *partner = typec_get_partner(port); 1880 1881 if (partner) { 1882 typec_partner_unlink_device(partner, dev); 1883 put_device(&partner->dev); 1884 } 1885 1886 if (port->usb2_dev == dev) 1887 port->usb2_dev = NULL; 1888 else if (port->usb3_dev == dev) 1889 port->usb3_dev = NULL; 1890} 1891 1892/** 1893 * typec_set_data_role - Report data role change 1894 * @port: The USB Type-C Port where the role was changed 1895 * @role: The new data role 1896 * 1897 * This routine is used by the port drivers to report data role changes. 1898 */ 1899void typec_set_data_role(struct typec_port *port, enum typec_data_role role) 1900{ 1901 struct typec_partner *partner; 1902 1903 if (port->data_role == role) 1904 return; 1905 1906 port->data_role = role; 1907 sysfs_notify(&port->dev.kobj, NULL, "data_role"); 1908 kobject_uevent(&port->dev.kobj, KOBJ_CHANGE); 1909 1910 partner = typec_get_partner(port); 1911 if (!partner) 1912 return; 1913 1914 if (partner->identity) 1915 typec_product_type_notify(&partner->dev); 1916 1917 put_device(&partner->dev); 1918} 1919EXPORT_SYMBOL_GPL(typec_set_data_role); 1920 1921/** 1922 * typec_set_pwr_role - Report power role change 1923 * @port: The USB Type-C Port where the role was changed 1924 * @role: The new data role 1925 * 1926 * This routine is used by the port drivers to report power role changes. 1927 */ 1928void typec_set_pwr_role(struct typec_port *port, enum typec_role role) 1929{ 1930 if (port->pwr_role == role) 1931 return; 1932 1933 port->pwr_role = role; 1934 sysfs_notify(&port->dev.kobj, NULL, "power_role"); 1935 kobject_uevent(&port->dev.kobj, KOBJ_CHANGE); 1936} 1937EXPORT_SYMBOL_GPL(typec_set_pwr_role); 1938 1939/** 1940 * typec_set_vconn_role - Report VCONN source change 1941 * @port: The USB Type-C Port which VCONN role changed 1942 * @role: Source when @port is sourcing VCONN, or Sink when it's not 1943 * 1944 * This routine is used by the port drivers to report if the VCONN source is 1945 * changes. 1946 */ 1947void typec_set_vconn_role(struct typec_port *port, enum typec_role role) 1948{ 1949 if (port->vconn_role == role) 1950 return; 1951 1952 port->vconn_role = role; 1953 sysfs_notify(&port->dev.kobj, NULL, "vconn_source"); 1954 kobject_uevent(&port->dev.kobj, KOBJ_CHANGE); 1955} 1956EXPORT_SYMBOL_GPL(typec_set_vconn_role); 1957 1958/** 1959 * typec_set_pwr_opmode - Report changed power operation mode 1960 * @port: The USB Type-C Port where the mode was changed 1961 * @opmode: New power operation mode 1962 * 1963 * This routine is used by the port drivers to report changed power operation 1964 * mode in @port. The modes are USB (default), 1.5A, 3.0A as defined in USB 1965 * Type-C specification, and "USB Power Delivery" when the power levels are 1966 * negotiated with methods defined in USB Power Delivery specification. 1967 */ 1968void typec_set_pwr_opmode(struct typec_port *port, 1969 enum typec_pwr_opmode opmode) 1970{ 1971 struct device *partner_dev; 1972 1973 if (port->pwr_opmode == opmode) 1974 return; 1975 1976 port->pwr_opmode = opmode; 1977 sysfs_notify(&port->dev.kobj, NULL, "power_operation_mode"); 1978 kobject_uevent(&port->dev.kobj, KOBJ_CHANGE); 1979 1980 partner_dev = device_find_child(&port->dev, NULL, partner_match); 1981 if (partner_dev) { 1982 struct typec_partner *partner = to_typec_partner(partner_dev); 1983 1984 if (opmode == TYPEC_PWR_MODE_PD && !partner->usb_pd) { 1985 partner->usb_pd = 1; 1986 sysfs_notify(&partner_dev->kobj, NULL, 1987 "supports_usb_power_delivery"); 1988 kobject_uevent(&partner_dev->kobj, KOBJ_CHANGE); 1989 } 1990 put_device(partner_dev); 1991 } 1992} 1993EXPORT_SYMBOL_GPL(typec_set_pwr_opmode); 1994 1995/** 1996 * typec_find_pwr_opmode - Get the typec power operation mode capability 1997 * @name: power operation mode string 1998 * 1999 * This routine is used to find the typec_pwr_opmode by its string @name. 2000 * 2001 * Returns typec_pwr_opmode if success, otherwise negative error code. 2002 */ 2003int typec_find_pwr_opmode(const char *name) 2004{ 2005 return match_string(typec_pwr_opmodes, 2006 ARRAY_SIZE(typec_pwr_opmodes), name); 2007} 2008EXPORT_SYMBOL_GPL(typec_find_pwr_opmode); 2009 2010/** 2011 * typec_find_orientation - Convert orientation string to enum typec_orientation 2012 * @name: Orientation string 2013 * 2014 * This routine is used to find the typec_orientation by its string name @name. 2015 * 2016 * Returns the orientation value on success, otherwise negative error code. 2017 */ 2018int typec_find_orientation(const char *name) 2019{ 2020 return match_string(typec_orientations, ARRAY_SIZE(typec_orientations), 2021 name); 2022} 2023EXPORT_SYMBOL_GPL(typec_find_orientation); 2024 2025/** 2026 * typec_find_port_power_role - Get the typec port power capability 2027 * @name: port power capability string 2028 * 2029 * This routine is used to find the typec_port_type by its string name. 2030 * 2031 * Returns typec_port_type if success, otherwise negative error code. 2032 */ 2033int typec_find_port_power_role(const char *name) 2034{ 2035 return match_string(typec_port_power_roles, 2036 ARRAY_SIZE(typec_port_power_roles), name); 2037} 2038EXPORT_SYMBOL_GPL(typec_find_port_power_role); 2039 2040/** 2041 * typec_find_power_role - Find the typec one specific power role 2042 * @name: power role string 2043 * 2044 * This routine is used to find the typec_role by its string name. 2045 * 2046 * Returns typec_role if success, otherwise negative error code. 2047 */ 2048int typec_find_power_role(const char *name) 2049{ 2050 return match_string(typec_roles, ARRAY_SIZE(typec_roles), name); 2051} 2052EXPORT_SYMBOL_GPL(typec_find_power_role); 2053 2054/** 2055 * typec_find_port_data_role - Get the typec port data capability 2056 * @name: port data capability string 2057 * 2058 * This routine is used to find the typec_port_data by its string name. 2059 * 2060 * Returns typec_port_data if success, otherwise negative error code. 2061 */ 2062int typec_find_port_data_role(const char *name) 2063{ 2064 return match_string(typec_port_data_roles, 2065 ARRAY_SIZE(typec_port_data_roles), name); 2066} 2067EXPORT_SYMBOL_GPL(typec_find_port_data_role); 2068 2069/* ------------------------------------------ */ 2070/* API for Multiplexer/DeMultiplexer Switches */ 2071 2072/** 2073 * typec_set_orientation - Set USB Type-C cable plug orientation 2074 * @port: USB Type-C Port 2075 * @orientation: USB Type-C cable plug orientation 2076 * 2077 * Set cable plug orientation for @port. 2078 */ 2079int typec_set_orientation(struct typec_port *port, 2080 enum typec_orientation orientation) 2081{ 2082 int ret; 2083 2084 ret = typec_switch_set(port->sw, orientation); 2085 if (ret) 2086 return ret; 2087 2088 port->orientation = orientation; 2089 sysfs_notify(&port->dev.kobj, NULL, "orientation"); 2090 kobject_uevent(&port->dev.kobj, KOBJ_CHANGE); 2091 2092 return 0; 2093} 2094EXPORT_SYMBOL_GPL(typec_set_orientation); 2095 2096/** 2097 * typec_get_orientation - Get USB Type-C cable plug orientation 2098 * @port: USB Type-C Port 2099 * 2100 * Get current cable plug orientation for @port. 2101 */ 2102enum typec_orientation typec_get_orientation(struct typec_port *port) 2103{ 2104 return port->orientation; 2105} 2106EXPORT_SYMBOL_GPL(typec_get_orientation); 2107 2108/** 2109 * typec_set_mode - Set mode of operation for USB Type-C connector 2110 * @port: USB Type-C connector 2111 * @mode: Accessory Mode, USB Operation or Safe State 2112 * 2113 * Configure @port for Accessory Mode @mode. This function will configure the 2114 * muxes needed for @mode. 2115 */ 2116int typec_set_mode(struct typec_port *port, int mode) 2117{ 2118 struct typec_mux_state state = { }; 2119 2120 state.mode = mode; 2121 2122 return typec_mux_set(port->mux, &state); 2123} 2124EXPORT_SYMBOL_GPL(typec_set_mode); 2125 2126/* --------------------------------------- */ 2127 2128/** 2129 * typec_get_negotiated_svdm_version - Get negotiated SVDM Version 2130 * @port: USB Type-C Port. 2131 * 2132 * Get the negotiated SVDM Version. The Version is set to the port default 2133 * value stored in typec_capability on partner registration, and updated after 2134 * a successful Discover Identity if the negotiated value is less than the 2135 * default value. 2136 * 2137 * Returns usb_pd_svdm_ver if the partner has been registered otherwise -ENODEV. 2138 */ 2139int typec_get_negotiated_svdm_version(struct typec_port *port) 2140{ 2141 enum usb_pd_svdm_ver svdm_version; 2142 struct device *partner_dev; 2143 2144 partner_dev = device_find_child(&port->dev, NULL, partner_match); 2145 if (!partner_dev) 2146 return -ENODEV; 2147 2148 svdm_version = to_typec_partner(partner_dev)->svdm_version; 2149 put_device(partner_dev); 2150 2151 return svdm_version; 2152} 2153EXPORT_SYMBOL_GPL(typec_get_negotiated_svdm_version); 2154 2155/** 2156 * typec_get_cable_svdm_version - Get cable negotiated SVDM Version 2157 * @port: USB Type-C Port. 2158 * 2159 * Get the negotiated SVDM Version for the cable. The Version is set to the port 2160 * default value based on the PD Revision during cable registration, and updated 2161 * after a successful Discover Identity if the negotiated value is less than the 2162 * default. 2163 * 2164 * Returns usb_pd_svdm_ver if the cable has been registered otherwise -ENODEV. 2165 */ 2166int typec_get_cable_svdm_version(struct typec_port *port) 2167{ 2168 enum usb_pd_svdm_ver svdm_version; 2169 struct device *cable_dev; 2170 2171 cable_dev = device_find_child(&port->dev, NULL, cable_match); 2172 if (!cable_dev) 2173 return -ENODEV; 2174 2175 svdm_version = to_typec_cable(cable_dev)->svdm_version; 2176 put_device(cable_dev); 2177 2178 return svdm_version; 2179} 2180EXPORT_SYMBOL_GPL(typec_get_cable_svdm_version); 2181 2182/** 2183 * typec_cable_set_svdm_version - Set negotiated Structured VDM (SVDM) Version 2184 * @cable: USB Type-C Active Cable that supports SVDM 2185 * @svdm_version: Negotiated SVDM Version 2186 * 2187 * This routine is used to save the negotiated SVDM Version. 2188 */ 2189void typec_cable_set_svdm_version(struct typec_cable *cable, enum usb_pd_svdm_ver svdm_version) 2190{ 2191 cable->svdm_version = svdm_version; 2192} 2193EXPORT_SYMBOL_GPL(typec_cable_set_svdm_version); 2194 2195/** 2196 * typec_get_drvdata - Return private driver data pointer 2197 * @port: USB Type-C port 2198 */ 2199void *typec_get_drvdata(struct typec_port *port) 2200{ 2201 return dev_get_drvdata(&port->dev); 2202} 2203EXPORT_SYMBOL_GPL(typec_get_drvdata); 2204 2205int typec_get_fw_cap(struct typec_capability *cap, 2206 struct fwnode_handle *fwnode) 2207{ 2208 const char *cap_str; 2209 int ret; 2210 2211 cap->fwnode = fwnode; 2212 2213 ret = fwnode_property_read_string(fwnode, "power-role", &cap_str); 2214 if (ret < 0) 2215 return ret; 2216 2217 ret = typec_find_port_power_role(cap_str); 2218 if (ret < 0) 2219 return ret; 2220 cap->type = ret; 2221 2222 /* USB data support is optional */ 2223 ret = fwnode_property_read_string(fwnode, "data-role", &cap_str); 2224 if (ret == 0) { 2225 ret = typec_find_port_data_role(cap_str); 2226 if (ret < 0) 2227 return ret; 2228 cap->data = ret; 2229 } 2230 2231 /* Get the preferred power role for a DRP */ 2232 if (cap->type == TYPEC_PORT_DRP) { 2233 cap->prefer_role = TYPEC_NO_PREFERRED_ROLE; 2234 2235 ret = fwnode_property_read_string(fwnode, "try-power-role", &cap_str); 2236 if (ret == 0) { 2237 ret = typec_find_power_role(cap_str); 2238 if (ret < 0) 2239 return ret; 2240 cap->prefer_role = ret; 2241 } 2242 } 2243 2244 return 0; 2245} 2246EXPORT_SYMBOL_GPL(typec_get_fw_cap); 2247 2248/** 2249 * typec_port_register_altmode - Register USB Type-C Port Alternate Mode 2250 * @port: USB Type-C Port that supports the alternate mode 2251 * @desc: Description of the alternate mode 2252 * 2253 * This routine is used to register an alternate mode that @port is capable of 2254 * supporting. 2255 * 2256 * Returns handle to the alternate mode on success or ERR_PTR on failure. 2257 */ 2258struct typec_altmode * 2259typec_port_register_altmode(struct typec_port *port, 2260 const struct typec_altmode_desc *desc) 2261{ 2262 struct typec_altmode *adev; 2263 struct typec_mux *mux; 2264 struct typec_retimer *retimer; 2265 2266 mux = typec_mux_get(&port->dev); 2267 if (IS_ERR(mux)) 2268 return ERR_CAST(mux); 2269 2270 retimer = typec_retimer_get(&port->dev); 2271 if (IS_ERR(retimer)) { 2272 typec_mux_put(mux); 2273 return ERR_CAST(retimer); 2274 } 2275 2276 adev = typec_register_altmode(&port->dev, desc); 2277 if (IS_ERR(adev)) { 2278 typec_retimer_put(retimer); 2279 typec_mux_put(mux); 2280 } else { 2281 to_altmode(adev)->mux = mux; 2282 to_altmode(adev)->retimer = retimer; 2283 } 2284 2285 return adev; 2286} 2287EXPORT_SYMBOL_GPL(typec_port_register_altmode); 2288 2289void typec_port_register_altmodes(struct typec_port *port, 2290 const struct typec_altmode_ops *ops, void *drvdata, 2291 struct typec_altmode **altmodes, size_t n) 2292{ 2293 struct fwnode_handle *altmodes_node, *child; 2294 struct typec_altmode_desc desc; 2295 struct typec_altmode *alt; 2296 size_t index = 0; 2297 u16 svid; 2298 u32 vdo; 2299 int ret; 2300 2301 altmodes_node = device_get_named_child_node(&port->dev, "altmodes"); 2302 if (!altmodes_node) 2303 return; /* No altmodes specified */ 2304 2305 fwnode_for_each_child_node(altmodes_node, child) { 2306 ret = fwnode_property_read_u16(child, "svid", &svid); 2307 if (ret) { 2308 dev_err(&port->dev, "Error reading svid for altmode %s\n", 2309 fwnode_get_name(child)); 2310 continue; 2311 } 2312 2313 ret = fwnode_property_read_u32(child, "vdo", &vdo); 2314 if (ret) { 2315 dev_err(&port->dev, "Error reading vdo for altmode %s\n", 2316 fwnode_get_name(child)); 2317 continue; 2318 } 2319 2320 if (index >= n) { 2321 dev_err(&port->dev, "Error not enough space for altmode %s\n", 2322 fwnode_get_name(child)); 2323 continue; 2324 } 2325 2326 desc.svid = svid; 2327 desc.vdo = vdo; 2328 desc.mode = index + 1; 2329 alt = typec_port_register_altmode(port, &desc); 2330 if (IS_ERR(alt)) { 2331 dev_err(&port->dev, "Error registering altmode %s\n", 2332 fwnode_get_name(child)); 2333 continue; 2334 } 2335 2336 typec_altmode_set_ops(alt, ops); 2337 typec_altmode_set_drvdata(alt, drvdata); 2338 altmodes[index] = alt; 2339 index++; 2340 } 2341} 2342EXPORT_SYMBOL_GPL(typec_port_register_altmodes); 2343 2344/** 2345 * typec_port_register_cable_ops - Register typec_cable_ops to port altmodes 2346 * @altmodes: USB Type-C Port's altmode vector 2347 * @max_altmodes: The maximum number of alt modes supported by the port 2348 * @ops: Cable alternate mode vector 2349 */ 2350void typec_port_register_cable_ops(struct typec_altmode **altmodes, int max_altmodes, 2351 const struct typec_cable_ops *ops) 2352{ 2353 int i; 2354 2355 for (i = 0; i < max_altmodes; i++) { 2356 if (!altmodes[i]) 2357 return; 2358 altmodes[i]->cable_ops = ops; 2359 } 2360} 2361EXPORT_SYMBOL_GPL(typec_port_register_cable_ops); 2362 2363/** 2364 * typec_register_port - Register a USB Type-C Port 2365 * @parent: Parent device 2366 * @cap: Description of the port 2367 * 2368 * Registers a device for USB Type-C Port described in @cap. 2369 * 2370 * Returns handle to the port on success or ERR_PTR on failure. 2371 */ 2372struct typec_port *typec_register_port(struct device *parent, 2373 const struct typec_capability *cap) 2374{ 2375 struct typec_port *port; 2376 int ret; 2377 int id; 2378 2379 port = kzalloc(sizeof(*port), GFP_KERNEL); 2380 if (!port) 2381 return ERR_PTR(-ENOMEM); 2382 2383 id = ida_alloc(&typec_index_ida, GFP_KERNEL); 2384 if (id < 0) { 2385 kfree(port); 2386 return ERR_PTR(id); 2387 } 2388 2389 switch (cap->type) { 2390 case TYPEC_PORT_SRC: 2391 port->pwr_role = TYPEC_SOURCE; 2392 port->vconn_role = TYPEC_SOURCE; 2393 break; 2394 case TYPEC_PORT_SNK: 2395 port->pwr_role = TYPEC_SINK; 2396 port->vconn_role = TYPEC_SINK; 2397 break; 2398 case TYPEC_PORT_DRP: 2399 if (cap->prefer_role != TYPEC_NO_PREFERRED_ROLE) 2400 port->pwr_role = cap->prefer_role; 2401 else 2402 port->pwr_role = TYPEC_SINK; 2403 break; 2404 } 2405 2406 switch (cap->data) { 2407 case TYPEC_PORT_DFP: 2408 port->data_role = TYPEC_HOST; 2409 break; 2410 case TYPEC_PORT_UFP: 2411 port->data_role = TYPEC_DEVICE; 2412 break; 2413 case TYPEC_PORT_DRD: 2414 if (cap->prefer_role == TYPEC_SOURCE) 2415 port->data_role = TYPEC_HOST; 2416 else 2417 port->data_role = TYPEC_DEVICE; 2418 break; 2419 } 2420 2421 ida_init(&port->mode_ids); 2422 mutex_init(&port->port_type_lock); 2423 2424 port->id = id; 2425 port->ops = cap->ops; 2426 port->port_type = cap->type; 2427 port->prefer_role = cap->prefer_role; 2428 port->con.attach = typec_partner_attach; 2429 port->con.deattach = typec_partner_deattach; 2430 2431 device_initialize(&port->dev); 2432 port->dev.class = &typec_class; 2433 port->dev.parent = parent; 2434 port->dev.fwnode = cap->fwnode; 2435 port->dev.type = &typec_port_dev_type; 2436 dev_set_name(&port->dev, "port%d", id); 2437 dev_set_drvdata(&port->dev, cap->driver_data); 2438 2439 port->cap = kmemdup(cap, sizeof(*cap), GFP_KERNEL); 2440 if (!port->cap) { 2441 put_device(&port->dev); 2442 return ERR_PTR(-ENOMEM); 2443 } 2444 2445 port->sw = typec_switch_get(&port->dev); 2446 if (IS_ERR(port->sw)) { 2447 ret = PTR_ERR(port->sw); 2448 put_device(&port->dev); 2449 return ERR_PTR(ret); 2450 } 2451 2452 port->mux = typec_mux_get(&port->dev); 2453 if (IS_ERR(port->mux)) { 2454 ret = PTR_ERR(port->mux); 2455 put_device(&port->dev); 2456 return ERR_PTR(ret); 2457 } 2458 2459 port->retimer = typec_retimer_get(&port->dev); 2460 if (IS_ERR(port->retimer)) { 2461 ret = PTR_ERR(port->retimer); 2462 put_device(&port->dev); 2463 return ERR_PTR(ret); 2464 } 2465 2466 port->pd = cap->pd; 2467 2468 ret = device_add(&port->dev); 2469 if (ret) { 2470 dev_err(parent, "failed to register port (%d)\n", ret); 2471 put_device(&port->dev); 2472 return ERR_PTR(ret); 2473 } 2474 2475 ret = usb_power_delivery_link_device(port->pd, &port->dev); 2476 if (ret) { 2477 dev_err(&port->dev, "failed to link pd\n"); 2478 device_unregister(&port->dev); 2479 return ERR_PTR(ret); 2480 } 2481 2482 ret = typec_link_ports(port); 2483 if (ret) 2484 dev_warn(&port->dev, "failed to create symlinks (%d)\n", ret); 2485 2486 return port; 2487} 2488EXPORT_SYMBOL_GPL(typec_register_port); 2489 2490/** 2491 * typec_unregister_port - Unregister a USB Type-C Port 2492 * @port: The port to be unregistered 2493 * 2494 * Unregister device created with typec_register_port(). 2495 */ 2496void typec_unregister_port(struct typec_port *port) 2497{ 2498 if (!IS_ERR_OR_NULL(port)) { 2499 typec_unlink_ports(port); 2500 typec_port_set_usb_power_delivery(port, NULL); 2501 device_unregister(&port->dev); 2502 } 2503} 2504EXPORT_SYMBOL_GPL(typec_unregister_port); 2505 2506static int __init typec_init(void) 2507{ 2508 int ret; 2509 2510 ret = bus_register(&typec_bus); 2511 if (ret) 2512 return ret; 2513 2514 ret = class_register(&typec_mux_class); 2515 if (ret) 2516 goto err_unregister_bus; 2517 2518 ret = class_register(&retimer_class); 2519 if (ret) 2520 goto err_unregister_mux_class; 2521 2522 ret = class_register(&typec_class); 2523 if (ret) 2524 goto err_unregister_retimer_class; 2525 2526 ret = usb_power_delivery_init(); 2527 if (ret) 2528 goto err_unregister_class; 2529 2530 return 0; 2531 2532err_unregister_class: 2533 class_unregister(&typec_class); 2534 2535err_unregister_retimer_class: 2536 class_unregister(&retimer_class); 2537 2538err_unregister_mux_class: 2539 class_unregister(&typec_mux_class); 2540 2541err_unregister_bus: 2542 bus_unregister(&typec_bus); 2543 2544 return ret; 2545} 2546subsys_initcall(typec_init); 2547 2548static void __exit typec_exit(void) 2549{ 2550 usb_power_delivery_exit(); 2551 class_unregister(&typec_class); 2552 ida_destroy(&typec_index_ida); 2553 bus_unregister(&typec_bus); 2554 class_unregister(&typec_mux_class); 2555 class_unregister(&retimer_class); 2556} 2557module_exit(typec_exit); 2558 2559MODULE_AUTHOR("Heikki Krogerus <heikki.krogerus@linux.intel.com>"); 2560MODULE_LICENSE("GPL v2"); 2561MODULE_DESCRIPTION("USB Type-C Connector Class");