|
@@ -538,8 +538,8 @@ static struct regulator_ops tps6507x_ldo_ops = {
|
|
.list_voltage = tps6507x_ldo_list_voltage,
|
|
.list_voltage = tps6507x_ldo_list_voltage,
|
|
};
|
|
};
|
|
|
|
|
|
-static
|
|
|
|
-int tps_6507x_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
|
|
|
|
|
+static int __devinit tps_6507x_probe(struct i2c_client *client,
|
|
|
|
+ const struct i2c_device_id *id)
|
|
{
|
|
{
|
|
static int desc_id;
|
|
static int desc_id;
|
|
const struct tps_info *info = (void *)id->driver_data;
|
|
const struct tps_info *info = (void *)id->driver_data;
|
|
@@ -547,6 +547,7 @@ int tps_6507x_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
|
struct regulator_dev *rdev;
|
|
struct regulator_dev *rdev;
|
|
struct tps_pmic *tps;
|
|
struct tps_pmic *tps;
|
|
int i;
|
|
int i;
|
|
|
|
+ int error;
|
|
|
|
|
|
if (!i2c_check_functionality(client->adapter,
|
|
if (!i2c_check_functionality(client->adapter,
|
|
I2C_FUNC_SMBUS_BYTE_DATA))
|
|
I2C_FUNC_SMBUS_BYTE_DATA))
|
|
@@ -557,7 +558,6 @@ int tps_6507x_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
|
* coming from the board-evm file.
|
|
* coming from the board-evm file.
|
|
*/
|
|
*/
|
|
init_data = client->dev.platform_data;
|
|
init_data = client->dev.platform_data;
|
|
-
|
|
|
|
if (!init_data)
|
|
if (!init_data)
|
|
return -EIO;
|
|
return -EIO;
|
|
|
|
|
|
@@ -586,18 +586,8 @@ int tps_6507x_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
|
if (IS_ERR(rdev)) {
|
|
if (IS_ERR(rdev)) {
|
|
dev_err(&client->dev, "failed to register %s\n",
|
|
dev_err(&client->dev, "failed to register %s\n",
|
|
id->name);
|
|
id->name);
|
|
-
|
|
|
|
- /* Unregister */
|
|
|
|
- while (i)
|
|
|
|
- regulator_unregister(tps->rdev[--i]);
|
|
|
|
-
|
|
|
|
- tps->client = NULL;
|
|
|
|
-
|
|
|
|
- /* clear the client data in i2c */
|
|
|
|
- i2c_set_clientdata(client, NULL);
|
|
|
|
-
|
|
|
|
- kfree(tps);
|
|
|
|
- return PTR_ERR(rdev);
|
|
|
|
|
|
+ error = PTR_ERR(rdev);
|
|
|
|
+ goto fail;
|
|
}
|
|
}
|
|
|
|
|
|
/* Save regulator for cleanup */
|
|
/* Save regulator for cleanup */
|
|
@@ -607,6 +597,13 @@ int tps_6507x_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
|
i2c_set_clientdata(client, tps);
|
|
i2c_set_clientdata(client, tps);
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
|
|
+
|
|
|
|
+fail:
|
|
|
|
+ while (--i >= 0)
|
|
|
|
+ regulator_unregister(tps->rdev[i]);
|
|
|
|
+
|
|
|
|
+ kfree(tps);
|
|
|
|
+ return error;
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -620,13 +617,12 @@ static int __devexit tps_6507x_remove(struct i2c_client *client)
|
|
struct tps_pmic *tps = i2c_get_clientdata(client);
|
|
struct tps_pmic *tps = i2c_get_clientdata(client);
|
|
int i;
|
|
int i;
|
|
|
|
|
|
|
|
+ /* clear the client data in i2c */
|
|
|
|
+ i2c_set_clientdata(client, NULL);
|
|
|
|
+
|
|
for (i = 0; i < TPS6507X_NUM_REGULATOR; i++)
|
|
for (i = 0; i < TPS6507X_NUM_REGULATOR; i++)
|
|
regulator_unregister(tps->rdev[i]);
|
|
regulator_unregister(tps->rdev[i]);
|
|
|
|
|
|
- tps->client = NULL;
|
|
|
|
-
|
|
|
|
- /* clear the client data in i2c */
|
|
|
|
- i2c_set_clientdata(client, NULL);
|
|
|
|
kfree(tps);
|
|
kfree(tps);
|
|
|
|
|
|
return 0;
|
|
return 0;
|