blob: e03f46af5739d7156ad0270a438e4744496e535f [file] [log] [blame]
Simon Glass57251282015-06-23 15:38:43 -06001/*
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
18struct regmap *syscon_get_regmap(struct udevice *dev)
19{
Simon Glass9f4629b2015-07-06 12:54:38 -060020 struct syscon_uc_info *priv;
Simon Glass57251282015-06-23 15:38:43 -060021
Simon Glass9f4629b2015-07-06 12:54:38 -060022 if (device_get_uclass_id(dev) != UCLASS_SYSCON)
23 return ERR_PTR(-ENOEXEC);
24 priv = dev_get_uclass_priv(dev);
Simon Glass57251282015-06-23 15:38:43 -060025 return priv->regmap;
26}
27
28static 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
Simon Glassac94b7b2016-01-17 16:11:08 -070035int syscon_get_by_driver_data(ulong driver_data, struct udevice **devp)
Simon Glass57251282015-06-23 15:38:43 -060036{
37 struct udevice *dev;
38 struct uclass *uc;
39 int ret;
40
Simon Glass532f2432016-03-11 22:06:49 -070041 *devp = NULL;
Simon Glass57251282015-06-23 15:38:43 -060042 ret = uclass_get(UCLASS_SYSCON, &uc);
43 if (ret)
Simon Glassac94b7b2016-01-17 16:11:08 -070044 return ret;
Simon Glass57251282015-06-23 15:38:43 -060045 uclass_foreach_dev(dev, uc) {
46 if (dev->driver_data == driver_data) {
Simon Glassac94b7b2016-01-17 16:11:08 -070047 *devp = dev;
48 return device_probe(dev);
Simon Glass57251282015-06-23 15:38:43 -060049 }
50 }
51
Simon Glassac94b7b2016-01-17 16:11:08 -070052 return -ENODEV;
53}
54
55struct regmap *syscon_get_regmap_by_driver_data(ulong driver_data)
56{
57 struct syscon_uc_info *priv;
58 struct udevice *dev;
59 int ret;
60
61 ret = syscon_get_by_driver_data(driver_data, &dev);
62 if (ret)
63 return ERR_PTR(ret);
64 priv = dev_get_uclass_priv(dev);
65
66 return priv->regmap;
Simon Glass57251282015-06-23 15:38:43 -060067}
68
69void *syscon_get_first_range(ulong driver_data)
70{
71 struct regmap *map;
72
73 map = syscon_get_regmap_by_driver_data(driver_data);
74 if (IS_ERR(map))
75 return map;
76 return regmap_get_range(map, 0);
77}
78
79UCLASS_DRIVER(syscon) = {
80 .id = UCLASS_SYSCON,
81 .name = "syscon",
82 .per_device_auto_alloc_size = sizeof(struct syscon_uc_info),
83 .pre_probe = syscon_pre_probe,
84};