2 * drivers/extcon/extcon.c - External Connector (extcon) framework.
4 * Copyright (C) 2015 Samsung Electronics
5 * Author: Chanwoo Choi <cw00.choi@samsung.com>
7 * Copyright (C) 2012 Samsung Electronics
8 * Author: Donggeun Kim <dg77.kim@samsung.com>
9 * Author: MyungJoo Ham <myungjoo.ham@samsung.com>
11 * based on android/drivers/switch/switch_class.c
12 * Copyright (C) 2008 Google, Inc.
13 * Author: Mike Lockwood <lockwood@android.com>
15 * This software is licensed under the terms of the GNU General Public
16 * License version 2, as published by the Free Software Foundation, and
17 * may be copied, distributed, and modified under those terms.
19 * This program is distributed in the hope that it will be useful,
20 * but WITHOUT ANY WARRANTY; without even the implied warranty of
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22 * GNU General Public License for more details.
25 #include <linux/module.h>
26 #include <linux/types.h>
27 #include <linux/init.h>
28 #include <linux/device.h>
30 #include <linux/err.h>
32 #include <linux/slab.h>
33 #include <linux/sysfs.h>
37 #define SUPPORTED_CABLE_MAX 32
39 static const struct __extcon_info
{
46 .type
= EXTCON_TYPE_MISC
,
51 /* USB external connector */
53 .type
= EXTCON_TYPE_USB
,
58 .type
= EXTCON_TYPE_USB
,
59 .id
= EXTCON_USB_HOST
,
63 /* Charging external connector */
64 [EXTCON_CHG_USB_SDP
] = {
65 .type
= EXTCON_TYPE_CHG
| EXTCON_TYPE_USB
,
66 .id
= EXTCON_CHG_USB_SDP
,
69 [EXTCON_CHG_USB_DCP
] = {
70 .type
= EXTCON_TYPE_CHG
| EXTCON_TYPE_USB
,
71 .id
= EXTCON_CHG_USB_DCP
,
74 [EXTCON_CHG_USB_CDP
] = {
75 .type
= EXTCON_TYPE_CHG
| EXTCON_TYPE_USB
,
76 .id
= EXTCON_CHG_USB_CDP
,
79 [EXTCON_CHG_USB_ACA
] = {
80 .type
= EXTCON_TYPE_CHG
| EXTCON_TYPE_USB
,
81 .id
= EXTCON_CHG_USB_ACA
,
84 [EXTCON_CHG_USB_FAST
] = {
85 .type
= EXTCON_TYPE_CHG
| EXTCON_TYPE_USB
,
86 .id
= EXTCON_CHG_USB_FAST
,
87 .name
= "FAST-CHARGER",
89 [EXTCON_CHG_USB_SLOW
] = {
90 .type
= EXTCON_TYPE_CHG
| EXTCON_TYPE_USB
,
91 .id
= EXTCON_CHG_USB_SLOW
,
92 .name
= "SLOW-CHARGER",
95 .type
= EXTCON_TYPE_CHG
,
99 [EXTCON_CHG_USB_PD
] = {
100 .type
= EXTCON_TYPE_CHG
| EXTCON_TYPE_USB
,
101 .id
= EXTCON_CHG_USB_PD
,
105 /* Jack external connector */
106 [EXTCON_JACK_MICROPHONE
] = {
107 .type
= EXTCON_TYPE_JACK
,
108 .id
= EXTCON_JACK_MICROPHONE
,
109 .name
= "MICROPHONE",
111 [EXTCON_JACK_HEADPHONE
] = {
112 .type
= EXTCON_TYPE_JACK
,
113 .id
= EXTCON_JACK_HEADPHONE
,
116 [EXTCON_JACK_LINE_IN
] = {
117 .type
= EXTCON_TYPE_JACK
,
118 .id
= EXTCON_JACK_LINE_IN
,
121 [EXTCON_JACK_LINE_OUT
] = {
122 .type
= EXTCON_TYPE_JACK
,
123 .id
= EXTCON_JACK_LINE_OUT
,
126 [EXTCON_JACK_VIDEO_IN
] = {
127 .type
= EXTCON_TYPE_JACK
,
128 .id
= EXTCON_JACK_VIDEO_IN
,
131 [EXTCON_JACK_VIDEO_OUT
] = {
132 .type
= EXTCON_TYPE_JACK
,
133 .id
= EXTCON_JACK_VIDEO_OUT
,
136 [EXTCON_JACK_SPDIF_IN
] = {
137 .type
= EXTCON_TYPE_JACK
,
138 .id
= EXTCON_JACK_SPDIF_IN
,
141 [EXTCON_JACK_SPDIF_OUT
] = {
142 .type
= EXTCON_TYPE_JACK
,
143 .id
= EXTCON_JACK_SPDIF_OUT
,
147 /* Display external connector */
148 [EXTCON_DISP_HDMI
] = {
149 .type
= EXTCON_TYPE_DISP
,
150 .id
= EXTCON_DISP_HDMI
,
153 [EXTCON_DISP_MHL
] = {
154 .type
= EXTCON_TYPE_DISP
,
155 .id
= EXTCON_DISP_MHL
,
158 [EXTCON_DISP_DVI
] = {
159 .type
= EXTCON_TYPE_DISP
,
160 .id
= EXTCON_DISP_DVI
,
163 [EXTCON_DISP_VGA
] = {
164 .type
= EXTCON_TYPE_DISP
,
165 .id
= EXTCON_DISP_VGA
,
169 .type
= EXTCON_TYPE_DISP
| EXTCON_TYPE_USB
,
170 .id
= EXTCON_DISP_DP
,
173 [EXTCON_DISP_HMD
] = {
174 .type
= EXTCON_TYPE_DISP
| EXTCON_TYPE_USB
,
175 .id
= EXTCON_DISP_HMD
,
179 /* Miscellaneous external connector */
181 .type
= EXTCON_TYPE_MISC
,
186 .type
= EXTCON_TYPE_MISC
,
190 [EXTCON_MECHANICAL
] = {
191 .type
= EXTCON_TYPE_MISC
,
192 .id
= EXTCON_MECHANICAL
,
193 .name
= "MECHANICAL",
200 * struct extcon_cable - An internal data for an external connector.
201 * @edev: the extcon device
202 * @cable_index: the index of this cable in the edev
203 * @attr_g: the attribute group for the cable
204 * @attr_name: "name" sysfs entry
205 * @attr_state: "state" sysfs entry
206 * @attrs: the array pointing to attr_name and attr_state for attr_g
208 struct extcon_cable
{
209 struct extcon_dev
*edev
;
212 struct attribute_group attr_g
;
213 struct device_attribute attr_name
;
214 struct device_attribute attr_state
;
216 struct attribute
*attrs
[3]; /* to be fed to attr_g.attrs */
218 union extcon_property_value usb_propval
[EXTCON_PROP_USB_CNT
];
219 union extcon_property_value chg_propval
[EXTCON_PROP_CHG_CNT
];
220 union extcon_property_value jack_propval
[EXTCON_PROP_JACK_CNT
];
221 union extcon_property_value disp_propval
[EXTCON_PROP_DISP_CNT
];
223 unsigned long usb_bits
[BITS_TO_LONGS(EXTCON_PROP_USB_CNT
)];
224 unsigned long chg_bits
[BITS_TO_LONGS(EXTCON_PROP_CHG_CNT
)];
225 unsigned long jack_bits
[BITS_TO_LONGS(EXTCON_PROP_JACK_CNT
)];
226 unsigned long disp_bits
[BITS_TO_LONGS(EXTCON_PROP_DISP_CNT
)];
229 static struct class *extcon_class
;
231 static LIST_HEAD(extcon_dev_list
);
232 static DEFINE_MUTEX(extcon_dev_list_lock
);
234 static int check_mutually_exclusive(struct extcon_dev
*edev
, u32 new_state
)
238 if (!edev
->mutually_exclusive
)
241 for (i
= 0; edev
->mutually_exclusive
[i
]; i
++) {
243 u32 correspondants
= new_state
& edev
->mutually_exclusive
[i
];
245 /* calculate the total number of bits set */
246 weight
= hweight32(correspondants
);
254 static int find_cable_index_by_id(struct extcon_dev
*edev
, const unsigned int id
)
258 /* Find the the index of extcon cable in edev->supported_cable */
259 for (i
= 0; i
< edev
->max_supported
; i
++) {
260 if (edev
->supported_cable
[i
] == id
)
267 static int get_extcon_type(unsigned int prop
)
270 case EXTCON_PROP_USB_MIN
... EXTCON_PROP_USB_MAX
:
271 return EXTCON_TYPE_USB
;
272 case EXTCON_PROP_CHG_MIN
... EXTCON_PROP_CHG_MAX
:
273 return EXTCON_TYPE_CHG
;
274 case EXTCON_PROP_JACK_MIN
... EXTCON_PROP_JACK_MAX
:
275 return EXTCON_TYPE_JACK
;
276 case EXTCON_PROP_DISP_MIN
... EXTCON_PROP_DISP_MAX
:
277 return EXTCON_TYPE_DISP
;
283 static bool is_extcon_attached(struct extcon_dev
*edev
, unsigned int index
)
285 return !!(edev
->state
& BIT(index
));
288 static bool is_extcon_changed(struct extcon_dev
*edev
, int index
,
291 int state
= !!(edev
->state
& BIT(index
));
292 return (state
!= new_state
);
295 static bool is_extcon_property_supported(unsigned int id
, unsigned int prop
)
299 /* Check whether the property is supported or not. */
300 type
= get_extcon_type(prop
);
304 /* Check whether a specific extcon id supports the property or not. */
305 return !!(extcon_info
[id
].type
& type
);
308 static int is_extcon_property_capability(struct extcon_dev
*edev
,
309 unsigned int id
, int index
,unsigned int prop
)
311 struct extcon_cable
*cable
;
314 /* Check whether the property is supported or not. */
315 type
= get_extcon_type(prop
);
319 cable
= &edev
->cables
[index
];
322 case EXTCON_TYPE_USB
:
323 ret
= test_bit(prop
- EXTCON_PROP_USB_MIN
, cable
->usb_bits
);
325 case EXTCON_TYPE_CHG
:
326 ret
= test_bit(prop
- EXTCON_PROP_CHG_MIN
, cable
->chg_bits
);
328 case EXTCON_TYPE_JACK
:
329 ret
= test_bit(prop
- EXTCON_PROP_JACK_MIN
, cable
->jack_bits
);
331 case EXTCON_TYPE_DISP
:
332 ret
= test_bit(prop
- EXTCON_PROP_DISP_MIN
, cable
->disp_bits
);
341 static void init_property(struct extcon_dev
*edev
, unsigned int id
, int index
)
343 unsigned int type
= extcon_info
[id
].type
;
344 struct extcon_cable
*cable
= &edev
->cables
[index
];
346 if (EXTCON_TYPE_USB
& type
)
347 memset(cable
->usb_propval
, 0, sizeof(cable
->usb_propval
));
348 if (EXTCON_TYPE_CHG
& type
)
349 memset(cable
->chg_propval
, 0, sizeof(cable
->chg_propval
));
350 if (EXTCON_TYPE_JACK
& type
)
351 memset(cable
->jack_propval
, 0, sizeof(cable
->jack_propval
));
352 if (EXTCON_TYPE_DISP
& type
)
353 memset(cable
->disp_propval
, 0, sizeof(cable
->disp_propval
));
356 static ssize_t
state_show(struct device
*dev
, struct device_attribute
*attr
,
360 struct extcon_dev
*edev
= dev_get_drvdata(dev
);
362 if (edev
->max_supported
== 0)
363 return sprintf(buf
, "%u\n", edev
->state
);
365 for (i
= 0; i
< edev
->max_supported
; i
++) {
366 count
+= sprintf(buf
+ count
, "%s=%d\n",
367 extcon_info
[edev
->supported_cable
[i
]].name
,
368 !!(edev
->state
& BIT(i
)));
373 static DEVICE_ATTR_RO(state
);
375 static ssize_t
name_show(struct device
*dev
, struct device_attribute
*attr
,
378 struct extcon_dev
*edev
= dev_get_drvdata(dev
);
380 return sprintf(buf
, "%s\n", edev
->name
);
382 static DEVICE_ATTR_RO(name
);
384 static ssize_t
cable_name_show(struct device
*dev
,
385 struct device_attribute
*attr
, char *buf
)
387 struct extcon_cable
*cable
= container_of(attr
, struct extcon_cable
,
389 int i
= cable
->cable_index
;
391 return sprintf(buf
, "%s\n",
392 extcon_info
[cable
->edev
->supported_cable
[i
]].name
);
395 static ssize_t
cable_state_show(struct device
*dev
,
396 struct device_attribute
*attr
, char *buf
)
398 struct extcon_cable
*cable
= container_of(attr
, struct extcon_cable
,
401 int i
= cable
->cable_index
;
403 return sprintf(buf
, "%d\n",
404 extcon_get_state(cable
->edev
, cable
->edev
->supported_cable
[i
]));
408 * extcon_sync() - Synchronize the state for an external connector.
409 * @edev: the extcon device
411 * Note that this function send a notification in order to synchronize
412 * the state and property of an external connector.
414 * Returns 0 if success or error number if fail.
416 int extcon_sync(struct extcon_dev
*edev
, unsigned int id
)
431 index
= find_cable_index_by_id(edev
, id
);
435 spin_lock_irqsave(&edev
->lock
, flags
);
436 state
= !!(edev
->state
& BIT(index
));
437 spin_unlock_irqrestore(&edev
->lock
, flags
);
440 * Call functions in a raw notifier chain for the specific one
441 * external connector.
443 raw_notifier_call_chain(&edev
->nh
[index
], state
, edev
);
446 * Call functions in a raw notifier chain for the all supported
447 * external connectors.
449 raw_notifier_call_chain(&edev
->nh_all
, state
, edev
);
451 spin_lock_irqsave(&edev
->lock
, flags
);
452 /* This could be in interrupt handler */
453 prop_buf
= (char *)get_zeroed_page(GFP_ATOMIC
);
455 /* Unlock early before uevent */
456 spin_unlock_irqrestore(&edev
->lock
, flags
);
458 dev_err(&edev
->dev
, "out of memory in extcon_set_state\n");
459 kobject_uevent(&edev
->dev
.kobj
, KOBJ_CHANGE
);
464 length
= name_show(&edev
->dev
, NULL
, prop_buf
);
466 if (prop_buf
[length
- 1] == '\n')
467 prop_buf
[length
- 1] = 0;
468 snprintf(name_buf
, sizeof(name_buf
), "NAME=%s", prop_buf
);
469 envp
[env_offset
++] = name_buf
;
472 length
= state_show(&edev
->dev
, NULL
, prop_buf
);
474 if (prop_buf
[length
- 1] == '\n')
475 prop_buf
[length
- 1] = 0;
476 snprintf(state_buf
, sizeof(state_buf
), "STATE=%s", prop_buf
);
477 envp
[env_offset
++] = state_buf
;
479 envp
[env_offset
] = NULL
;
481 /* Unlock early before uevent */
482 spin_unlock_irqrestore(&edev
->lock
, flags
);
483 kobject_uevent_env(&edev
->dev
.kobj
, KOBJ_CHANGE
, envp
);
484 free_page((unsigned long)prop_buf
);
488 EXPORT_SYMBOL_GPL(extcon_sync
);
491 * extcon_get_state() - Get the state of an external connector.
492 * @edev: the extcon device
493 * @id: the unique id indicating an external connector
495 * Returns 0 if success or error number if fail.
497 int extcon_get_state(struct extcon_dev
*edev
, const unsigned int id
)
505 index
= find_cable_index_by_id(edev
, id
);
509 spin_lock_irqsave(&edev
->lock
, flags
);
510 state
= is_extcon_attached(edev
, index
);
511 spin_unlock_irqrestore(&edev
->lock
, flags
);
515 EXPORT_SYMBOL_GPL(extcon_get_state
);
518 * extcon_set_state() - Set the state of an external connector.
519 * @edev: the extcon device
520 * @id: the unique id indicating an external connector
521 * @state: the new state of an external connector.
522 * the default semantics is true: attached / false: detached.
524 * Note that this function set the state of an external connector without
525 * a notification. To synchronize the state of an external connector,
526 * have to use extcon_set_state_sync() and extcon_sync().
528 * Returns 0 if success or error number if fail.
530 int extcon_set_state(struct extcon_dev
*edev
, unsigned int id
, bool state
)
538 index
= find_cable_index_by_id(edev
, id
);
542 spin_lock_irqsave(&edev
->lock
, flags
);
544 /* Check whether the external connector's state is changed. */
545 if (!is_extcon_changed(edev
, index
, state
))
548 if (check_mutually_exclusive(edev
,
549 (edev
->state
& ~BIT(index
)) | (state
& BIT(index
)))) {
555 * Initialize the value of extcon property before setting
556 * the detached state for an external connector.
559 init_property(edev
, id
, index
);
561 /* Update the state for an external connector. */
563 edev
->state
|= BIT(index
);
565 edev
->state
&= ~(BIT(index
));
567 spin_unlock_irqrestore(&edev
->lock
, flags
);
571 EXPORT_SYMBOL_GPL(extcon_set_state
);
574 * extcon_set_state_sync() - Set the state of an external connector with sync.
575 * @edev: the extcon device
576 * @id: the unique id indicating an external connector
577 * @state: the new state of external connector.
578 * the default semantics is true: attached / false: detached.
580 * Note that this function set the state of external connector
581 * and synchronize the state by sending a notification.
583 * Returns 0 if success or error number if fail.
585 int extcon_set_state_sync(struct extcon_dev
*edev
, unsigned int id
, bool state
)
590 index
= find_cable_index_by_id(edev
, id
);
594 /* Check whether the external connector's state is changed. */
595 spin_lock_irqsave(&edev
->lock
, flags
);
596 ret
= is_extcon_changed(edev
, index
, state
);
597 spin_unlock_irqrestore(&edev
->lock
, flags
);
601 ret
= extcon_set_state(edev
, id
, state
);
605 return extcon_sync(edev
, id
);
607 EXPORT_SYMBOL_GPL(extcon_set_state_sync
);
610 * extcon_get_property() - Get the property value of an external connector.
611 * @edev: the extcon device
612 * @id: the unique id indicating an external connector
613 * @prop: the property id indicating an extcon property
614 * @prop_val: the pointer which store the value of extcon property
616 * Note that when getting the property value of external connector,
617 * the external connector should be attached. If detached state, function
618 * return 0 without property value. Also, the each property should be
619 * included in the list of supported properties according to extcon type.
621 * Returns 0 if success or error number if fail.
623 int extcon_get_property(struct extcon_dev
*edev
, unsigned int id
,
625 union extcon_property_value
*prop_val
)
627 struct extcon_cable
*cable
;
631 *prop_val
= (union extcon_property_value
)(0);
636 /* Check whether the property is supported or not */
637 if (!is_extcon_property_supported(id
, prop
))
640 /* Find the cable index of external connector by using id */
641 index
= find_cable_index_by_id(edev
, id
);
645 spin_lock_irqsave(&edev
->lock
, flags
);
647 /* Check whether the property is available or not. */
648 if (!is_extcon_property_capability(edev
, id
, index
, prop
)) {
649 spin_unlock_irqrestore(&edev
->lock
, flags
);
654 * Check whether the external connector is attached.
655 * If external connector is detached, the user can not
656 * get the property value.
658 if (!is_extcon_attached(edev
, index
)) {
659 spin_unlock_irqrestore(&edev
->lock
, flags
);
663 cable
= &edev
->cables
[index
];
665 /* Get the property value according to extcon type */
667 case EXTCON_PROP_USB_MIN
... EXTCON_PROP_USB_MAX
:
668 *prop_val
= cable
->usb_propval
[prop
- EXTCON_PROP_USB_MIN
];
670 case EXTCON_PROP_CHG_MIN
... EXTCON_PROP_CHG_MAX
:
671 *prop_val
= cable
->chg_propval
[prop
- EXTCON_PROP_CHG_MIN
];
673 case EXTCON_PROP_JACK_MIN
... EXTCON_PROP_JACK_MAX
:
674 *prop_val
= cable
->jack_propval
[prop
- EXTCON_PROP_JACK_MIN
];
676 case EXTCON_PROP_DISP_MIN
... EXTCON_PROP_DISP_MAX
:
677 *prop_val
= cable
->disp_propval
[prop
- EXTCON_PROP_DISP_MIN
];
684 spin_unlock_irqrestore(&edev
->lock
, flags
);
688 EXPORT_SYMBOL_GPL(extcon_get_property
);
691 * extcon_set_property() - Set the property value of an external connector.
692 * @edev: the extcon device
693 * @id: the unique id indicating an external connector
694 * @prop: the property id indicating an extcon property
695 * @prop_val: the pointer including the new value of extcon property
697 * Note that each property should be included in the list of supported
698 * properties according to the extcon type.
700 * Returns 0 if success or error number if fail.
702 int extcon_set_property(struct extcon_dev
*edev
, unsigned int id
,
704 union extcon_property_value prop_val
)
706 struct extcon_cable
*cable
;
713 /* Check whether the property is supported or not */
714 if (!is_extcon_property_supported(id
, prop
))
717 /* Find the cable index of external connector by using id */
718 index
= find_cable_index_by_id(edev
, id
);
722 spin_lock_irqsave(&edev
->lock
, flags
);
724 /* Check whether the property is available or not. */
725 if (!is_extcon_property_capability(edev
, id
, index
, prop
)) {
726 spin_unlock_irqrestore(&edev
->lock
, flags
);
730 cable
= &edev
->cables
[index
];
732 /* Set the property value according to extcon type */
734 case EXTCON_PROP_USB_MIN
... EXTCON_PROP_USB_MAX
:
735 cable
->usb_propval
[prop
- EXTCON_PROP_USB_MIN
] = prop_val
;
737 case EXTCON_PROP_CHG_MIN
... EXTCON_PROP_CHG_MAX
:
738 cable
->chg_propval
[prop
- EXTCON_PROP_CHG_MIN
] = prop_val
;
740 case EXTCON_PROP_JACK_MIN
... EXTCON_PROP_JACK_MAX
:
741 cable
->jack_propval
[prop
- EXTCON_PROP_JACK_MIN
] = prop_val
;
743 case EXTCON_PROP_DISP_MIN
... EXTCON_PROP_DISP_MAX
:
744 cable
->disp_propval
[prop
- EXTCON_PROP_DISP_MIN
] = prop_val
;
751 spin_unlock_irqrestore(&edev
->lock
, flags
);
755 EXPORT_SYMBOL_GPL(extcon_set_property
);
758 * extcon_set_property_sync() - Set property of an external connector with sync.
759 * @prop_val: the pointer including the new value of extcon property
761 * Note that when setting the property value of external connector,
762 * the external connector should be attached. The each property should
763 * be included in the list of supported properties according to extcon type.
765 * Returns 0 if success or error number if fail.
767 int extcon_set_property_sync(struct extcon_dev
*edev
, unsigned int id
,
769 union extcon_property_value prop_val
)
773 ret
= extcon_set_property(edev
, id
, prop
, prop_val
);
777 return extcon_sync(edev
, id
);
779 EXPORT_SYMBOL_GPL(extcon_set_property_sync
);
782 * extcon_get_property_capability() - Get the capability of the property
783 * for an external connector.
784 * @edev: the extcon device
785 * @id: the unique id indicating an external connector
786 * @prop: the property id indicating an extcon property
788 * Returns 1 if the property is available or 0 if not available.
790 int extcon_get_property_capability(struct extcon_dev
*edev
, unsigned int id
,
798 /* Check whether the property is supported or not */
799 if (!is_extcon_property_supported(id
, prop
))
802 /* Find the cable index of external connector by using id */
803 index
= find_cable_index_by_id(edev
, id
);
807 return is_extcon_property_capability(edev
, id
, index
, prop
);
809 EXPORT_SYMBOL_GPL(extcon_get_property_capability
);
812 * extcon_set_property_capability() - Set the capability of the property
813 * for an external connector.
814 * @edev: the extcon device
815 * @id: the unique id indicating an external connector
816 * @prop: the property id indicating an extcon property
818 * Note that this function set the capability of the property
819 * for an external connector in order to mark the bit in capability
820 * bitmap which mean the available state of the property.
822 * Returns 0 if success or error number if fail.
824 int extcon_set_property_capability(struct extcon_dev
*edev
, unsigned int id
,
827 struct extcon_cable
*cable
;
828 int index
, type
, ret
= 0;
833 /* Check whether the property is supported or not. */
834 if (!is_extcon_property_supported(id
, prop
))
837 /* Find the cable index of external connector by using id. */
838 index
= find_cable_index_by_id(edev
, id
);
842 type
= get_extcon_type(prop
);
846 cable
= &edev
->cables
[index
];
849 case EXTCON_TYPE_USB
:
850 __set_bit(prop
- EXTCON_PROP_USB_MIN
, cable
->usb_bits
);
852 case EXTCON_TYPE_CHG
:
853 __set_bit(prop
- EXTCON_PROP_CHG_MIN
, cable
->chg_bits
);
855 case EXTCON_TYPE_JACK
:
856 __set_bit(prop
- EXTCON_PROP_JACK_MIN
, cable
->jack_bits
);
858 case EXTCON_TYPE_DISP
:
859 __set_bit(prop
- EXTCON_PROP_DISP_MIN
, cable
->disp_bits
);
867 EXPORT_SYMBOL_GPL(extcon_set_property_capability
);
870 * extcon_get_extcon_dev() - Get the extcon device instance from the name.
871 * @extcon_name: the extcon name provided with extcon_dev_register()
873 * Return the pointer of extcon device if success or ERR_PTR(err) if fail.
875 struct extcon_dev
*extcon_get_extcon_dev(const char *extcon_name
)
877 struct extcon_dev
*sd
;
880 return ERR_PTR(-EINVAL
);
882 mutex_lock(&extcon_dev_list_lock
);
883 list_for_each_entry(sd
, &extcon_dev_list
, entry
) {
884 if (!strcmp(sd
->name
, extcon_name
))
889 mutex_unlock(&extcon_dev_list_lock
);
892 EXPORT_SYMBOL_GPL(extcon_get_extcon_dev
);
895 * extcon_register_notifier() - Register a notifier block to get notified by
896 * any state changes from the extcon.
897 * @edev: the extcon device
898 * @id: the unique id indicating an external connector
899 * @nb: a notifier block to be registered
901 * Note that the second parameter given to the callback of nb (val) is
902 * the current state of an external connector and the third pameter
903 * is the pointer of extcon device.
905 * Returns 0 if success or error number if fail.
907 int extcon_register_notifier(struct extcon_dev
*edev
, unsigned int id
,
908 struct notifier_block
*nb
)
911 int ret
, idx
= -EINVAL
;
916 idx
= find_cable_index_by_id(edev
, id
);
920 spin_lock_irqsave(&edev
->lock
, flags
);
921 ret
= raw_notifier_chain_register(&edev
->nh
[idx
], nb
);
922 spin_unlock_irqrestore(&edev
->lock
, flags
);
926 EXPORT_SYMBOL_GPL(extcon_register_notifier
);
929 * extcon_unregister_notifier() - Unregister a notifier block from the extcon.
930 * @edev: the extcon device
931 * @id: the unique id indicating an external connector
932 * @nb: a notifier block to be registered
934 * Returns 0 if success or error number if fail.
936 int extcon_unregister_notifier(struct extcon_dev
*edev
, unsigned int id
,
937 struct notifier_block
*nb
)
945 idx
= find_cable_index_by_id(edev
, id
);
949 spin_lock_irqsave(&edev
->lock
, flags
);
950 ret
= raw_notifier_chain_unregister(&edev
->nh
[idx
], nb
);
951 spin_unlock_irqrestore(&edev
->lock
, flags
);
955 EXPORT_SYMBOL_GPL(extcon_unregister_notifier
);
958 * extcon_register_notifier_all() - Register a notifier block for all connectors.
959 * @edev: the extcon device
960 * @nb: a notifier block to be registered
962 * Note that this function registers a notifier block in order to receive
963 * the state change of all supported external connectors from extcon device.
964 * And the second parameter given to the callback of nb (val) is
965 * the current state and the third pameter is the pointer of extcon device.
967 * Returns 0 if success or error number if fail.
969 int extcon_register_notifier_all(struct extcon_dev
*edev
,
970 struct notifier_block
*nb
)
978 spin_lock_irqsave(&edev
->lock
, flags
);
979 ret
= raw_notifier_chain_register(&edev
->nh_all
, nb
);
980 spin_unlock_irqrestore(&edev
->lock
, flags
);
984 EXPORT_SYMBOL_GPL(extcon_register_notifier_all
);
987 * extcon_unregister_notifier_all() - Unregister a notifier block from extcon.
988 * @edev: the extcon device
989 * @nb: a notifier block to be registered
991 * Returns 0 if success or error number if fail.
993 int extcon_unregister_notifier_all(struct extcon_dev
*edev
,
994 struct notifier_block
*nb
)
1002 spin_lock_irqsave(&edev
->lock
, flags
);
1003 ret
= raw_notifier_chain_unregister(&edev
->nh_all
, nb
);
1004 spin_unlock_irqrestore(&edev
->lock
, flags
);
1008 EXPORT_SYMBOL_GPL(extcon_unregister_notifier_all
);
1010 static struct attribute
*extcon_attrs
[] = {
1011 &dev_attr_state
.attr
,
1012 &dev_attr_name
.attr
,
1015 ATTRIBUTE_GROUPS(extcon
);
1017 static int create_extcon_class(void)
1019 if (!extcon_class
) {
1020 extcon_class
= class_create(THIS_MODULE
, "extcon");
1021 if (IS_ERR(extcon_class
))
1022 return PTR_ERR(extcon_class
);
1023 extcon_class
->dev_groups
= extcon_groups
;
1029 static void extcon_dev_release(struct device
*dev
)
1033 static const char *muex_name
= "mutually_exclusive";
1034 static void dummy_sysfs_dev_release(struct device
*dev
)
1039 * extcon_dev_allocate() - Allocate the memory of extcon device.
1040 * @supported_cable: the array of the supported external connectors
1041 * ending with EXTCON_NONE.
1043 * Note that this function allocates the memory for extcon device
1044 * and initialize default setting for the extcon device.
1046 * Returns the pointer memory of allocated extcon_dev if success
1047 * or ERR_PTR(err) if fail.
1049 struct extcon_dev
*extcon_dev_allocate(const unsigned int *supported_cable
)
1051 struct extcon_dev
*edev
;
1053 if (!supported_cable
)
1054 return ERR_PTR(-EINVAL
);
1056 edev
= kzalloc(sizeof(*edev
), GFP_KERNEL
);
1058 return ERR_PTR(-ENOMEM
);
1060 edev
->max_supported
= 0;
1061 edev
->supported_cable
= supported_cable
;
1067 * extcon_dev_free() - Free the memory of extcon device.
1068 * @edev: the extcon device
1070 void extcon_dev_free(struct extcon_dev
*edev
)
1074 EXPORT_SYMBOL_GPL(extcon_dev_free
);
1077 * extcon_dev_register() - Register an new extcon device
1078 * @edev: the extcon device to be registered
1080 * Among the members of edev struct, please set the "user initializing data"
1081 * do not set the values of "internal data", which are initialized by
1084 * Note that before calling this funciton, have to allocate the memory
1085 * of an extcon device by using the extcon_dev_allocate(). And the extcon
1086 * dev should include the supported_cable information.
1088 * Returns 0 if success or error number if fail.
1090 int extcon_dev_register(struct extcon_dev
*edev
)
1093 static atomic_t edev_no
= ATOMIC_INIT(-1);
1095 if (!extcon_class
) {
1096 ret
= create_extcon_class();
1101 if (!edev
|| !edev
->supported_cable
)
1104 for (; edev
->supported_cable
[index
] != EXTCON_NONE
; index
++);
1106 edev
->max_supported
= index
;
1107 if (index
> SUPPORTED_CABLE_MAX
) {
1109 "exceed the maximum number of supported cables\n");
1113 edev
->dev
.class = extcon_class
;
1114 edev
->dev
.release
= extcon_dev_release
;
1116 edev
->name
= dev_name(edev
->dev
.parent
);
1117 if (IS_ERR_OR_NULL(edev
->name
)) {
1119 "extcon device name is null\n");
1122 dev_set_name(&edev
->dev
, "extcon%lu",
1123 (unsigned long)atomic_inc_return(&edev_no
));
1125 if (edev
->max_supported
) {
1128 struct extcon_cable
*cable
;
1130 edev
->cables
= kcalloc(edev
->max_supported
,
1131 sizeof(struct extcon_cable
),
1133 if (!edev
->cables
) {
1135 goto err_sysfs_alloc
;
1137 for (index
= 0; index
< edev
->max_supported
; index
++) {
1138 cable
= &edev
->cables
[index
];
1140 snprintf(buf
, 10, "cable.%d", index
);
1141 str
= kzalloc(strlen(buf
) + 1,
1144 for (index
--; index
>= 0; index
--) {
1145 cable
= &edev
->cables
[index
];
1146 kfree(cable
->attr_g
.name
);
1150 goto err_alloc_cables
;
1155 cable
->cable_index
= index
;
1156 cable
->attrs
[0] = &cable
->attr_name
.attr
;
1157 cable
->attrs
[1] = &cable
->attr_state
.attr
;
1158 cable
->attrs
[2] = NULL
;
1159 cable
->attr_g
.name
= str
;
1160 cable
->attr_g
.attrs
= cable
->attrs
;
1162 sysfs_attr_init(&cable
->attr_name
.attr
);
1163 cable
->attr_name
.attr
.name
= "name";
1164 cable
->attr_name
.attr
.mode
= 0444;
1165 cable
->attr_name
.show
= cable_name_show
;
1167 sysfs_attr_init(&cable
->attr_state
.attr
);
1168 cable
->attr_state
.attr
.name
= "state";
1169 cable
->attr_state
.attr
.mode
= 0444;
1170 cable
->attr_state
.show
= cable_state_show
;
1174 if (edev
->max_supported
&& edev
->mutually_exclusive
) {
1178 /* Count the size of mutually_exclusive array */
1179 for (index
= 0; edev
->mutually_exclusive
[index
]; index
++)
1182 edev
->attrs_muex
= kcalloc(index
+ 1,
1183 sizeof(struct attribute
*),
1185 if (!edev
->attrs_muex
) {
1190 edev
->d_attrs_muex
= kcalloc(index
,
1191 sizeof(struct device_attribute
),
1193 if (!edev
->d_attrs_muex
) {
1195 kfree(edev
->attrs_muex
);
1199 for (index
= 0; edev
->mutually_exclusive
[index
]; index
++) {
1200 sprintf(buf
, "0x%x", edev
->mutually_exclusive
[index
]);
1201 name
= kzalloc(strlen(buf
) + 1,
1204 for (index
--; index
>= 0; index
--) {
1205 kfree(edev
->d_attrs_muex
[index
].attr
.
1208 kfree(edev
->d_attrs_muex
);
1209 kfree(edev
->attrs_muex
);
1214 sysfs_attr_init(&edev
->d_attrs_muex
[index
].attr
);
1215 edev
->d_attrs_muex
[index
].attr
.name
= name
;
1216 edev
->d_attrs_muex
[index
].attr
.mode
= 0000;
1217 edev
->attrs_muex
[index
] = &edev
->d_attrs_muex
[index
]
1220 edev
->attr_g_muex
.name
= muex_name
;
1221 edev
->attr_g_muex
.attrs
= edev
->attrs_muex
;
1225 if (edev
->max_supported
) {
1226 edev
->extcon_dev_type
.groups
=
1227 kcalloc(edev
->max_supported
+ 2,
1228 sizeof(struct attribute_group
*),
1230 if (!edev
->extcon_dev_type
.groups
) {
1232 goto err_alloc_groups
;
1235 edev
->extcon_dev_type
.name
= dev_name(&edev
->dev
);
1236 edev
->extcon_dev_type
.release
= dummy_sysfs_dev_release
;
1238 for (index
= 0; index
< edev
->max_supported
; index
++)
1239 edev
->extcon_dev_type
.groups
[index
] =
1240 &edev
->cables
[index
].attr_g
;
1241 if (edev
->mutually_exclusive
)
1242 edev
->extcon_dev_type
.groups
[index
] =
1245 edev
->dev
.type
= &edev
->extcon_dev_type
;
1248 ret
= device_register(&edev
->dev
);
1250 put_device(&edev
->dev
);
1254 spin_lock_init(&edev
->lock
);
1255 edev
->nh
= devm_kcalloc(&edev
->dev
, edev
->max_supported
,
1256 sizeof(*edev
->nh
), GFP_KERNEL
);
1262 for (index
= 0; index
< edev
->max_supported
; index
++)
1263 RAW_INIT_NOTIFIER_HEAD(&edev
->nh
[index
]);
1265 RAW_INIT_NOTIFIER_HEAD(&edev
->nh_all
);
1267 dev_set_drvdata(&edev
->dev
, edev
);
1270 mutex_lock(&extcon_dev_list_lock
);
1271 list_add(&edev
->entry
, &extcon_dev_list
);
1272 mutex_unlock(&extcon_dev_list_lock
);
1277 if (edev
->max_supported
)
1278 kfree(edev
->extcon_dev_type
.groups
);
1280 if (edev
->max_supported
&& edev
->mutually_exclusive
) {
1281 for (index
= 0; edev
->mutually_exclusive
[index
]; index
++)
1282 kfree(edev
->d_attrs_muex
[index
].attr
.name
);
1283 kfree(edev
->d_attrs_muex
);
1284 kfree(edev
->attrs_muex
);
1287 for (index
= 0; index
< edev
->max_supported
; index
++)
1288 kfree(edev
->cables
[index
].attr_g
.name
);
1290 if (edev
->max_supported
)
1291 kfree(edev
->cables
);
1295 EXPORT_SYMBOL_GPL(extcon_dev_register
);
1298 * extcon_dev_unregister() - Unregister the extcon device.
1299 * @edev: the extcon device to be unregistered.
1301 * Note that this does not call kfree(edev) because edev was not allocated
1304 void extcon_dev_unregister(struct extcon_dev
*edev
)
1311 mutex_lock(&extcon_dev_list_lock
);
1312 list_del(&edev
->entry
);
1313 mutex_unlock(&extcon_dev_list_lock
);
1315 if (IS_ERR_OR_NULL(get_device(&edev
->dev
))) {
1316 dev_err(&edev
->dev
, "Failed to unregister extcon_dev (%s)\n",
1317 dev_name(&edev
->dev
));
1321 device_unregister(&edev
->dev
);
1323 if (edev
->mutually_exclusive
&& edev
->max_supported
) {
1324 for (index
= 0; edev
->mutually_exclusive
[index
];
1326 kfree(edev
->d_attrs_muex
[index
].attr
.name
);
1327 kfree(edev
->d_attrs_muex
);
1328 kfree(edev
->attrs_muex
);
1331 for (index
= 0; index
< edev
->max_supported
; index
++)
1332 kfree(edev
->cables
[index
].attr_g
.name
);
1334 if (edev
->max_supported
) {
1335 kfree(edev
->extcon_dev_type
.groups
);
1336 kfree(edev
->cables
);
1339 put_device(&edev
->dev
);
1341 EXPORT_SYMBOL_GPL(extcon_dev_unregister
);
1346 * extcon_find_edev_by_node - Find the extcon device from devicetree.
1347 * @node : OF node identifying edev
1349 * Return the pointer of extcon device if success or ERR_PTR(err) if fail.
1351 struct extcon_dev
*extcon_find_edev_by_node(struct device_node
*node
)
1353 struct extcon_dev
*edev
;
1355 mutex_lock(&extcon_dev_list_lock
);
1356 list_for_each_entry(edev
, &extcon_dev_list
, entry
)
1357 if (edev
->dev
.parent
&& edev
->dev
.parent
->of_node
== node
)
1359 edev
= ERR_PTR(-EPROBE_DEFER
);
1361 mutex_unlock(&extcon_dev_list_lock
);
1367 * extcon_get_edev_by_phandle - Get the extcon device from devicetree.
1368 * @dev : the instance to the given device
1369 * @index : the index into list of extcon_dev
1371 * Return the pointer of extcon device if success or ERR_PTR(err) if fail.
1373 struct extcon_dev
*extcon_get_edev_by_phandle(struct device
*dev
, int index
)
1375 struct device_node
*node
;
1376 struct extcon_dev
*edev
;
1379 return ERR_PTR(-EINVAL
);
1381 if (!dev
->of_node
) {
1382 dev_dbg(dev
, "device does not have a device node entry\n");
1383 return ERR_PTR(-EINVAL
);
1386 node
= of_parse_phandle(dev
->of_node
, "extcon", index
);
1388 dev_dbg(dev
, "failed to get phandle in %pOF node\n",
1390 return ERR_PTR(-ENODEV
);
1393 edev
= extcon_find_edev_by_node(node
);
1401 struct extcon_dev
*extcon_find_edev_by_node(struct device_node
*node
)
1403 return ERR_PTR(-ENOSYS
);
1406 struct extcon_dev
*extcon_get_edev_by_phandle(struct device
*dev
, int index
)
1408 return ERR_PTR(-ENOSYS
);
1411 #endif /* CONFIG_OF */
1413 EXPORT_SYMBOL_GPL(extcon_find_edev_by_node
);
1414 EXPORT_SYMBOL_GPL(extcon_get_edev_by_phandle
);
1417 * extcon_get_edev_name() - Get the name of the extcon device.
1418 * @edev: the extcon device
1420 const char *extcon_get_edev_name(struct extcon_dev
*edev
)
1422 return !edev
? NULL
: edev
->name
;
1425 static int __init
extcon_class_init(void)
1427 return create_extcon_class();
1429 module_init(extcon_class_init
);
1431 static void __exit
extcon_class_exit(void)
1433 class_destroy(extcon_class
);
1435 module_exit(extcon_class_exit
);
1437 MODULE_AUTHOR("Chanwoo Choi <cw00.choi@samsung.com>");
1438 MODULE_AUTHOR("MyungJoo Ham <myungjoo.ham@samsung.com>");
1439 MODULE_DESCRIPTION("External Connector (extcon) framework");
1440 MODULE_LICENSE("GPL v2");