| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371 | // SPDX-License-Identifier: GPL-2.0+/* * Copyright (C) 2014-2015 Samsung Electronics * Przemyslaw Marczak <p.marczak@samsung.com> */#include <common.h>#include <errno.h>#include <dm.h>#include <dm/uclass-internal.h>#include <power/pmic.h>#include <power/regulator.h>int regulator_mode(struct udevice *dev, struct dm_regulator_mode **modep){	struct dm_regulator_uclass_platdata *uc_pdata;	*modep = NULL;	uc_pdata = dev_get_uclass_platdata(dev);	if (!uc_pdata)		return -ENXIO;	*modep = uc_pdata->mode;	return uc_pdata->mode_count;}int regulator_get_value(struct udevice *dev){	const struct dm_regulator_ops *ops = dev_get_driver_ops(dev);	if (!ops || !ops->get_value)		return -ENOSYS;	return ops->get_value(dev);}int regulator_set_value(struct udevice *dev, int uV){	const struct dm_regulator_ops *ops = dev_get_driver_ops(dev);	struct dm_regulator_uclass_platdata *uc_pdata;	uc_pdata = dev_get_uclass_platdata(dev);	if (uc_pdata->min_uV != -ENODATA && uV < uc_pdata->min_uV)		return -EINVAL;	if (uc_pdata->max_uV != -ENODATA && uV > uc_pdata->max_uV)		return -EINVAL;	if (!ops || !ops->set_value)		return -ENOSYS;	return ops->set_value(dev, uV);}/* * To be called with at most caution as there is no check * before setting the actual voltage value. */int regulator_set_value_force(struct udevice *dev, int uV){	const struct dm_regulator_ops *ops = dev_get_driver_ops(dev);	if (!ops || !ops->set_value)		return -ENOSYS;	return ops->set_value(dev, uV);}int regulator_get_current(struct udevice *dev){	const struct dm_regulator_ops *ops = dev_get_driver_ops(dev);	if (!ops || !ops->get_current)		return -ENOSYS;	return ops->get_current(dev);}int regulator_set_current(struct udevice *dev, int uA){	const struct dm_regulator_ops *ops = dev_get_driver_ops(dev);	struct dm_regulator_uclass_platdata *uc_pdata;	uc_pdata = dev_get_uclass_platdata(dev);	if (uc_pdata->min_uA != -ENODATA && uA < uc_pdata->min_uA)		return -EINVAL;	if (uc_pdata->max_uA != -ENODATA && uA > uc_pdata->max_uA)		return -EINVAL;	if (!ops || !ops->set_current)		return -ENOSYS;	return ops->set_current(dev, uA);}int regulator_get_enable(struct udevice *dev){	const struct dm_regulator_ops *ops = dev_get_driver_ops(dev);	if (!ops || !ops->get_enable)		return -ENOSYS;	return ops->get_enable(dev);}int regulator_set_enable(struct udevice *dev, bool enable){	const struct dm_regulator_ops *ops = dev_get_driver_ops(dev);	if (!ops || !ops->set_enable)		return -ENOSYS;	return ops->set_enable(dev, enable);}int regulator_get_mode(struct udevice *dev){	const struct dm_regulator_ops *ops = dev_get_driver_ops(dev);	if (!ops || !ops->get_mode)		return -ENOSYS;	return ops->get_mode(dev);}int regulator_set_mode(struct udevice *dev, int mode){	const struct dm_regulator_ops *ops = dev_get_driver_ops(dev);	if (!ops || !ops->set_mode)		return -ENOSYS;	return ops->set_mode(dev, mode);}int regulator_get_by_platname(const char *plat_name, struct udevice **devp){	struct dm_regulator_uclass_platdata *uc_pdata;	struct udevice *dev;	int ret;	*devp = NULL;	for (ret = uclass_find_first_device(UCLASS_REGULATOR, &dev); dev;	     ret = uclass_find_next_device(&dev)) {		if (ret) {			debug("regulator %s, ret=%d\n", dev->name, ret);			continue;		}		uc_pdata = dev_get_uclass_platdata(dev);		if (!uc_pdata || strcmp(plat_name, uc_pdata->name))			continue;		return uclass_get_device_tail(dev, 0, devp);	}	debug("%s: can't find: %s, ret=%d\n", __func__, plat_name, ret);	return -ENODEV;}int regulator_get_by_devname(const char *devname, struct udevice **devp){	return uclass_get_device_by_name(UCLASS_REGULATOR, devname, devp);}int device_get_supply_regulator(struct udevice *dev, const char *supply_name,				struct udevice **devp){	return uclass_get_device_by_phandle(UCLASS_REGULATOR, dev,					    supply_name, devp);}int regulator_autoset(struct udevice *dev){	struct dm_regulator_uclass_platdata *uc_pdata;	int ret = 0;	uc_pdata = dev_get_uclass_platdata(dev);	if (!uc_pdata->always_on && !uc_pdata->boot_on)		return -EMEDIUMTYPE;	if (uc_pdata->flags & REGULATOR_FLAG_AUTOSET_UV)		ret = regulator_set_value(dev, uc_pdata->min_uV);	if (!ret && (uc_pdata->flags & REGULATOR_FLAG_AUTOSET_UA))		ret = regulator_set_current(dev, uc_pdata->min_uA);	if (!ret)		ret = regulator_set_enable(dev, true);	return ret;}static void regulator_show(struct udevice *dev, int ret){	struct dm_regulator_uclass_platdata *uc_pdata;	uc_pdata = dev_get_uclass_platdata(dev);	printf("%s@%s: ", dev->name, uc_pdata->name);	if (uc_pdata->flags & REGULATOR_FLAG_AUTOSET_UV)		printf("set %d uV", uc_pdata->min_uV);	if (uc_pdata->flags & REGULATOR_FLAG_AUTOSET_UA)		printf("; set %d uA", uc_pdata->min_uA);	printf("; enabling");	if (ret)		printf(" (ret: %d)", ret);	printf("\n");}int regulator_autoset_by_name(const char *platname, struct udevice **devp){	struct udevice *dev;	int ret;	ret = regulator_get_by_platname(platname, &dev);	if (devp)		*devp = dev;	if (ret) {		debug("Can get the regulator: %s (err=%d)\n", platname, ret);		return ret;	}	return regulator_autoset(dev);}int regulator_list_autoset(const char *list_platname[],			   struct udevice *list_devp[],			   bool verbose){	struct udevice *dev;	int error = 0, i = 0, ret;	while (list_platname[i]) {		ret = regulator_autoset_by_name(list_platname[i], &dev);		if (ret != -EMEDIUMTYPE && verbose)			regulator_show(dev, ret);		if (ret & !error)			error = ret;		if (list_devp)			list_devp[i] = dev;		i++;	}	return error;}static bool regulator_name_is_unique(struct udevice *check_dev,				     const char *check_name){	struct dm_regulator_uclass_platdata *uc_pdata;	struct udevice *dev;	int check_len = strlen(check_name);	int ret;	int len;	for (ret = uclass_find_first_device(UCLASS_REGULATOR, &dev); dev;	     ret = uclass_find_next_device(&dev)) {		if (ret || dev == check_dev)			continue;		uc_pdata = dev_get_uclass_platdata(dev);		len = strlen(uc_pdata->name);		if (len != check_len)			continue;		if (!strcmp(uc_pdata->name, check_name))			return false;	}	return true;}static int regulator_post_bind(struct udevice *dev){	struct dm_regulator_uclass_platdata *uc_pdata;	const char *property = "regulator-name";	uc_pdata = dev_get_uclass_platdata(dev);	/* Regulator's mandatory constraint */	uc_pdata->name = dev_read_string(dev, property);	if (!uc_pdata->name) {		debug("%s: dev '%s' has no property '%s'\n",		      __func__, dev->name, property);		uc_pdata->name = dev_read_name(dev);		if (!uc_pdata->name)			return -EINVAL;	}	if (regulator_name_is_unique(dev, uc_pdata->name))		return 0;	debug("'%s' of dev: '%s', has nonunique value: '%s\n",	      property, dev->name, uc_pdata->name);	return -EINVAL;}static int regulator_pre_probe(struct udevice *dev){	struct dm_regulator_uclass_platdata *uc_pdata;	uc_pdata = dev_get_uclass_platdata(dev);	if (!uc_pdata)		return -ENXIO;	/* Regulator's optional constraints */	uc_pdata->min_uV = dev_read_u32_default(dev, "regulator-min-microvolt",						-ENODATA);	uc_pdata->max_uV = dev_read_u32_default(dev, "regulator-max-microvolt",						-ENODATA);	uc_pdata->min_uA = dev_read_u32_default(dev, "regulator-min-microamp",						-ENODATA);	uc_pdata->max_uA = dev_read_u32_default(dev, "regulator-max-microamp",						-ENODATA);	uc_pdata->always_on = dev_read_bool(dev, "regulator-always-on");	uc_pdata->boot_on = dev_read_bool(dev, "regulator-boot-on");	/* Those values are optional (-ENODATA if unset) */	if ((uc_pdata->min_uV != -ENODATA) &&	    (uc_pdata->max_uV != -ENODATA) &&	    (uc_pdata->min_uV == uc_pdata->max_uV))		uc_pdata->flags |= REGULATOR_FLAG_AUTOSET_UV;	/* Those values are optional (-ENODATA if unset) */	if ((uc_pdata->min_uA != -ENODATA) &&	    (uc_pdata->max_uA != -ENODATA) &&	    (uc_pdata->min_uA == uc_pdata->max_uA))		uc_pdata->flags |= REGULATOR_FLAG_AUTOSET_UA;	return 0;}int regulators_enable_boot_on(bool verbose){	struct udevice *dev;	struct uclass *uc;	int ret;	ret = uclass_get(UCLASS_REGULATOR, &uc);	if (ret)		return ret;	for (uclass_first_device(UCLASS_REGULATOR, &dev);	     dev;	     uclass_next_device(&dev)) {		ret = regulator_autoset(dev);		if (ret == -EMEDIUMTYPE) {			ret = 0;			continue;		}		if (verbose)			regulator_show(dev, ret);		if (ret == -ENOSYS)			ret = 0;	}	return ret;}UCLASS_DRIVER(regulator) = {	.id		= UCLASS_REGULATOR,	.name		= "regulator",	.post_bind	= regulator_post_bind,	.pre_probe	= regulator_pre_probe,	.per_device_platdata_auto_alloc_size =				sizeof(struct dm_regulator_uclass_platdata),};
 |