regulator: userspace-consumer: Retrieve supplies from DT
PATCH 1/1 regulator: userspace-consumer: Retrieve supplies from DT
Instead of hardcoding a single supply, retrieve supplies from DT.
Signed-off-by Naresh Solanki <[email protected]>
--- drivers/regulator/userspace-consumer.c | 43 ++++++++++++++++++++++++-- 1 file changed, 40 insertions(+), 3 deletions(-)
drivers/regulator/userspace-consumer.c +40 -3
@@ -153,11 +153,32 @@ static int regulator_userspace_notify(struct notifier_block *nb,return NOTIFY_OK ; } +#define SUPPLY_SUFFIX "-supply" +#define SUPPLY_SUFFIX_LEN 7 + +static int get_num_supplies (struct platform_device *pdev) +{ +struct property *prop; +int num_supplies =0 ; + +for_each_property_of_node (pdev->dev.of_node, prop) { +const char *prop_name = prop->name; +int len =strlen (prop_name); + +if (len >SUPPLY_SUFFIX_LEN && \ +strcmp (prop_name + len -SUPPLY_SUFFIX_LEN ,SUPPLY_SUFFIX ) ==0 ) { + num_supplies++; + } + } +return num_supplies; +} +static int regulator_userspace_consumer_probe (struct platform_device *pdev) {struct regulator_userspace_consumer_data tmpdata;struct regulator_userspace_consumer_data *pdata;struct userspace_consumer_data *drvdata; +struct property *prop;int i, ret; pdata =dev_get_platdata (&pdev->dev);
@@ -169,11 +190,27 @@ static int regulator_userspace_consumer_probe(struct platform_device *pdev)memset (pdata,0 ,sizeof (*pdata)); pdata->no_autoswitch = true; - pdata->num_supplies =1 ; - pdata->supplies =devm_kzalloc (&pdev->dev,sizeof (*pdata->supplies),GFP_KERNEL ); + pdata->num_supplies =get_num_supplies (pdev); + + pdata->supplies =devm_kzalloc (&pdev->dev, pdata->num_supplies * \ +sizeof (*pdata->supplies),GFP_KERNEL );if (!pdata->supplies)return -ENOMEM ; - pdata->supplies[0 ].supply ="vout" ; + +for_each_property_of_node (pdev->dev.of_node, prop) { +const char *prop_name = prop->name; +int len =strlen (prop_name); + +if (len >7 && \ +strcmp (prop_name + len -SUPPLY_SUFFIX_LEN ,SUPPLY_SUFFIX ) ==0 ) { +char *supply_name =devm_kzalloc (&pdev->dev, + len -SUPPLY_SUFFIX_LEN +1 , +GFP_KERNEL ); +strscpy (supply_name, prop_name, len -SUPPLY_SUFFIX_LEN ); + supply_name[len -SUPPLY_SUFFIX_LEN ] ='\0' ; + pdata->supplies[0 ].supply = supply_name; + } + } }if (pdata->num_supplies <1 ) {
base-commit: 8950c4a350c188deb5f5b05df3244d4db82fe3d8
Signature · 1 line
2.41.0