2 * drivers/extcon/extcon_class.c
4 * External connector (extcon) class driver
6 * Copyright (C) 2012 Samsung Electronics
7 * Author: Donggeun Kim <dg77.kim@samsung.com>
8 * Author: MyungJoo Ham <myungjoo.ham@samsung.com>
10 * based on android/drivers/switch/switch_class.c
11 * Copyright (C) 2008 Google, Inc.
12 * Author: Mike Lockwood <lockwood@android.com>
14 * This software is licensed under the terms of the GNU General Public
15 * License version 2, as published by the Free Software Foundation, and
16 * may be copied, distributed, and modified under those terms.
18 * This program is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 * 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>
31 #include <linux/extcon.h>
33 #include <linux/slab.h>
34 #include <linux/sysfs.h>
38 * extcon_cable_name suggests the standard cable names for commonly used
41 * However, please do not use extcon_cable_name directly for extcon_dev
42 * struct's supported_cable pointer unless your device really supports
43 * every single port-type of the following cable names. Please choose cable
44 * names that are actually used in your extcon device.
46 const char extcon_cable_name
[][CABLE_NAME_MAX
+ 1] = {
48 [EXTCON_USB_HOST
] = "USB-Host",
50 [EXTCON_FAST_CHARGER
] = "Fast-charger",
51 [EXTCON_SLOW_CHARGER
] = "Slow-charger",
52 [EXTCON_CHARGE_DOWNSTREAM
] = "Charge-downstream",
53 [EXTCON_HDMI
] = "HDMI",
57 [EXTCON_DOCK
] = "Dock",
58 [EXTCON_LINE_IN
] = "Line-in",
59 [EXTCON_LINE_OUT
] = "Line-out",
60 [EXTCON_MIC_IN
] = "Microphone",
61 [EXTCON_HEADPHONE_OUT
] = "Headphone",
62 [EXTCON_SPDIF_IN
] = "SPDIF-in",
63 [EXTCON_SPDIF_OUT
] = "SPDIF-out",
64 [EXTCON_VIDEO_IN
] = "Video-in",
65 [EXTCON_VIDEO_OUT
] = "Video-out",
66 [EXTCON_MECHANICAL
] = "Mechanical",
69 static struct class *extcon_class
;
70 #if defined(CONFIG_ANDROID)
71 static struct class_compat
*switch_class
;
72 #endif /* CONFIG_ANDROID */
74 static LIST_HEAD(extcon_dev_list
);
75 static DEFINE_MUTEX(extcon_dev_list_lock
);
78 * check_mutually_exclusive - Check if new_state violates mutually_exclusive
80 * @edev: the extcon device
81 * @new_state: new cable attach status for @edev
83 * Returns 0 if nothing violates. Returns the index + 1 for the first
86 static int check_mutually_exclusive(struct extcon_dev
*edev
, u32 new_state
)
90 if (!edev
->mutually_exclusive
)
93 for (i
= 0; edev
->mutually_exclusive
[i
]; i
++) {
95 u32 correspondants
= new_state
& edev
->mutually_exclusive
[i
];
97 /* calculate the total number of bits set */
98 weight
= hweight32(correspondants
);
106 static ssize_t
state_show(struct device
*dev
, struct device_attribute
*attr
,
110 struct extcon_dev
*edev
= dev_get_drvdata(dev
);
112 if (edev
->print_state
) {
113 int ret
= edev
->print_state(edev
, buf
);
117 /* Use default if failed */
120 if (edev
->max_supported
== 0)
121 return sprintf(buf
, "%u\n", edev
->state
);
123 for (i
= 0; i
< SUPPORTED_CABLE_MAX
; i
++) {
124 if (!edev
->supported_cable
[i
])
126 count
+= sprintf(buf
+ count
, "%s=%d\n",
127 edev
->supported_cable
[i
],
128 !!(edev
->state
& (1 << i
)));
134 static ssize_t
state_store(struct device
*dev
, struct device_attribute
*attr
,
135 const char *buf
, size_t count
)
139 struct extcon_dev
*edev
= dev_get_drvdata(dev
);
141 ret
= sscanf(buf
, "0x%x", &state
);
145 ret
= extcon_set_state(edev
, state
);
152 static DEVICE_ATTR_RW(state
);
154 static ssize_t
name_show(struct device
*dev
, struct device_attribute
*attr
,
157 struct extcon_dev
*edev
= dev_get_drvdata(dev
);
159 /* Optional callback given by the user */
160 if (edev
->print_name
) {
161 int ret
= edev
->print_name(edev
, buf
);
166 return sprintf(buf
, "%s\n", dev_name(&edev
->dev
));
168 static DEVICE_ATTR_RO(name
);
170 static ssize_t
cable_name_show(struct device
*dev
,
171 struct device_attribute
*attr
, char *buf
)
173 struct extcon_cable
*cable
= container_of(attr
, struct extcon_cable
,
176 return sprintf(buf
, "%s\n",
177 cable
->edev
->supported_cable
[cable
->cable_index
]);
180 static ssize_t
cable_state_show(struct device
*dev
,
181 struct device_attribute
*attr
, char *buf
)
183 struct extcon_cable
*cable
= container_of(attr
, struct extcon_cable
,
186 return sprintf(buf
, "%d\n",
187 extcon_get_cable_state_(cable
->edev
,
188 cable
->cable_index
));
192 * extcon_update_state() - Update the cable attach states of the extcon device
193 * only for the masked bits.
194 * @edev: the extcon device
195 * @mask: the bit mask to designate updated bits.
196 * @state: new cable attach status for @edev
198 * Changing the state sends uevent with environment variable containing
199 * the name of extcon device (envp[0]) and the state output (envp[1]).
200 * Tizen uses this format for extcon device to get events from ports.
201 * Android uses this format as well.
203 * Note that the notifier provides which bits are changed in the state
204 * variable with the val parameter (second) to the callback.
206 int extcon_update_state(struct extcon_dev
*edev
, u32 mask
, u32 state
)
216 spin_lock_irqsave(&edev
->lock
, flags
);
218 if (edev
->state
!= ((edev
->state
& ~mask
) | (state
& mask
))) {
219 u32 old_state
= edev
->state
;
221 if (check_mutually_exclusive(edev
, (edev
->state
& ~mask
) |
223 spin_unlock_irqrestore(&edev
->lock
, flags
);
227 edev
->state
&= ~mask
;
228 edev
->state
|= state
& mask
;
230 raw_notifier_call_chain(&edev
->nh
, old_state
, edev
);
231 /* This could be in interrupt handler */
232 prop_buf
= (char *)get_zeroed_page(GFP_ATOMIC
);
234 length
= name_show(&edev
->dev
, NULL
, prop_buf
);
236 if (prop_buf
[length
- 1] == '\n')
237 prop_buf
[length
- 1] = 0;
238 snprintf(name_buf
, sizeof(name_buf
),
239 "NAME=%s", prop_buf
);
240 envp
[env_offset
++] = name_buf
;
242 length
= state_show(&edev
->dev
, NULL
, prop_buf
);
244 if (prop_buf
[length
- 1] == '\n')
245 prop_buf
[length
- 1] = 0;
246 snprintf(state_buf
, sizeof(state_buf
),
247 "STATE=%s", prop_buf
);
248 envp
[env_offset
++] = state_buf
;
250 envp
[env_offset
] = NULL
;
251 /* Unlock early before uevent */
252 spin_unlock_irqrestore(&edev
->lock
, flags
);
254 kobject_uevent_env(&edev
->dev
.kobj
, KOBJ_CHANGE
, envp
);
255 free_page((unsigned long)prop_buf
);
257 /* Unlock early before uevent */
258 spin_unlock_irqrestore(&edev
->lock
, flags
);
260 dev_err(&edev
->dev
, "out of memory in extcon_set_state\n");
261 kobject_uevent(&edev
->dev
.kobj
, KOBJ_CHANGE
);
265 spin_unlock_irqrestore(&edev
->lock
, flags
);
270 EXPORT_SYMBOL_GPL(extcon_update_state
);
273 * extcon_set_state() - Set the cable attach states of the extcon device.
274 * @edev: the extcon device
275 * @state: new cable attach status for @edev
277 * Note that notifier provides which bits are changed in the state
278 * variable with the val parameter (second) to the callback.
280 int extcon_set_state(struct extcon_dev
*edev
, u32 state
)
282 return extcon_update_state(edev
, 0xffffffff, state
);
284 EXPORT_SYMBOL_GPL(extcon_set_state
);
287 * extcon_find_cable_index() - Get the cable index based on the cable name.
288 * @edev: the extcon device that has the cable.
289 * @cable_name: cable name to be searched.
291 * Note that accessing a cable state based on cable_index is faster than
292 * cable_name because using cable_name induces a loop with strncmp().
293 * Thus, when get/set_cable_state is repeatedly used, using cable_index
296 int extcon_find_cable_index(struct extcon_dev
*edev
, const char *cable_name
)
300 if (edev
->supported_cable
) {
301 for (i
= 0; edev
->supported_cable
[i
]; i
++) {
302 if (!strncmp(edev
->supported_cable
[i
],
303 cable_name
, CABLE_NAME_MAX
))
310 EXPORT_SYMBOL_GPL(extcon_find_cable_index
);
313 * extcon_get_cable_state_() - Get the status of a specific cable.
314 * @edev: the extcon device that has the cable.
315 * @index: cable index that can be retrieved by extcon_find_cable_index().
317 int extcon_get_cable_state_(struct extcon_dev
*edev
, int index
)
319 if (index
< 0 || (edev
->max_supported
&& edev
->max_supported
<= index
))
322 return !!(edev
->state
& (1 << index
));
324 EXPORT_SYMBOL_GPL(extcon_get_cable_state_
);
327 * extcon_get_cable_state() - Get the status of a specific cable.
328 * @edev: the extcon device that has the cable.
329 * @cable_name: cable name.
331 * Note that this is slower than extcon_get_cable_state_.
333 int extcon_get_cable_state(struct extcon_dev
*edev
, const char *cable_name
)
335 return extcon_get_cable_state_(edev
, extcon_find_cable_index
338 EXPORT_SYMBOL_GPL(extcon_get_cable_state
);
341 * extcon_set_cable_state_() - Set the status of a specific cable.
342 * @edev: the extcon device that has the cable.
343 * @index: cable index that can be retrieved by
344 * extcon_find_cable_index().
345 * @cable_state: the new cable status. The default semantics is
346 * true: attached / false: detached.
348 int extcon_set_cable_state_(struct extcon_dev
*edev
,
349 int index
, bool cable_state
)
353 if (index
< 0 || (edev
->max_supported
&& edev
->max_supported
<= index
))
356 state
= cable_state
? (1 << index
) : 0;
357 return extcon_update_state(edev
, 1 << index
, state
);
359 EXPORT_SYMBOL_GPL(extcon_set_cable_state_
);
362 * extcon_set_cable_state() - Set the status of a specific cable.
363 * @edev: the extcon device that has the cable.
364 * @cable_name: cable name.
365 * @cable_state: the new cable status. The default semantics is
366 * true: attached / false: detached.
368 * Note that this is slower than extcon_set_cable_state_.
370 int extcon_set_cable_state(struct extcon_dev
*edev
,
371 const char *cable_name
, bool cable_state
)
373 return extcon_set_cable_state_(edev
, extcon_find_cable_index
374 (edev
, cable_name
), cable_state
);
376 EXPORT_SYMBOL_GPL(extcon_set_cable_state
);
379 * extcon_get_extcon_dev() - Get the extcon device instance from the name
380 * @extcon_name: The extcon name provided with extcon_dev_register()
382 struct extcon_dev
*extcon_get_extcon_dev(const char *extcon_name
)
384 struct extcon_dev
*sd
;
386 mutex_lock(&extcon_dev_list_lock
);
387 list_for_each_entry(sd
, &extcon_dev_list
, entry
) {
388 if (!strcmp(sd
->name
, extcon_name
))
393 mutex_unlock(&extcon_dev_list_lock
);
396 EXPORT_SYMBOL_GPL(extcon_get_extcon_dev
);
398 static int _call_per_cable(struct notifier_block
*nb
, unsigned long val
,
401 struct extcon_specific_cable_nb
*obj
= container_of(nb
,
402 struct extcon_specific_cable_nb
, internal_nb
);
403 struct extcon_dev
*edev
= ptr
;
405 if ((val
& (1 << obj
->cable_index
)) !=
406 (edev
->state
& (1 << obj
->cable_index
))) {
407 bool cable_state
= true;
409 obj
->previous_value
= val
;
411 if (val
& (1 << obj
->cable_index
))
414 return obj
->user_nb
->notifier_call(obj
->user_nb
,
422 * extcon_register_interest() - Register a notifier for a state change of a
423 * specific cable, not an entier set of cables of a
425 * @obj: an empty extcon_specific_cable_nb object to be returned.
426 * @extcon_name: the name of extcon device.
427 * if NULL, extcon_register_interest will register
428 * every cable with the target cable_name given.
429 * @cable_name: the target cable name.
430 * @nb: the notifier block to get notified.
432 * Provide an empty extcon_specific_cable_nb. extcon_register_interest() sets
433 * the struct for you.
435 * extcon_register_interest is a helper function for those who want to get
436 * notification for a single specific cable's status change. If a user wants
437 * to get notification for any changes of all cables of a extcon device,
438 * he/she should use the general extcon_register_notifier().
440 * Note that the second parameter given to the callback of nb (val) is
441 * "old_state", not the current state. The current state can be retrieved
442 * by looking at the third pameter (edev pointer)'s state value.
444 int extcon_register_interest(struct extcon_specific_cable_nb
*obj
,
445 const char *extcon_name
, const char *cable_name
,
446 struct notifier_block
*nb
)
448 if (!obj
|| !cable_name
|| !nb
)
452 obj
->edev
= extcon_get_extcon_dev(extcon_name
);
456 obj
->cable_index
= extcon_find_cable_index(obj
->edev
,
458 if (obj
->cable_index
< 0)
459 return obj
->cable_index
;
463 obj
->internal_nb
.notifier_call
= _call_per_cable
;
465 return raw_notifier_chain_register(&obj
->edev
->nh
,
468 struct class_dev_iter iter
;
469 struct extcon_dev
*extd
;
474 class_dev_iter_init(&iter
, extcon_class
, NULL
, NULL
);
475 while ((dev
= class_dev_iter_next(&iter
))) {
476 extd
= dev_get_drvdata(dev
);
478 if (extcon_find_cable_index(extd
, cable_name
) < 0)
481 class_dev_iter_exit(&iter
);
482 return extcon_register_interest(obj
, extd
->name
,
489 EXPORT_SYMBOL_GPL(extcon_register_interest
);
492 * extcon_unregister_interest() - Unregister the notifier registered by
493 * extcon_register_interest().
494 * @obj: the extcon_specific_cable_nb object returned by
495 * extcon_register_interest().
497 int extcon_unregister_interest(struct extcon_specific_cable_nb
*obj
)
502 return raw_notifier_chain_unregister(&obj
->edev
->nh
, &obj
->internal_nb
);
504 EXPORT_SYMBOL_GPL(extcon_unregister_interest
);
507 * extcon_register_notifier() - Register a notifiee to get notified by
508 * any attach status changes from the extcon.
509 * @edev: the extcon device.
510 * @nb: a notifier block to be registered.
512 * Note that the second parameter given to the callback of nb (val) is
513 * "old_state", not the current state. The current state can be retrieved
514 * by looking at the third pameter (edev pointer)'s state value.
516 int extcon_register_notifier(struct extcon_dev
*edev
,
517 struct notifier_block
*nb
)
519 return raw_notifier_chain_register(&edev
->nh
, nb
);
521 EXPORT_SYMBOL_GPL(extcon_register_notifier
);
524 * extcon_unregister_notifier() - Unregister a notifiee from the extcon device.
525 * @edev: the extcon device.
526 * @nb: a registered notifier block to be unregistered.
528 int extcon_unregister_notifier(struct extcon_dev
*edev
,
529 struct notifier_block
*nb
)
531 return raw_notifier_chain_unregister(&edev
->nh
, nb
);
533 EXPORT_SYMBOL_GPL(extcon_unregister_notifier
);
535 static struct attribute
*extcon_attrs
[] = {
536 &dev_attr_state
.attr
,
540 ATTRIBUTE_GROUPS(extcon
);
542 static int create_extcon_class(void)
545 extcon_class
= class_create(THIS_MODULE
, "extcon");
546 if (IS_ERR(extcon_class
))
547 return PTR_ERR(extcon_class
);
548 extcon_class
->dev_groups
= extcon_groups
;
550 #if defined(CONFIG_ANDROID)
551 switch_class
= class_compat_register("switch");
552 if (WARN(!switch_class
, "cannot allocate"))
554 #endif /* CONFIG_ANDROID */
560 static void extcon_dev_release(struct device
*dev
)
564 static const char *muex_name
= "mutually_exclusive";
565 static void dummy_sysfs_dev_release(struct device
*dev
)
570 * extcon_dev_allocate() - Allocate the memory of extcon device.
571 * @supported_cable: Array of supported cable names ending with NULL.
572 * If supported_cable is NULL, cable name related APIs
575 * This function allocates the memory for extcon device without allocating
576 * memory in each extcon provider driver and initialize default setting for
579 * Return the pointer of extcon device if success or ERR_PTR(err) if fail
581 struct extcon_dev
*extcon_dev_allocate(const char **supported_cable
)
583 struct extcon_dev
*edev
;
585 edev
= kzalloc(sizeof(*edev
), GFP_KERNEL
);
587 return ERR_PTR(-ENOMEM
);
589 edev
->max_supported
= 0;
590 edev
->supported_cable
= supported_cable
;
596 * extcon_dev_free() - Free the memory of extcon device.
597 * @edev: the extcon device to free
599 void extcon_dev_free(struct extcon_dev
*edev
)
603 EXPORT_SYMBOL_GPL(extcon_dev_free
);
605 static int devm_extcon_dev_match(struct device
*dev
, void *res
, void *data
)
607 struct extcon_dev
**r
= res
;
609 if (WARN_ON(!r
|| !*r
))
615 static void devm_extcon_dev_release(struct device
*dev
, void *res
)
617 extcon_dev_free(*(struct extcon_dev
**)res
);
621 * devm_extcon_dev_allocate - Allocate managed extcon device
622 * @dev: device owning the extcon device being created
623 * @supported_cable: Array of supported cable names ending with NULL.
624 * If supported_cable is NULL, cable name related APIs
627 * This function manages automatically the memory of extcon device using device
628 * resource management and simplify the control of freeing the memory of extcon
631 * Returns the pointer memory of allocated extcon_dev if success
632 * or ERR_PTR(err) if fail
634 struct extcon_dev
*devm_extcon_dev_allocate(struct device
*dev
,
635 const char **supported_cable
)
637 struct extcon_dev
**ptr
, *edev
;
639 ptr
= devres_alloc(devm_extcon_dev_release
, sizeof(*ptr
), GFP_KERNEL
);
641 return ERR_PTR(-ENOMEM
);
643 edev
= extcon_dev_allocate(supported_cable
);
649 edev
->dev
.parent
= dev
;
652 devres_add(dev
, ptr
);
656 EXPORT_SYMBOL_GPL(devm_extcon_dev_allocate
);
658 void devm_extcon_dev_free(struct device
*dev
, struct extcon_dev
*edev
)
660 WARN_ON(devres_release(dev
, devm_extcon_dev_release
,
661 devm_extcon_dev_match
, edev
));
663 EXPORT_SYMBOL_GPL(devm_extcon_dev_free
);
666 * extcon_dev_register() - Register a new extcon device
667 * @edev : the new extcon device (should be allocated before calling)
669 * Among the members of edev struct, please set the "user initializing data"
670 * in any case and set the "optional callbacks" if required. However, please
671 * do not set the values of "internal data", which are initialized by
674 int extcon_dev_register(struct extcon_dev
*edev
)
679 ret
= create_extcon_class();
684 if (edev
->supported_cable
) {
685 /* Get size of array */
686 for (index
= 0; edev
->supported_cable
[index
]; index
++)
688 edev
->max_supported
= index
;
690 edev
->max_supported
= 0;
693 if (index
> SUPPORTED_CABLE_MAX
) {
694 dev_err(&edev
->dev
, "extcon: maximum number of supported cables exceeded.\n");
698 edev
->dev
.class = extcon_class
;
699 edev
->dev
.release
= extcon_dev_release
;
701 edev
->name
= edev
->name
? edev
->name
: dev_name(edev
->dev
.parent
);
702 if (IS_ERR_OR_NULL(edev
->name
)) {
704 "extcon device name is null\n");
707 dev_set_name(&edev
->dev
, "%s", edev
->name
);
709 if (edev
->max_supported
) {
712 struct extcon_cable
*cable
;
714 edev
->cables
= kzalloc(sizeof(struct extcon_cable
) *
715 edev
->max_supported
, GFP_KERNEL
);
718 goto err_sysfs_alloc
;
720 for (index
= 0; index
< edev
->max_supported
; index
++) {
721 cable
= &edev
->cables
[index
];
723 snprintf(buf
, 10, "cable.%d", index
);
724 str
= kzalloc(sizeof(char) * (strlen(buf
) + 1),
727 for (index
--; index
>= 0; index
--) {
728 cable
= &edev
->cables
[index
];
729 kfree(cable
->attr_g
.name
);
733 goto err_alloc_cables
;
738 cable
->cable_index
= index
;
739 cable
->attrs
[0] = &cable
->attr_name
.attr
;
740 cable
->attrs
[1] = &cable
->attr_state
.attr
;
741 cable
->attrs
[2] = NULL
;
742 cable
->attr_g
.name
= str
;
743 cable
->attr_g
.attrs
= cable
->attrs
;
745 sysfs_attr_init(&cable
->attr_name
.attr
);
746 cable
->attr_name
.attr
.name
= "name";
747 cable
->attr_name
.attr
.mode
= 0444;
748 cable
->attr_name
.show
= cable_name_show
;
750 sysfs_attr_init(&cable
->attr_state
.attr
);
751 cable
->attr_state
.attr
.name
= "state";
752 cable
->attr_state
.attr
.mode
= 0444;
753 cable
->attr_state
.show
= cable_state_show
;
757 if (edev
->max_supported
&& edev
->mutually_exclusive
) {
761 /* Count the size of mutually_exclusive array */
762 for (index
= 0; edev
->mutually_exclusive
[index
]; index
++)
765 edev
->attrs_muex
= kzalloc(sizeof(struct attribute
*) *
766 (index
+ 1), GFP_KERNEL
);
767 if (!edev
->attrs_muex
) {
772 edev
->d_attrs_muex
= kzalloc(sizeof(struct device_attribute
) *
774 if (!edev
->d_attrs_muex
) {
776 kfree(edev
->attrs_muex
);
780 for (index
= 0; edev
->mutually_exclusive
[index
]; index
++) {
781 sprintf(buf
, "0x%x", edev
->mutually_exclusive
[index
]);
782 name
= kzalloc(sizeof(char) * (strlen(buf
) + 1),
785 for (index
--; index
>= 0; index
--) {
786 kfree(edev
->d_attrs_muex
[index
].attr
.
789 kfree(edev
->d_attrs_muex
);
790 kfree(edev
->attrs_muex
);
795 sysfs_attr_init(&edev
->d_attrs_muex
[index
].attr
);
796 edev
->d_attrs_muex
[index
].attr
.name
= name
;
797 edev
->d_attrs_muex
[index
].attr
.mode
= 0000;
798 edev
->attrs_muex
[index
] = &edev
->d_attrs_muex
[index
]
801 edev
->attr_g_muex
.name
= muex_name
;
802 edev
->attr_g_muex
.attrs
= edev
->attrs_muex
;
806 if (edev
->max_supported
) {
807 edev
->extcon_dev_type
.groups
=
808 kzalloc(sizeof(struct attribute_group
*) *
809 (edev
->max_supported
+ 2), GFP_KERNEL
);
810 if (!edev
->extcon_dev_type
.groups
) {
812 goto err_alloc_groups
;
815 edev
->extcon_dev_type
.name
= dev_name(&edev
->dev
);
816 edev
->extcon_dev_type
.release
= dummy_sysfs_dev_release
;
818 for (index
= 0; index
< edev
->max_supported
; index
++)
819 edev
->extcon_dev_type
.groups
[index
] =
820 &edev
->cables
[index
].attr_g
;
821 if (edev
->mutually_exclusive
)
822 edev
->extcon_dev_type
.groups
[index
] =
825 edev
->dev
.type
= &edev
->extcon_dev_type
;
828 ret
= device_register(&edev
->dev
);
830 put_device(&edev
->dev
);
833 #if defined(CONFIG_ANDROID)
835 ret
= class_compat_create_link(switch_class
, &edev
->dev
, NULL
);
836 #endif /* CONFIG_ANDROID */
838 spin_lock_init(&edev
->lock
);
840 RAW_INIT_NOTIFIER_HEAD(&edev
->nh
);
842 dev_set_drvdata(&edev
->dev
, edev
);
845 mutex_lock(&extcon_dev_list_lock
);
846 list_add(&edev
->entry
, &extcon_dev_list
);
847 mutex_unlock(&extcon_dev_list_lock
);
852 if (edev
->max_supported
)
853 kfree(edev
->extcon_dev_type
.groups
);
855 if (edev
->max_supported
&& edev
->mutually_exclusive
) {
856 for (index
= 0; edev
->mutually_exclusive
[index
]; index
++)
857 kfree(edev
->d_attrs_muex
[index
].attr
.name
);
858 kfree(edev
->d_attrs_muex
);
859 kfree(edev
->attrs_muex
);
862 for (index
= 0; index
< edev
->max_supported
; index
++)
863 kfree(edev
->cables
[index
].attr_g
.name
);
865 if (edev
->max_supported
)
870 EXPORT_SYMBOL_GPL(extcon_dev_register
);
873 * extcon_dev_unregister() - Unregister the extcon device.
874 * @edev: the extcon device instance to be unregistered.
876 * Note that this does not call kfree(edev) because edev was not allocated
879 void extcon_dev_unregister(struct extcon_dev
*edev
)
883 mutex_lock(&extcon_dev_list_lock
);
884 list_del(&edev
->entry
);
885 mutex_unlock(&extcon_dev_list_lock
);
887 if (IS_ERR_OR_NULL(get_device(&edev
->dev
))) {
888 dev_err(&edev
->dev
, "Failed to unregister extcon_dev (%s)\n",
889 dev_name(&edev
->dev
));
893 device_unregister(&edev
->dev
);
895 if (edev
->mutually_exclusive
&& edev
->max_supported
) {
896 for (index
= 0; edev
->mutually_exclusive
[index
];
898 kfree(edev
->d_attrs_muex
[index
].attr
.name
);
899 kfree(edev
->d_attrs_muex
);
900 kfree(edev
->attrs_muex
);
903 for (index
= 0; index
< edev
->max_supported
; index
++)
904 kfree(edev
->cables
[index
].attr_g
.name
);
906 if (edev
->max_supported
) {
907 kfree(edev
->extcon_dev_type
.groups
);
911 #if defined(CONFIG_ANDROID)
913 class_compat_remove_link(switch_class
, &edev
->dev
, NULL
);
915 put_device(&edev
->dev
);
917 EXPORT_SYMBOL_GPL(extcon_dev_unregister
);
919 static void devm_extcon_dev_unreg(struct device
*dev
, void *res
)
921 extcon_dev_unregister(*(struct extcon_dev
**)res
);
925 * devm_extcon_dev_register() - Resource-managed extcon_dev_register()
926 * @dev: device to allocate extcon device
927 * @edev: the new extcon device to register
929 * Managed extcon_dev_register() function. If extcon device is attached with
930 * this function, that extcon device is automatically unregistered on driver
931 * detach. Internally this function calls extcon_dev_register() function.
932 * To get more information, refer that function.
934 * If extcon device is registered with this function and the device needs to be
935 * unregistered separately, devm_extcon_dev_unregister() should be used.
937 * Returns 0 if success or negaive error number if failure.
939 int devm_extcon_dev_register(struct device
*dev
, struct extcon_dev
*edev
)
941 struct extcon_dev
**ptr
;
944 ptr
= devres_alloc(devm_extcon_dev_unreg
, sizeof(*ptr
), GFP_KERNEL
);
948 ret
= extcon_dev_register(edev
);
955 devres_add(dev
, ptr
);
959 EXPORT_SYMBOL_GPL(devm_extcon_dev_register
);
962 * devm_extcon_dev_unregister() - Resource-managed extcon_dev_unregister()
963 * @dev: device the extcon belongs to
964 * @edev: the extcon device to unregister
966 * Unregister extcon device that is registered with devm_extcon_dev_register()
969 void devm_extcon_dev_unregister(struct device
*dev
, struct extcon_dev
*edev
)
971 WARN_ON(devres_release(dev
, devm_extcon_dev_unreg
,
972 devm_extcon_dev_match
, edev
));
974 EXPORT_SYMBOL_GPL(devm_extcon_dev_unregister
);
978 * extcon_get_edev_by_phandle - Get the extcon device from devicetree
979 * @dev - instance to the given device
980 * @index - index into list of extcon_dev
982 * return the instance of extcon device
984 struct extcon_dev
*extcon_get_edev_by_phandle(struct device
*dev
, int index
)
986 struct device_node
*node
;
987 struct extcon_dev
*edev
;
990 dev_err(dev
, "device does not have a device node entry\n");
991 return ERR_PTR(-EINVAL
);
994 node
= of_parse_phandle(dev
->of_node
, "extcon", index
);
996 dev_err(dev
, "failed to get phandle in %s node\n",
997 dev
->of_node
->full_name
);
998 return ERR_PTR(-ENODEV
);
1001 mutex_lock(&extcon_dev_list_lock
);
1002 list_for_each_entry(edev
, &extcon_dev_list
, entry
) {
1003 if (edev
->dev
.parent
&& edev
->dev
.parent
->of_node
== node
) {
1004 mutex_unlock(&extcon_dev_list_lock
);
1008 mutex_unlock(&extcon_dev_list_lock
);
1010 return ERR_PTR(-EPROBE_DEFER
);
1013 struct extcon_dev
*extcon_get_edev_by_phandle(struct device
*dev
, int index
)
1015 return ERR_PTR(-ENOSYS
);
1017 #endif /* CONFIG_OF */
1018 EXPORT_SYMBOL_GPL(extcon_get_edev_by_phandle
);
1020 static int __init
extcon_class_init(void)
1022 return create_extcon_class();
1024 module_init(extcon_class_init
);
1026 static void __exit
extcon_class_exit(void)
1028 #if defined(CONFIG_ANDROID)
1029 class_compat_unregister(switch_class
);
1031 class_destroy(extcon_class
);
1033 module_exit(extcon_class_exit
);
1035 MODULE_AUTHOR("Mike Lockwood <lockwood@android.com>");
1036 MODULE_AUTHOR("Donggeun Kim <dg77.kim@samsung.com>");
1037 MODULE_AUTHOR("MyungJoo Ham <myungjoo.ham@samsung.com>");
1038 MODULE_DESCRIPTION("External connector (extcon) class driver");
1039 MODULE_LICENSE("GPL");