118 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * Broadcom BCM590xx PMU4 *5 * Copyright 2014 Linaro Limited6 * 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 20static const struct mfd_cell bcm590xx_devs[] = {21 {22 .name = "bcm590xx-vregs",23 },24};25 26static 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_MAPLE,31};32 33static 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_MAPLE,38};39 40static int bcm590xx_i2c_probe(struct i2c_client *i2c_pri)41{42 struct bcm590xx *bcm590xx;43 int ret;44 45 bcm590xx = devm_kzalloc(&i2c_pri->dev, sizeof(*bcm590xx), GFP_KERNEL);46 if (!bcm590xx)47 return -ENOMEM;48 49 i2c_set_clientdata(i2c_pri, 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(bcm590xx->regmap_pri)) {56 ret = PTR_ERR(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(i2c_pri->adapter,63 i2c_pri->addr | BIT(2));64 if (IS_ERR(bcm590xx->i2c_sec)) {65 dev_err(&i2c_pri->dev, "failed to add secondary I2C device\n");66 return PTR_ERR(bcm590xx->i2c_sec);67 }68 i2c_set_clientdata(bcm590xx->i2c_sec, bcm590xx);69 70 bcm590xx->regmap_sec = devm_regmap_init_i2c(bcm590xx->i2c_sec,71 &bcm590xx_regmap_config_sec);72 if (IS_ERR(bcm590xx->regmap_sec)) {73 ret = PTR_ERR(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(&i2c_pri->dev, -1, bcm590xx_devs,80 ARRAY_SIZE(bcm590xx_devs), NULL, 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 88err:89 i2c_unregister_device(bcm590xx->i2c_sec);90 return ret;91}92 93static const struct of_device_id bcm590xx_of_match[] = {94 { .compatible = "brcm,bcm59056" },95 { }96};97MODULE_DEVICE_TABLE(of, bcm590xx_of_match);98 99static const struct i2c_device_id bcm590xx_i2c_id[] = {100 { "bcm59056" },101 { }102};103MODULE_DEVICE_TABLE(i2c, bcm590xx_i2c_id);104 105static 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};113module_i2c_driver(bcm590xx_i2c_driver);114 115MODULE_AUTHOR("Matt Porter <mporter@linaro.org>");116MODULE_DESCRIPTION("BCM590xx multi-function driver");117MODULE_LICENSE("GPL v2");118