1 /* 2 * tps65912-core.c -- TI TPS65912x 3 * 4 * Copyright 2011 Texas Instruments Inc. 5 * 6 * Author: Margarita Olaya Cabrera <magi@slimlogic.co.uk> 7 * 8 * This program is free software; you can redistribute it and/or modify it 9 * under the terms of the GNU General Public License as published by the 10 * Free Software Foundation; either version 2 of the License, or (at your 11 * option) any later version. 12 * 13 * This driver is based on wm8350 implementation. 14 */ 15 16 #include <linux/module.h> 17 #include <linux/moduleparam.h> 18 #include <linux/init.h> 19 #include <linux/slab.h> 20 #include <linux/gpio.h> 21 #include <linux/mfd/core.h> 22 #include <linux/mfd/tps65912.h> 23 24 static struct mfd_cell tps65912s[] = { 25 { 26 .name = "tps65912-pmic", 27 }, 28 }; 29 30 int tps65912_set_bits(struct tps65912 *tps65912, u8 reg, u8 mask) 31 { 32 u8 data; 33 int err; 34 35 mutex_lock(&tps65912->io_mutex); 36 37 err = tps65912->read(tps65912, reg, 1, &data); 38 if (err) { 39 dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg); 40 goto out; 41 } 42 43 data |= mask; 44 err = tps65912->write(tps65912, reg, 1, &data); 45 if (err) 46 dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg); 47 48 out: 49 mutex_unlock(&tps65912->io_mutex); 50 return err; 51 } 52 EXPORT_SYMBOL_GPL(tps65912_set_bits); 53 54 int tps65912_clear_bits(struct tps65912 *tps65912, u8 reg, u8 mask) 55 { 56 u8 data; 57 int err; 58 59 mutex_lock(&tps65912->io_mutex); 60 err = tps65912->read(tps65912, reg, 1, &data); 61 if (err) { 62 dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg); 63 goto out; 64 } 65 66 data &= ~mask; 67 err = tps65912->write(tps65912, reg, 1, &data); 68 if (err) 69 dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg); 70 71 out: 72 mutex_unlock(&tps65912->io_mutex); 73 return err; 74 } 75 EXPORT_SYMBOL_GPL(tps65912_clear_bits); 76 77 static inline int tps65912_read(struct tps65912 *tps65912, u8 reg) 78 { 79 u8 val; 80 int err; 81 82 err = tps65912->read(tps65912, reg, 1, &val); 83 if (err < 0) 84 return err; 85 86 return val; 87 } 88 89 static inline int tps65912_write(struct tps65912 *tps65912, u8 reg, u8 val) 90 { 91 return tps65912->write(tps65912, reg, 1, &val); 92 } 93 94 int tps65912_reg_read(struct tps65912 *tps65912, u8 reg) 95 { 96 int data; 97 98 mutex_lock(&tps65912->io_mutex); 99 100 data = tps65912_read(tps65912, reg); 101 if (data < 0) 102 dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg); 103 104 mutex_unlock(&tps65912->io_mutex); 105 return data; 106 } 107 EXPORT_SYMBOL_GPL(tps65912_reg_read); 108 109 int tps65912_reg_write(struct tps65912 *tps65912, u8 reg, u8 val) 110 { 111 int err; 112 113 mutex_lock(&tps65912->io_mutex); 114 115 err = tps65912_write(tps65912, reg, val); 116 if (err < 0) 117 dev_err(tps65912->dev, "Write for reg 0x%x failed\n", reg); 118 119 mutex_unlock(&tps65912->io_mutex); 120 return err; 121 } 122 EXPORT_SYMBOL_GPL(tps65912_reg_write); 123 124 int tps65912_device_init(struct tps65912 *tps65912) 125 { 126 struct tps65912_board *pmic_plat_data = tps65912->dev->platform_data; 127 struct tps65912_platform_data *init_data; 128 int ret, dcdc_avs, value; 129 130 init_data = kzalloc(sizeof(struct tps65912_platform_data), GFP_KERNEL); 131 if (init_data == NULL) 132 return -ENOMEM; 133 134 mutex_init(&tps65912->io_mutex); 135 dev_set_drvdata(tps65912->dev, tps65912); 136 137 dcdc_avs = (pmic_plat_data->is_dcdc1_avs << 0 | 138 pmic_plat_data->is_dcdc2_avs << 1 | 139 pmic_plat_data->is_dcdc3_avs << 2 | 140 pmic_plat_data->is_dcdc4_avs << 3); 141 if (dcdc_avs) { 142 tps65912->read(tps65912, TPS65912_I2C_SPI_CFG, 1, &value); 143 dcdc_avs |= value; 144 tps65912->write(tps65912, TPS65912_I2C_SPI_CFG, 1, &dcdc_avs); 145 } 146 147 ret = mfd_add_devices(tps65912->dev, -1, 148 tps65912s, ARRAY_SIZE(tps65912s), 149 NULL, 0); 150 if (ret < 0) 151 goto err; 152 153 init_data->irq = pmic_plat_data->irq; 154 init_data->irq_base = pmic_plat_data->irq; 155 ret = tps65912_irq_init(tps65912, init_data->irq, init_data); 156 if (ret < 0) 157 goto err; 158 159 kfree(init_data); 160 return ret; 161 162 err: 163 kfree(init_data); 164 mfd_remove_devices(tps65912->dev); 165 kfree(tps65912); 166 return ret; 167 } 168 169 void tps65912_device_exit(struct tps65912 *tps65912) 170 { 171 mfd_remove_devices(tps65912->dev); 172 kfree(tps65912); 173 } 174 175 MODULE_AUTHOR("Margarita Olaya <magi@slimlogic.co.uk>"); 176 MODULE_DESCRIPTION("TPS65912x chip family multi-function driver"); 177 MODULE_LICENSE("GPL"); 178