1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Copyright (C) 2015 Google, Inc
3*4882a593Smuzhiyun * Written by Simon Glass <sjg@chromium.org>
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <common.h>
9*4882a593Smuzhiyun #include <syscon.h>
10*4882a593Smuzhiyun #include <dm.h>
11*4882a593Smuzhiyun #include <errno.h>
12*4882a593Smuzhiyun #include <regmap.h>
13*4882a593Smuzhiyun #include <dm/device-internal.h>
14*4882a593Smuzhiyun #include <dm/lists.h>
15*4882a593Smuzhiyun #include <dm/root.h>
16*4882a593Smuzhiyun #include <linux/err.h>
17*4882a593Smuzhiyun
syscon_get_regmap(struct udevice * dev)18*4882a593Smuzhiyun struct regmap *syscon_get_regmap(struct udevice *dev)
19*4882a593Smuzhiyun {
20*4882a593Smuzhiyun struct syscon_uc_info *priv;
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun if (device_get_uclass_id(dev) != UCLASS_SYSCON)
23*4882a593Smuzhiyun return ERR_PTR(-ENOEXEC);
24*4882a593Smuzhiyun priv = dev_get_uclass_priv(dev);
25*4882a593Smuzhiyun return priv->regmap;
26*4882a593Smuzhiyun }
27*4882a593Smuzhiyun
syscon_pre_probe(struct udevice * dev)28*4882a593Smuzhiyun static int syscon_pre_probe(struct udevice *dev)
29*4882a593Smuzhiyun {
30*4882a593Smuzhiyun struct syscon_uc_info *priv = dev_get_uclass_priv(dev);
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun /*
33*4882a593Smuzhiyun * With OF_PLATDATA we really have no way of knowing the format of
34*4882a593Smuzhiyun * the device-specific platform data. So we assume that it starts with
35*4882a593Smuzhiyun * a 'reg' member, and this holds a single address and size. Drivers
36*4882a593Smuzhiyun * using OF_PLATDATA will need to ensure that this is true.
37*4882a593Smuzhiyun */
38*4882a593Smuzhiyun #if CONFIG_IS_ENABLED(OF_PLATDATA)
39*4882a593Smuzhiyun struct syscon_base_platdata *plat = dev_get_platdata(dev);
40*4882a593Smuzhiyun
41*4882a593Smuzhiyun return regmap_init_mem_platdata(dev, plat->reg, ARRAY_SIZE(plat->reg),
42*4882a593Smuzhiyun &priv->regmap);
43*4882a593Smuzhiyun #else
44*4882a593Smuzhiyun return regmap_init_mem(dev, &priv->regmap);
45*4882a593Smuzhiyun #endif
46*4882a593Smuzhiyun }
47*4882a593Smuzhiyun
syscon_regmap_lookup_by_phandle(struct udevice * dev,const char * name)48*4882a593Smuzhiyun struct regmap *syscon_regmap_lookup_by_phandle(struct udevice *dev,
49*4882a593Smuzhiyun const char *name)
50*4882a593Smuzhiyun {
51*4882a593Smuzhiyun struct udevice *syscon;
52*4882a593Smuzhiyun struct regmap *r;
53*4882a593Smuzhiyun int err;
54*4882a593Smuzhiyun
55*4882a593Smuzhiyun err = uclass_get_device_by_phandle(UCLASS_SYSCON, dev,
56*4882a593Smuzhiyun name, &syscon);
57*4882a593Smuzhiyun if (err)
58*4882a593Smuzhiyun return ERR_PTR(err);
59*4882a593Smuzhiyun
60*4882a593Smuzhiyun r = syscon_get_regmap(syscon);
61*4882a593Smuzhiyun if (!r)
62*4882a593Smuzhiyun return ERR_PTR(-ENODEV);
63*4882a593Smuzhiyun
64*4882a593Smuzhiyun return r;
65*4882a593Smuzhiyun }
66*4882a593Smuzhiyun
syscon_get_by_driver_data(ulong driver_data,struct udevice ** devp)67*4882a593Smuzhiyun int syscon_get_by_driver_data(ulong driver_data, struct udevice **devp)
68*4882a593Smuzhiyun {
69*4882a593Smuzhiyun struct udevice *dev;
70*4882a593Smuzhiyun struct uclass *uc;
71*4882a593Smuzhiyun int ret;
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun *devp = NULL;
74*4882a593Smuzhiyun ret = uclass_get(UCLASS_SYSCON, &uc);
75*4882a593Smuzhiyun if (ret)
76*4882a593Smuzhiyun return ret;
77*4882a593Smuzhiyun uclass_foreach_dev(dev, uc) {
78*4882a593Smuzhiyun if (dev->driver_data == driver_data) {
79*4882a593Smuzhiyun *devp = dev;
80*4882a593Smuzhiyun return device_probe(dev);
81*4882a593Smuzhiyun }
82*4882a593Smuzhiyun }
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun return -ENODEV;
85*4882a593Smuzhiyun }
86*4882a593Smuzhiyun
syscon_get_regmap_by_driver_data(ulong driver_data)87*4882a593Smuzhiyun struct regmap *syscon_get_regmap_by_driver_data(ulong driver_data)
88*4882a593Smuzhiyun {
89*4882a593Smuzhiyun struct syscon_uc_info *priv;
90*4882a593Smuzhiyun struct udevice *dev;
91*4882a593Smuzhiyun int ret;
92*4882a593Smuzhiyun
93*4882a593Smuzhiyun ret = syscon_get_by_driver_data(driver_data, &dev);
94*4882a593Smuzhiyun if (ret)
95*4882a593Smuzhiyun return ERR_PTR(ret);
96*4882a593Smuzhiyun priv = dev_get_uclass_priv(dev);
97*4882a593Smuzhiyun
98*4882a593Smuzhiyun return priv->regmap;
99*4882a593Smuzhiyun }
100*4882a593Smuzhiyun
syscon_get_first_range(ulong driver_data)101*4882a593Smuzhiyun void *syscon_get_first_range(ulong driver_data)
102*4882a593Smuzhiyun {
103*4882a593Smuzhiyun struct regmap *map;
104*4882a593Smuzhiyun
105*4882a593Smuzhiyun map = syscon_get_regmap_by_driver_data(driver_data);
106*4882a593Smuzhiyun if (IS_ERR(map))
107*4882a593Smuzhiyun return map;
108*4882a593Smuzhiyun return regmap_get_range(map, 0);
109*4882a593Smuzhiyun }
110*4882a593Smuzhiyun
111*4882a593Smuzhiyun UCLASS_DRIVER(syscon) = {
112*4882a593Smuzhiyun .id = UCLASS_SYSCON,
113*4882a593Smuzhiyun .name = "syscon",
114*4882a593Smuzhiyun .per_device_auto_alloc_size = sizeof(struct syscon_uc_info),
115*4882a593Smuzhiyun .pre_probe = syscon_pre_probe,
116*4882a593Smuzhiyun };
117*4882a593Smuzhiyun
118*4882a593Smuzhiyun static const struct udevice_id generic_syscon_ids[] = {
119*4882a593Smuzhiyun { .compatible = "syscon" },
120*4882a593Smuzhiyun { }
121*4882a593Smuzhiyun };
122*4882a593Smuzhiyun
123*4882a593Smuzhiyun U_BOOT_DRIVER(generic_syscon) = {
124*4882a593Smuzhiyun .name = "syscon",
125*4882a593Smuzhiyun .id = UCLASS_SYSCON,
126*4882a593Smuzhiyun #if !CONFIG_IS_ENABLED(OF_PLATDATA)
127*4882a593Smuzhiyun .bind = dm_scan_fdt_dev,
128*4882a593Smuzhiyun #endif
129*4882a593Smuzhiyun .of_match = generic_syscon_ids,
130*4882a593Smuzhiyun };
131