[people/ms/u-boot.git] / drivers / core / syscon-uclass.c

/*
 * Copyright (C) 2015 Google, Inc
 * Written by Simon Glass <sjg@chromium.org>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <syscon.h>
#include <dm.h>
#include <errno.h>
#include <regmap.h>
#include <dm/device-internal.h>
#include <dm/lists.h>
#include <dm/root.h>
#include <linux/err.h>

struct regmap *syscon_get_regmap(struct udevice *dev)
{
	struct syscon_uc_info *priv;

	if (device_get_uclass_id(dev) != UCLASS_SYSCON)
		return ERR_PTR(-ENOEXEC);
	priv = dev_get_uclass_priv(dev);
	return priv->regmap;
}

static int syscon_pre_probe(struct udevice *dev)
{
	struct syscon_uc_info *priv = dev_get_uclass_priv(dev);

	return regmap_init_mem(dev, &priv->regmap);
}

int syscon_get_by_driver_data(ulong driver_data, struct udevice **devp)
{
	struct udevice *dev;
	struct uclass *uc;
	int ret;

	ret = uclass_get(UCLASS_SYSCON, &uc);
	if (ret)
		return ret;
	uclass_foreach_dev(dev, uc) {
		if (dev->driver_data == driver_data) {
			*devp = dev;
			return device_probe(dev);
		}
	}

	return -ENODEV;
}

struct regmap *syscon_get_regmap_by_driver_data(ulong driver_data)
{
	struct syscon_uc_info *priv;
	struct udevice *dev;
	int ret;

	ret = syscon_get_by_driver_data(driver_data, &dev);
	if (ret)
		return ERR_PTR(ret);
	priv = dev_get_uclass_priv(dev);

	return priv->regmap;
}

void *syscon_get_first_range(ulong driver_data)
{
	struct regmap *map;

	map = syscon_get_regmap_by_driver_data(driver_data);
	if (IS_ERR(map))
		return map;
	return regmap_get_range(map, 0);
}

UCLASS_DRIVER(syscon) = {
	.id		= UCLASS_SYSCON,
	.name		= "syscon",
	.per_device_auto_alloc_size = sizeof(struct syscon_uc_info),
	.pre_probe = syscon_pre_probe,
};
Commit	Line	Data
57251285 SG	1	/*
	2	* Copyright (C) 2015 Google, Inc
	3	* Written by Simon Glass <sjg@chromium.org>
	4	*
	5	* SPDX-License-Identifier: GPL-2.0+
	6	*/
	7
	8	#include <common.h>
	9	#include <syscon.h>
	10	#include <dm.h>
	11	#include <errno.h>
	12	#include <regmap.h>
	13	#include <dm/device-internal.h>
	14	#include <dm/lists.h>
	15	#include <dm/root.h>
	16	#include <linux/err.h>
	17
	18	struct regmap syscon_get_regmap(struct udevice dev)
	19	{
9f4629be	20	struct syscon_uc_info *priv;
57251285	21
9f4629be SG	22	if (device_get_uclass_id(dev) != UCLASS_SYSCON)
	23	return ERR_PTR(-ENOEXEC);
	24	priv = dev_get_uclass_priv(dev);
57251285 SG	25	return priv->regmap;
	26	}
	27
	28	static int syscon_pre_probe(struct udevice *dev)
	29	{
	30	struct syscon_uc_info *priv = dev_get_uclass_priv(dev);
	31
	32	return regmap_init_mem(dev, &priv->regmap);
	33	}
	34
ac94b7bc	35	int syscon_get_by_driver_data(ulong driver_data, struct udevice **devp)
57251285 SG	36	{
	37	struct udevice *dev;
	38	struct uclass *uc;
	39	int ret;
	40
	41	ret = uclass_get(UCLASS_SYSCON, &uc);
	42	if (ret)
ac94b7bc	43	return ret;
57251285 SG	44	uclass_foreach_dev(dev, uc) {
57251285 SG	45	if (dev->driver_data == driver_data) {
ac94b7bc SG	46	*devp = dev;
ac94b7bc SG	47	return device_probe(dev);
57251285 SG	48	}
	49	}
	50
ac94b7bc SG	51	return -ENODEV;
	52	}
	53
	54	struct regmap *syscon_get_regmap_by_driver_data(ulong driver_data)
	55	{
	56	struct syscon_uc_info *priv;
	57	struct udevice *dev;
	58	int ret;
	59
	60	ret = syscon_get_by_driver_data(driver_data, &dev);
	61	if (ret)
	62	return ERR_PTR(ret);
	63	priv = dev_get_uclass_priv(dev);
	64
	65	return priv->regmap;
57251285 SG	66	}
	67
	68	void *syscon_get_first_range(ulong driver_data)
	69	{
	70	struct regmap *map;
	71
	72	map = syscon_get_regmap_by_driver_data(driver_data);
	73	if (IS_ERR(map))
	74	return map;
	75	return regmap_get_range(map, 0);
	76	}
	77
	78	UCLASS_DRIVER(syscon) = {
	79	.id = UCLASS_SYSCON,
	80	.name = "syscon",
	81	.per_device_auto_alloc_size = sizeof(struct syscon_uc_info),
	82	.pre_probe = syscon_pre_probe,
	83	};