mfd: twl-core: Allocate twl_modules dynamically

At boot time we can allocate the twl_modules array dynamically based on the
twl class we are using with devm_kzalloc() instead of the static
twl_modules[] array.

Signed-off-by: Peter Ujfalusi <peter.ujfalusi@ti.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
This commit is contained in:
Peter Ujfalusi 2013-01-16 14:53:53 +01:00 committed by Samuel Ortiz
parent 3c3302794c
commit 6dd810b5e6

View file

@ -66,8 +66,6 @@
/* Triton Core internal information (BEGIN) */ /* Triton Core internal information (BEGIN) */
#define TWL_NUM_SLAVES 4
/* Base Address defns for twl4030_map[] */ /* Base Address defns for twl4030_map[] */
/* subchip/slave 0 - USB ID */ /* subchip/slave 0 - USB ID */
@ -162,7 +160,7 @@ struct twl_client {
struct regmap *regmap; struct regmap *regmap;
}; };
static struct twl_client twl_modules[TWL_NUM_SLAVES]; static struct twl_client *twl_modules;
/* mapping the module id to slave id and base address */ /* mapping the module id to slave id and base address */
struct twl_mapping { struct twl_mapping {
@ -284,6 +282,14 @@ static struct regmap_config twl6030_regmap_config[3] = {
/*----------------------------------------------------------------------*/ /*----------------------------------------------------------------------*/
static inline int twl_get_num_slaves(void)
{
if (twl_class_is_4030())
return 4; /* TWL4030 class have four slave address */
else
return 3; /* TWL6030 class have three slave address */
}
static inline int twl_get_last_module(void) static inline int twl_get_last_module(void)
{ {
if (twl_class_is_4030()) if (twl_class_is_4030())
@ -1127,17 +1133,15 @@ static int twl_remove(struct i2c_client *client)
unsigned i, num_slaves; unsigned i, num_slaves;
int status; int status;
if (twl_class_is_4030()) { if (twl_class_is_4030())
status = twl4030_exit_irq(); status = twl4030_exit_irq();
num_slaves = TWL_NUM_SLAVES; else
} else {
status = twl6030_exit_irq(); status = twl6030_exit_irq();
num_slaves = TWL_NUM_SLAVES - 1;
}
if (status < 0) if (status < 0)
return status; return status;
num_slaves = twl_get_num_slaves();
for (i = 0; i < num_slaves; i++) { for (i = 0; i < num_slaves; i++) {
struct twl_client *twl = &twl_modules[i]; struct twl_client *twl = &twl_modules[i];
@ -1215,12 +1219,19 @@ twl_probe(struct i2c_client *client, const struct i2c_device_id *id)
twl_map[TWL_MODULE_MAIN_CHARGE].base = twl_map[TWL_MODULE_MAIN_CHARGE].base =
TWL6025_BASEADD_CHARGER; TWL6025_BASEADD_CHARGER;
twl_regmap_config = twl6030_regmap_config; twl_regmap_config = twl6030_regmap_config;
num_slaves = TWL_NUM_SLAVES - 1;
} else { } else {
twl_id = TWL4030_CLASS_ID; twl_id = TWL4030_CLASS_ID;
twl_map = &twl4030_map[0]; twl_map = &twl4030_map[0];
twl_regmap_config = twl4030_regmap_config; twl_regmap_config = twl4030_regmap_config;
num_slaves = TWL_NUM_SLAVES; }
num_slaves = twl_get_num_slaves();
twl_modules = devm_kzalloc(&client->dev,
sizeof(struct twl_client) * num_slaves,
GFP_KERNEL);
if (!twl_modules) {
status = -ENOMEM;
goto free;
} }
for (i = 0; i < num_slaves; i++) { for (i = 0; i < num_slaves; i++) {