1 | // SPDX-License-Identifier: GPL-2.0-or-later |
2 | /* |
3 | * Broadcom BCM590xx PMU |
4 | * |
5 | * Copyright 2014 Linaro Limited |
6 | * Author: Matt Porter <mporter@linaro.org> |
7 | */ |
8 | |
9 | #include <linux/err.h> |
10 | #include <linux/i2c.h> |
11 | #include <linux/init.h> |
12 | #include <linux/mfd/bcm590xx.h> |
13 | #include <linux/mfd/core.h> |
14 | #include <linux/module.h> |
15 | #include <linux/moduleparam.h> |
16 | #include <linux/of.h> |
17 | #include <linux/regmap.h> |
18 | #include <linux/slab.h> |
19 | |
20 | static const struct mfd_cell bcm590xx_devs[] = { |
21 | { |
22 | .name = "bcm590xx-vregs" , |
23 | }, |
24 | }; |
25 | |
26 | static const struct regmap_config bcm590xx_regmap_config_pri = { |
27 | .reg_bits = 8, |
28 | .val_bits = 8, |
29 | .max_register = BCM590XX_MAX_REGISTER_PRI, |
30 | .cache_type = REGCACHE_RBTREE, |
31 | }; |
32 | |
33 | static const struct regmap_config bcm590xx_regmap_config_sec = { |
34 | .reg_bits = 8, |
35 | .val_bits = 8, |
36 | .max_register = BCM590XX_MAX_REGISTER_SEC, |
37 | .cache_type = REGCACHE_RBTREE, |
38 | }; |
39 | |
40 | static int bcm590xx_i2c_probe(struct i2c_client *i2c_pri) |
41 | { |
42 | struct bcm590xx *bcm590xx; |
43 | int ret; |
44 | |
45 | bcm590xx = devm_kzalloc(dev: &i2c_pri->dev, size: sizeof(*bcm590xx), GFP_KERNEL); |
46 | if (!bcm590xx) |
47 | return -ENOMEM; |
48 | |
49 | i2c_set_clientdata(client: i2c_pri, data: bcm590xx); |
50 | bcm590xx->dev = &i2c_pri->dev; |
51 | bcm590xx->i2c_pri = i2c_pri; |
52 | |
53 | bcm590xx->regmap_pri = devm_regmap_init_i2c(i2c_pri, |
54 | &bcm590xx_regmap_config_pri); |
55 | if (IS_ERR(ptr: bcm590xx->regmap_pri)) { |
56 | ret = PTR_ERR(ptr: bcm590xx->regmap_pri); |
57 | dev_err(&i2c_pri->dev, "primary regmap init failed: %d\n" , ret); |
58 | return ret; |
59 | } |
60 | |
61 | /* Secondary I2C slave address is the base address with A(2) asserted */ |
62 | bcm590xx->i2c_sec = i2c_new_dummy_device(adapter: i2c_pri->adapter, |
63 | address: i2c_pri->addr | BIT(2)); |
64 | if (IS_ERR(ptr: bcm590xx->i2c_sec)) { |
65 | dev_err(&i2c_pri->dev, "failed to add secondary I2C device\n" ); |
66 | return PTR_ERR(ptr: bcm590xx->i2c_sec); |
67 | } |
68 | i2c_set_clientdata(client: bcm590xx->i2c_sec, data: bcm590xx); |
69 | |
70 | bcm590xx->regmap_sec = devm_regmap_init_i2c(bcm590xx->i2c_sec, |
71 | &bcm590xx_regmap_config_sec); |
72 | if (IS_ERR(ptr: bcm590xx->regmap_sec)) { |
73 | ret = PTR_ERR(ptr: bcm590xx->regmap_sec); |
74 | dev_err(&bcm590xx->i2c_sec->dev, |
75 | "secondary regmap init failed: %d\n" , ret); |
76 | goto err; |
77 | } |
78 | |
79 | ret = devm_mfd_add_devices(dev: &i2c_pri->dev, id: -1, cells: bcm590xx_devs, |
80 | ARRAY_SIZE(bcm590xx_devs), NULL, irq_base: 0, NULL); |
81 | if (ret < 0) { |
82 | dev_err(&i2c_pri->dev, "failed to add sub-devices: %d\n" , ret); |
83 | goto err; |
84 | } |
85 | |
86 | return 0; |
87 | |
88 | err: |
89 | i2c_unregister_device(client: bcm590xx->i2c_sec); |
90 | return ret; |
91 | } |
92 | |
93 | static const struct of_device_id bcm590xx_of_match[] = { |
94 | { .compatible = "brcm,bcm59056" }, |
95 | { } |
96 | }; |
97 | MODULE_DEVICE_TABLE(of, bcm590xx_of_match); |
98 | |
99 | static const struct i2c_device_id bcm590xx_i2c_id[] = { |
100 | { "bcm59056" }, |
101 | { } |
102 | }; |
103 | MODULE_DEVICE_TABLE(i2c, bcm590xx_i2c_id); |
104 | |
105 | static struct i2c_driver bcm590xx_i2c_driver = { |
106 | .driver = { |
107 | .name = "bcm590xx" , |
108 | .of_match_table = bcm590xx_of_match, |
109 | }, |
110 | .probe = bcm590xx_i2c_probe, |
111 | .id_table = bcm590xx_i2c_id, |
112 | }; |
113 | module_i2c_driver(bcm590xx_i2c_driver); |
114 | |
115 | MODULE_AUTHOR("Matt Porter <mporter@linaro.org>" ); |
116 | MODULE_DESCRIPTION("BCM590xx multi-function driver" ); |
117 | MODULE_LICENSE("GPL v2" ); |
118 | |