123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216 |
- #include <linux/extcon.h>
- static int devm_extcon_dev_match(struct device *dev, void *res, void *data)
- {
- struct extcon_dev **r = res;
- if (WARN_ON(!r || !*r))
- return 0;
- return *r == data;
- }
- static void devm_extcon_dev_release(struct device *dev, void *res)
- {
- extcon_dev_free(*(struct extcon_dev **)res);
- }
- static void devm_extcon_dev_unreg(struct device *dev, void *res)
- {
- extcon_dev_unregister(*(struct extcon_dev **)res);
- }
- struct extcon_dev_notifier_devres {
- struct extcon_dev *edev;
- unsigned int id;
- struct notifier_block *nb;
- };
- static void devm_extcon_dev_notifier_unreg(struct device *dev, void *res)
- {
- struct extcon_dev_notifier_devres *this = res;
- extcon_unregister_notifier(this->edev, this->id, this->nb);
- }
- struct extcon_dev *devm_extcon_dev_allocate(struct device *dev,
- const unsigned int *supported_cable)
- {
- struct extcon_dev **ptr, *edev;
- ptr = devres_alloc(devm_extcon_dev_release, sizeof(*ptr), GFP_KERNEL);
- if (!ptr)
- return ERR_PTR(-ENOMEM);
- edev = extcon_dev_allocate(supported_cable);
- if (IS_ERR(edev)) {
- devres_free(ptr);
- return edev;
- }
- edev->dev.parent = dev;
- *ptr = edev;
- devres_add(dev, ptr);
- return edev;
- }
- EXPORT_SYMBOL_GPL(devm_extcon_dev_allocate);
- void devm_extcon_dev_free(struct device *dev, struct extcon_dev *edev)
- {
- WARN_ON(devres_release(dev, devm_extcon_dev_release,
- devm_extcon_dev_match, edev));
- }
- EXPORT_SYMBOL_GPL(devm_extcon_dev_free);
- int devm_extcon_dev_register(struct device *dev, struct extcon_dev *edev)
- {
- struct extcon_dev **ptr;
- int ret;
- ptr = devres_alloc(devm_extcon_dev_unreg, sizeof(*ptr), GFP_KERNEL);
- if (!ptr)
- return -ENOMEM;
- ret = extcon_dev_register(edev);
- if (ret) {
- devres_free(ptr);
- return ret;
- }
- *ptr = edev;
- devres_add(dev, ptr);
- return 0;
- }
- EXPORT_SYMBOL_GPL(devm_extcon_dev_register);
- void devm_extcon_dev_unregister(struct device *dev, struct extcon_dev *edev)
- {
- WARN_ON(devres_release(dev, devm_extcon_dev_unreg,
- devm_extcon_dev_match, edev));
- }
- EXPORT_SYMBOL_GPL(devm_extcon_dev_unregister);
- int devm_extcon_register_notifier(struct device *dev, struct extcon_dev *edev,
- unsigned int id, struct notifier_block *nb)
- {
- struct extcon_dev_notifier_devres *ptr;
- int ret;
- ptr = devres_alloc(devm_extcon_dev_notifier_unreg, sizeof(*ptr),
- GFP_KERNEL);
- if (!ptr)
- return -ENOMEM;
- ret = extcon_register_notifier(edev, id, nb);
- if (ret) {
- devres_free(ptr);
- return ret;
- }
- ptr->edev = edev;
- ptr->id = id;
- ptr->nb = nb;
- devres_add(dev, ptr);
- return 0;
- }
- EXPORT_SYMBOL(devm_extcon_register_notifier);
- void devm_extcon_unregister_notifier(struct device *dev,
- struct extcon_dev *edev, unsigned int id,
- struct notifier_block *nb)
- {
- WARN_ON(devres_release(dev, devm_extcon_dev_notifier_unreg,
- devm_extcon_dev_match, edev));
- }
- EXPORT_SYMBOL(devm_extcon_unregister_notifier);
|