diff options
Diffstat (limited to 'drivers/iio/temperature/tmp007.c')
| -rw-r--r-- | drivers/iio/temperature/tmp007.c | 36 | 
1 files changed, 15 insertions, 21 deletions
| diff --git a/drivers/iio/temperature/tmp007.c b/drivers/iio/temperature/tmp007.c index ad2b35c65548..b422371a4674 100644 --- a/drivers/iio/temperature/tmp007.c +++ b/drivers/iio/temperature/tmp007.c @@ -439,6 +439,13 @@ static bool tmp007_identify(struct i2c_client *client)  	return (manf_id == TMP007_MANUFACTURER_MAGIC && dev_id == TMP007_DEVICE_MAGIC);  } +static void tmp007_powerdown_action_cb(void *priv) +{ +	struct tmp007_data *data = priv; + +	tmp007_powerdown(data); +} +  static int tmp007_probe(struct i2c_client *client,  			const struct i2c_device_id *tmp007_id)  { @@ -489,6 +496,10 @@ static int tmp007_probe(struct i2c_client *client,  	if (ret < 0)  		return ret; +	ret = devm_add_action_or_reset(&client->dev, tmp007_powerdown_action_cb, data); +	if (ret) +		return ret; +  	/*  	 * Only the following flags can activate ALERT pin. Data conversion/validity flags  	 * flags can still be polled for getting temperature data @@ -502,7 +513,7 @@ static int tmp007_probe(struct i2c_client *client,  	ret = i2c_smbus_read_word_swapped(data->client, TMP007_STATUS_MASK);  	if (ret < 0) -		goto error_powerdown; +		return ret;  	data->status_mask = ret;  	data->status_mask |= (TMP007_STATUS_OHF | TMP007_STATUS_OLF @@ -510,7 +521,7 @@ static int tmp007_probe(struct i2c_client *client,  	ret = i2c_smbus_write_word_swapped(data->client, TMP007_STATUS_MASK, data->status_mask);  	if (ret < 0) -		goto error_powerdown; +		return ret;  	if (client->irq) {  		ret = devm_request_threaded_irq(&client->dev, client->irq, @@ -519,27 +530,11 @@ static int tmp007_probe(struct i2c_client *client,  				tmp007_id->name, indio_dev);  		if (ret) {  			dev_err(&client->dev, "irq request error %d\n", -ret); -			goto error_powerdown; +			return ret;  		}  	} -	return iio_device_register(indio_dev); - -error_powerdown: -	tmp007_powerdown(data); - -	return ret; -} - -static int tmp007_remove(struct i2c_client *client) -{ -	struct iio_dev *indio_dev = i2c_get_clientdata(client); -	struct tmp007_data *data = iio_priv(indio_dev); - -	iio_device_unregister(indio_dev); -	tmp007_powerdown(data); - -	return 0; +	return devm_iio_device_register(&client->dev, indio_dev);  }  #ifdef CONFIG_PM_SLEEP @@ -582,7 +577,6 @@ static struct i2c_driver tmp007_driver = {  		.pm	= &tmp007_pm_ops,  	},  	.probe		= tmp007_probe, -	.remove		= tmp007_remove,  	.id_table	= tmp007_id,  };  module_i2c_driver(tmp007_driver); | 
