/* * @file bd71837.c -- ROHM BD71837MWV mfd driver * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the * Free Software Foundation; either version 2 of the License, or (at your * option) any later version. * * @author: cpham2403@gmail.com * Copyright 2017. */ #define DEBUG #include #include #include #include #include #include #include #include #include #include #include #include #include #include /* Default enable debug message All Level */ unsigned int bd71837_debug_mask = BD71837_DBG0; /** @brief bd71837 irq resource */ static struct resource pmic_resources[] = { // irq# 0 { .start = BD71837_IRQ, .end = BD71837_IRQ, .flags = IORESOURCE_IRQ, }, }; /** @brief bd71837 multi function cells */ static struct mfd_cell bd71837_mfd_cells[] = { { .name = "bd71837-pmic", .num_resources = ARRAY_SIZE(pmic_resources), .resources = &pmic_resources[0], }, }; /** @brief bd71837 irqs */ static const struct regmap_irq bd71837_irqs[] = { [BD71837_IRQ] = { .mask = BD71837_INT_MASK, .reg_offset = 0, }, }; /** @brief bd71837 irq chip definition */ static struct regmap_irq_chip bd71837_irq_chip = { .name = "bd71837", .irqs = bd71837_irqs, .num_irqs = ARRAY_SIZE(bd71837_irqs), .num_regs = 1, .irq_reg_stride = 1, .status_base = BD71837_REG_IRQ, .mask_base = BD71837_REG_MIRQ, .mask_invert = true, // .ack_base = BD71837_REG_IRQ, }; /** @brief bd71837 irq initialize * @param bd71837 bd71837 device to init * @param bdinfo platform init data * @retval 0 probe success * @retval negative error number */ static int bd71837_irq_init(struct bd71837 *bd71837, struct bd71837_board *bdinfo) { int irq; int ret = 0; if (!bdinfo) { dev_warn(bd71837->dev, "No interrupt support, no pdata\n"); return -EINVAL; } dev_info(bd71837->dev, "gpio_intr = %d \n", bdinfo->gpio_intr); irq = gpio_to_irq(bdinfo->gpio_intr); bd71837->chip_irq = irq; dev_info(bd71837->dev, "chip_irq=%d \n", bd71837->chip_irq); ret = regmap_add_irq_chip(bd71837->regmap, bd71837->chip_irq, IRQF_ONESHOT | IRQF_TRIGGER_FALLING, bdinfo->irq_base, &bd71837_irq_chip, &bd71837->irq_data); if (ret < 0) { dev_warn(bd71837->dev, "Failed to add irq_chip %d\n", ret); } return ret; } /** @brief bd71837 irq initialize * @param bd71837 bd71837 device to init * @retval 0 probe success * @retval negative error number */ static int bd71837_irq_exit(struct bd71837 *bd71837) { if (bd71837->chip_irq > 0) regmap_del_irq_chip(bd71837->chip_irq, bd71837->irq_data); return 0; } /** @brief check whether volatile register * @param dev kernel device pointer * @param reg register index */ static bool is_volatile_reg(struct device *dev, unsigned int reg) { // struct bd71837 *bd71837 = dev_get_drvdata(dev); /* * Caching all regulator registers. */ return true; } /** @brief regmap configures */ static const struct regmap_config bd71837_regmap_config = { .reg_bits = 8, .val_bits = 8, .volatile_reg = is_volatile_reg, .max_register = BD71837_MAX_REGISTER - 1, .cache_type = REGCACHE_RBTREE, }; #ifdef CONFIG_OF static struct of_device_id bd71837_of_match[] = { { .compatible = "rohm,bd71837", .data = (void *)0}, { .compatible = "rohm,bd71840", .data = (void *)0}, { }, }; MODULE_DEVICE_TABLE(of, bd71837_of_match); /** @brief parse device tree data of bd71837 * @param client client object provided by system * @param chip_id return chip id back to caller * @return board initialize data */ static struct bd71837_board *bd71837_parse_dt(struct i2c_client *client, int *chip_id) { struct device_node *np = client->dev.of_node; struct bd71837_board *board_info; unsigned int prop; const struct of_device_id *match; int r = 0; match = of_match_device(bd71837_of_match, &client->dev); if (!match) { dev_err(&client->dev, "Failed to find matching dt id\n"); return NULL; } chip_id = (int *)match->data; board_info = devm_kzalloc(&client->dev, sizeof(*board_info), GFP_KERNEL); if (!board_info) { dev_err(&client->dev, "Failed to allocate pdata\n"); return NULL; } board_info->gpio_intr = of_get_named_gpio(np, "gpio_intr", 0); if (!gpio_is_valid(board_info->gpio_intr)) { dev_err(&client->dev, "no pmic intr pin available\n"); goto err_intr; } r = of_property_read_u32(np, "irq_base", &prop); if (!r) { board_info->irq_base = prop; } else { board_info->irq_base = -1; } return board_info; err_intr: devm_kfree(&client->dev, board_info); return NULL; } #endif /** @brief probe bd71837 device * @param i2c client object provided by system * @param id chip id * @retval 0 probe success * @retval negative error number */ static int bd71837_i2c_probe(struct i2c_client *i2c, const struct i2c_device_id *id) { struct bd71837 *bd71837; struct bd71837_board *pmic_plat_data; struct bd71837_board *of_pmic_plat_data = NULL; int chip_id = id->driver_data; int ret = 0; pmic_plat_data = dev_get_platdata(&i2c->dev); if (!pmic_plat_data && i2c->dev.of_node) { pmic_plat_data = bd71837_parse_dt(i2c, &chip_id); of_pmic_plat_data = pmic_plat_data; } if (!pmic_plat_data) return -EINVAL; bd71837 = kzalloc(sizeof(struct bd71837), GFP_KERNEL); if (bd71837 == NULL) return -ENOMEM; bd71837->of_plat_data = of_pmic_plat_data; i2c_set_clientdata(i2c, bd71837); bd71837->dev = &i2c->dev; bd71837->i2c_client = i2c; bd71837->id = chip_id; mutex_init(&bd71837->io_mutex); bd71837->regmap = devm_regmap_init_i2c(i2c, &bd71837_regmap_config); if (IS_ERR(bd71837->regmap)) { ret = PTR_ERR(bd71837->regmap); dev_err(&i2c->dev, "regmap initialization failed: %d\n", ret); return ret; } ret = bd71837_reg_read(bd71837, BD71837_REG_REV); if (ret < 0) { dev_err(bd71837->dev, "%s(): Read BD71837_REG_DEVICE failed!\n", __func__); goto err; } dev_info(bd71837->dev, "Device ID=0x%X\n", ret); bd71837_irq_init(bd71837, of_pmic_plat_data); ret = mfd_add_devices(bd71837->dev, -1, bd71837_mfd_cells, ARRAY_SIZE(bd71837_mfd_cells), NULL, 0, regmap_irq_get_domain(bd71837->irq_data)); if (ret < 0) goto err; return ret; err: mfd_remove_devices(bd71837->dev); kfree(bd71837); return ret; } /** @brief remove bd71837 device * @param i2c client object provided by system * @return 0 */ static int bd71837_i2c_remove(struct i2c_client *i2c) { struct bd71837 *bd71837 = i2c_get_clientdata(i2c); bd71837_irq_exit(bd71837); mfd_remove_devices(bd71837->dev); kfree(bd71837); return 0; } static const struct i2c_device_id bd71837_i2c_id[] = { { "bd71837", 0 }, { "bd71840", 0 }, { } }; MODULE_DEVICE_TABLE(i2c, bd71837_i2c_id); static struct i2c_driver bd71837_i2c_driver = { .driver = { .name = "bd71837", .owner = THIS_MODULE, .of_match_table = of_match_ptr(bd71837_of_match), }, .probe = bd71837_i2c_probe, .remove = bd71837_i2c_remove, .id_table = bd71837_i2c_id, }; static int __init bd71837_i2c_init(void) { return i2c_add_driver(&bd71837_i2c_driver); } /* init early so consumer devices can complete system boot */ subsys_initcall(bd71837_i2c_init); static void __exit bd71837_i2c_exit(void) { i2c_del_driver(&bd71837_i2c_driver); } module_exit(bd71837_i2c_exit); MODULE_AUTHOR("Cong Pham "); MODULE_DESCRIPTION("BD71837 chip multi-function driver"); MODULE_LICENSE("GPL");