|
@@ -124,25 +124,35 @@ static int find_cable_index_by_id(struct extcon_dev *edev, const unsigned int id
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
|
|
|
-static int find_cable_index_by_name(struct extcon_dev *edev, const char *name)
|
|
|
+static int find_cable_id_by_name(struct extcon_dev *edev, const char *name)
|
|
|
{
|
|
|
- unsigned int id = EXTCON_NONE;
|
|
|
+ unsigned int id = -EINVAL;
|
|
|
int i = 0;
|
|
|
|
|
|
- if (edev->max_supported == 0)
|
|
|
- return -EINVAL;
|
|
|
-
|
|
|
- /* Find the the number of extcon cable */
|
|
|
+ /* Find the id of extcon cable */
|
|
|
while (extcon_name[i]) {
|
|
|
if (!strncmp(extcon_name[i], name, CABLE_NAME_MAX)) {
|
|
|
id = i;
|
|
|
break;
|
|
|
}
|
|
|
+ i++;
|
|
|
}
|
|
|
|
|
|
- if (id == EXTCON_NONE)
|
|
|
+ return id;
|
|
|
+}
|
|
|
+
|
|
|
+static int find_cable_index_by_name(struct extcon_dev *edev, const char *name)
|
|
|
+{
|
|
|
+ unsigned int id;
|
|
|
+
|
|
|
+ if (edev->max_supported == 0)
|
|
|
return -EINVAL;
|
|
|
|
|
|
+ /* Find the the number of extcon cable */
|
|
|
+ id = find_cable_id_by_name(edev, name);
|
|
|
+ if (id < 0)
|
|
|
+ return id;
|
|
|
+
|
|
|
return find_cable_index_by_id(edev, id);
|
|
|
}
|
|
|
|
|
@@ -228,9 +238,11 @@ static ssize_t cable_state_show(struct device *dev,
|
|
|
struct extcon_cable *cable = container_of(attr, struct extcon_cable,
|
|
|
attr_state);
|
|
|
|
|
|
+ int i = cable->cable_index;
|
|
|
+
|
|
|
return sprintf(buf, "%d\n",
|
|
|
extcon_get_cable_state_(cable->edev,
|
|
|
- cable->cable_index));
|
|
|
+ cable->edev->supported_cable[i]));
|
|
|
}
|
|
|
|
|
|
/**
|
|
@@ -263,20 +275,25 @@ int extcon_update_state(struct extcon_dev *edev, u32 mask, u32 state)
|
|
|
spin_lock_irqsave(&edev->lock, flags);
|
|
|
|
|
|
if (edev->state != ((edev->state & ~mask) | (state & mask))) {
|
|
|
+ u32 old_state;
|
|
|
+
|
|
|
if (check_mutually_exclusive(edev, (edev->state & ~mask) |
|
|
|
(state & mask))) {
|
|
|
spin_unlock_irqrestore(&edev->lock, flags);
|
|
|
return -EPERM;
|
|
|
}
|
|
|
|
|
|
- for (index = 0; index < edev->max_supported; index++) {
|
|
|
- if (is_extcon_changed(edev->state, state, index, &attached))
|
|
|
- raw_notifier_call_chain(&edev->nh[index], attached, edev);
|
|
|
- }
|
|
|
-
|
|
|
+ old_state = edev->state;
|
|
|
edev->state &= ~mask;
|
|
|
edev->state |= state & mask;
|
|
|
|
|
|
+ for (index = 0; index < edev->max_supported; index++) {
|
|
|
+ if (is_extcon_changed(old_state, edev->state, index,
|
|
|
+ &attached))
|
|
|
+ raw_notifier_call_chain(&edev->nh[index],
|
|
|
+ attached, edev);
|
|
|
+ }
|
|
|
+
|
|
|
/* This could be in interrupt handler */
|
|
|
prop_buf = (char *)get_zeroed_page(GFP_ATOMIC);
|
|
|
if (prop_buf) {
|
|
@@ -361,8 +378,13 @@ EXPORT_SYMBOL_GPL(extcon_get_cable_state_);
|
|
|
*/
|
|
|
int extcon_get_cable_state(struct extcon_dev *edev, const char *cable_name)
|
|
|
{
|
|
|
- return extcon_get_cable_state_(edev, find_cable_index_by_name
|
|
|
- (edev, cable_name));
|
|
|
+ unsigned int id;
|
|
|
+
|
|
|
+ id = find_cable_id_by_name(edev, cable_name);
|
|
|
+ if (id < 0)
|
|
|
+ return id;
|
|
|
+
|
|
|
+ return extcon_get_cable_state_(edev, id);
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(extcon_get_cable_state);
|
|
|
|
|
@@ -404,8 +426,13 @@ EXPORT_SYMBOL_GPL(extcon_set_cable_state_);
|
|
|
int extcon_set_cable_state(struct extcon_dev *edev,
|
|
|
const char *cable_name, bool cable_state)
|
|
|
{
|
|
|
- return extcon_set_cable_state_(edev, find_cable_index_by_name
|
|
|
- (edev, cable_name), cable_state);
|
|
|
+ unsigned int id;
|
|
|
+
|
|
|
+ id = find_cable_id_by_name(edev, cable_name);
|
|
|
+ if (id < 0)
|
|
|
+ return id;
|
|
|
+
|
|
|
+ return extcon_set_cable_state_(edev, id, cable_state);
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(extcon_set_cable_state);
|
|
|
|