1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (c) 2020 Rockchip Electronics Co. Ltd.
4 *
5 * Author: Algea Cao <algea.cao@rock-chips.com>
6 */
7
8 #include <linux/device.h>
9 #include <linux/err.h>
10 #include <linux/i2c.h>
11 #include <linux/input.h>
12 #include <linux/module.h>
13 #include <linux/mfd/rk630.h>
14
15 static int
rk630_i2c_probe(struct i2c_client * client,const struct i2c_device_id * id)16 rk630_i2c_probe(struct i2c_client *client, const struct i2c_device_id *id)
17 {
18 struct device *dev = &client->dev;
19 struct rk630 *rk630;
20 int ret;
21
22 rk630 = devm_kzalloc(dev, sizeof(*rk630), GFP_KERNEL);
23 if (!rk630)
24 return -ENOMEM;
25
26 rk630->dev = dev;
27 rk630->client = client;
28 i2c_set_clientdata(client, rk630);
29
30 rk630->grf = devm_regmap_init_i2c(client, &rk630_grf_regmap_config);
31 if (IS_ERR(rk630->grf)) {
32 ret = PTR_ERR(rk630->grf);
33 dev_err(dev, "failed to allocate grf register map: %d\n", ret);
34 return ret;
35 }
36
37 rk630->cru = devm_regmap_init_i2c(client, &rk630_cru_regmap_config);
38 if (IS_ERR(rk630->cru)) {
39 ret = PTR_ERR(rk630->cru);
40 dev_err(dev, "failed to allocate cru register map: %d\n", ret);
41 return ret;
42 }
43
44 rk630->tve = devm_regmap_init_i2c(client, &rk630_tve_regmap_config);
45 if (IS_ERR(rk630->tve)) {
46 ret = PTR_ERR(rk630->tve);
47 dev_err(rk630->dev, "Failed to initialize tve regmap: %d\n",
48 ret);
49 return ret;
50 }
51
52 return rk630_core_probe(rk630);
53 }
54
55 static const struct of_device_id rk630_i2c_of_match[] = {
56 { .compatible = "rockchip,rk630", },
57 {}
58 };
59 MODULE_DEVICE_TABLE(of, rk630_i2c_of_match);
60
61 static const struct i2c_device_id rk630_i2c_id[] = {
62 { "rk630", 0 },
63 {}
64 };
65 MODULE_DEVICE_TABLE(i2c, rk630_i2c_id);
66
67 static struct i2c_driver rk630_i2c_driver = {
68 .driver = {
69 .name = "rk630",
70 .of_match_table = of_match_ptr(rk630_i2c_of_match),
71 },
72 .probe = rk630_i2c_probe,
73 .id_table = rk630_i2c_id,
74 };
75 module_i2c_driver(rk630_i2c_driver);
76
77 MODULE_AUTHOR("Algea Cao <Algea.cao@rock-chips.com>");
78 MODULE_DESCRIPTION("Rockchip rk630 MFD I2C driver");
79 MODULE_LICENSE("GPL v2");
80