|
@@ -35,10 +35,12 @@
|
|
#include <linux/iio/trigger.h>
|
|
#include <linux/iio/trigger.h>
|
|
#include <linux/iio/trigger_consumer.h>
|
|
#include <linux/iio/trigger_consumer.h>
|
|
#include <linux/iio/triggered_buffer.h>
|
|
#include <linux/iio/triggered_buffer.h>
|
|
|
|
+#include <linux/regmap.h>
|
|
|
|
+
|
|
|
|
+#include "bmc150-accel.h"
|
|
|
|
|
|
#define BMC150_ACCEL_DRV_NAME "bmc150_accel"
|
|
#define BMC150_ACCEL_DRV_NAME "bmc150_accel"
|
|
#define BMC150_ACCEL_IRQ_NAME "bmc150_accel_event"
|
|
#define BMC150_ACCEL_IRQ_NAME "bmc150_accel_event"
|
|
-#define BMC150_ACCEL_GPIO_NAME "bmc150_accel_int"
|
|
|
|
|
|
|
|
#define BMC150_ACCEL_REG_CHIP_ID 0x00
|
|
#define BMC150_ACCEL_REG_CHIP_ID 0x00
|
|
|
|
|
|
@@ -185,7 +187,9 @@ enum bmc150_accel_trigger_id {
|
|
};
|
|
};
|
|
|
|
|
|
struct bmc150_accel_data {
|
|
struct bmc150_accel_data {
|
|
- struct i2c_client *client;
|
|
|
|
|
|
+ struct regmap *regmap;
|
|
|
|
+ struct device *dev;
|
|
|
|
+ int irq;
|
|
struct bmc150_accel_interrupt interrupts[BMC150_ACCEL_INTERRUPTS];
|
|
struct bmc150_accel_interrupt interrupts[BMC150_ACCEL_INTERRUPTS];
|
|
atomic_t active_intr;
|
|
atomic_t active_intr;
|
|
struct bmc150_accel_trigger triggers[BMC150_ACCEL_TRIGGERS];
|
|
struct bmc150_accel_trigger triggers[BMC150_ACCEL_TRIGGERS];
|
|
@@ -242,6 +246,12 @@ static const struct {
|
|
{500000, BMC150_ACCEL_SLEEP_500_MS},
|
|
{500000, BMC150_ACCEL_SLEEP_500_MS},
|
|
{1000000, BMC150_ACCEL_SLEEP_1_SEC} };
|
|
{1000000, BMC150_ACCEL_SLEEP_1_SEC} };
|
|
|
|
|
|
|
|
+static const struct regmap_config bmc150_i2c_regmap_conf = {
|
|
|
|
+ .reg_bits = 8,
|
|
|
|
+ .val_bits = 8,
|
|
|
|
+ .max_register = 0x3f,
|
|
|
|
+};
|
|
|
|
+
|
|
static int bmc150_accel_set_mode(struct bmc150_accel_data *data,
|
|
static int bmc150_accel_set_mode(struct bmc150_accel_data *data,
|
|
enum bmc150_power_modes mode,
|
|
enum bmc150_power_modes mode,
|
|
int dur_us)
|
|
int dur_us)
|
|
@@ -269,12 +279,11 @@ static int bmc150_accel_set_mode(struct bmc150_accel_data *data,
|
|
lpw_bits = mode << BMC150_ACCEL_PMU_MODE_SHIFT;
|
|
lpw_bits = mode << BMC150_ACCEL_PMU_MODE_SHIFT;
|
|
lpw_bits |= (dur_val << BMC150_ACCEL_PMU_BIT_SLEEP_DUR_SHIFT);
|
|
lpw_bits |= (dur_val << BMC150_ACCEL_PMU_BIT_SLEEP_DUR_SHIFT);
|
|
|
|
|
|
- dev_dbg(&data->client->dev, "Set Mode bits %x\n", lpw_bits);
|
|
|
|
|
|
+ dev_dbg(data->dev, "Set Mode bits %x\n", lpw_bits);
|
|
|
|
|
|
- ret = i2c_smbus_write_byte_data(data->client,
|
|
|
|
- BMC150_ACCEL_REG_PMU_LPW, lpw_bits);
|
|
|
|
|
|
+ ret = regmap_write(data->regmap, BMC150_ACCEL_REG_PMU_LPW, lpw_bits);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error writing reg_pmu_lpw\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error writing reg_pmu_lpw\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -290,8 +299,7 @@ static int bmc150_accel_set_bw(struct bmc150_accel_data *data, int val,
|
|
for (i = 0; i < ARRAY_SIZE(bmc150_accel_samp_freq_table); ++i) {
|
|
for (i = 0; i < ARRAY_SIZE(bmc150_accel_samp_freq_table); ++i) {
|
|
if (bmc150_accel_samp_freq_table[i].val == val &&
|
|
if (bmc150_accel_samp_freq_table[i].val == val &&
|
|
bmc150_accel_samp_freq_table[i].val2 == val2) {
|
|
bmc150_accel_samp_freq_table[i].val2 == val2) {
|
|
- ret = i2c_smbus_write_byte_data(
|
|
|
|
- data->client,
|
|
|
|
|
|
+ ret = regmap_write(data->regmap,
|
|
BMC150_ACCEL_REG_PMU_BW,
|
|
BMC150_ACCEL_REG_PMU_BW,
|
|
bmc150_accel_samp_freq_table[i].bw_bits);
|
|
bmc150_accel_samp_freq_table[i].bw_bits);
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
@@ -308,30 +316,23 @@ static int bmc150_accel_set_bw(struct bmc150_accel_data *data, int val,
|
|
|
|
|
|
static int bmc150_accel_update_slope(struct bmc150_accel_data *data)
|
|
static int bmc150_accel_update_slope(struct bmc150_accel_data *data)
|
|
{
|
|
{
|
|
- int ret, val;
|
|
|
|
|
|
+ int ret;
|
|
|
|
|
|
- ret = i2c_smbus_write_byte_data(data->client, BMC150_ACCEL_REG_INT_6,
|
|
|
|
|
|
+ ret = regmap_write(data->regmap, BMC150_ACCEL_REG_INT_6,
|
|
data->slope_thres);
|
|
data->slope_thres);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error writing reg_int_6\n");
|
|
|
|
- return ret;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- ret = i2c_smbus_read_byte_data(data->client, BMC150_ACCEL_REG_INT_5);
|
|
|
|
- if (ret < 0) {
|
|
|
|
- dev_err(&data->client->dev, "Error reading reg_int_5\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error writing reg_int_6\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
- val = (ret & ~BMC150_ACCEL_SLOPE_DUR_MASK) | data->slope_dur;
|
|
|
|
- ret = i2c_smbus_write_byte_data(data->client, BMC150_ACCEL_REG_INT_5,
|
|
|
|
- val);
|
|
|
|
|
|
+ ret = regmap_update_bits(data->regmap, BMC150_ACCEL_REG_INT_5,
|
|
|
|
+ BMC150_ACCEL_SLOPE_DUR_MASK, data->slope_dur);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error write reg_int_5\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error updating reg_int_5\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
- dev_dbg(&data->client->dev, "%s: %x %x\n", __func__, data->slope_thres,
|
|
|
|
|
|
+ dev_dbg(data->dev, "%s: %x %x\n", __func__, data->slope_thres,
|
|
data->slope_dur);
|
|
data->slope_dur);
|
|
|
|
|
|
return ret;
|
|
return ret;
|
|
@@ -380,17 +381,17 @@ static int bmc150_accel_set_power_state(struct bmc150_accel_data *data, bool on)
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
if (on) {
|
|
if (on) {
|
|
- ret = pm_runtime_get_sync(&data->client->dev);
|
|
|
|
|
|
+ ret = pm_runtime_get_sync(data->dev);
|
|
} else {
|
|
} else {
|
|
- pm_runtime_mark_last_busy(&data->client->dev);
|
|
|
|
- ret = pm_runtime_put_autosuspend(&data->client->dev);
|
|
|
|
|
|
+ pm_runtime_mark_last_busy(data->dev);
|
|
|
|
+ ret = pm_runtime_put_autosuspend(data->dev);
|
|
}
|
|
}
|
|
|
|
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev,
|
|
|
|
|
|
+ dev_err(data->dev,
|
|
"Failed: bmc150_accel_set_power_state for %d\n", on);
|
|
"Failed: bmc150_accel_set_power_state for %d\n", on);
|
|
if (on)
|
|
if (on)
|
|
- pm_runtime_put_noidle(&data->client->dev);
|
|
|
|
|
|
+ pm_runtime_put_noidle(data->dev);
|
|
|
|
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
@@ -470,38 +471,18 @@ static int bmc150_accel_set_interrupt(struct bmc150_accel_data *data, int i,
|
|
return ret;
|
|
return ret;
|
|
|
|
|
|
/* map the interrupt to the appropriate pins */
|
|
/* map the interrupt to the appropriate pins */
|
|
- ret = i2c_smbus_read_byte_data(data->client, info->map_reg);
|
|
|
|
- if (ret < 0) {
|
|
|
|
- dev_err(&data->client->dev, "Error reading reg_int_map\n");
|
|
|
|
- goto out_fix_power_state;
|
|
|
|
- }
|
|
|
|
- if (state)
|
|
|
|
- ret |= info->map_bitmask;
|
|
|
|
- else
|
|
|
|
- ret &= ~info->map_bitmask;
|
|
|
|
-
|
|
|
|
- ret = i2c_smbus_write_byte_data(data->client, info->map_reg,
|
|
|
|
- ret);
|
|
|
|
|
|
+ ret = regmap_update_bits(data->regmap, info->map_reg, info->map_bitmask,
|
|
|
|
+ (state ? info->map_bitmask : 0));
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error writing reg_int_map\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error updating reg_int_map\n");
|
|
goto out_fix_power_state;
|
|
goto out_fix_power_state;
|
|
}
|
|
}
|
|
|
|
|
|
/* enable/disable the interrupt */
|
|
/* enable/disable the interrupt */
|
|
- ret = i2c_smbus_read_byte_data(data->client, info->en_reg);
|
|
|
|
- if (ret < 0) {
|
|
|
|
- dev_err(&data->client->dev, "Error reading reg_int_en\n");
|
|
|
|
- goto out_fix_power_state;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- if (state)
|
|
|
|
- ret |= info->en_bitmask;
|
|
|
|
- else
|
|
|
|
- ret &= ~info->en_bitmask;
|
|
|
|
-
|
|
|
|
- ret = i2c_smbus_write_byte_data(data->client, info->en_reg, ret);
|
|
|
|
|
|
+ ret = regmap_update_bits(data->regmap, info->en_reg, info->en_bitmask,
|
|
|
|
+ (state ? info->en_bitmask : 0));
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error writing reg_int_en\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error updating reg_int_en\n");
|
|
goto out_fix_power_state;
|
|
goto out_fix_power_state;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -523,12 +504,11 @@ static int bmc150_accel_set_scale(struct bmc150_accel_data *data, int val)
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(data->chip_info->scale_table); ++i) {
|
|
for (i = 0; i < ARRAY_SIZE(data->chip_info->scale_table); ++i) {
|
|
if (data->chip_info->scale_table[i].scale == val) {
|
|
if (data->chip_info->scale_table[i].scale == val) {
|
|
- ret = i2c_smbus_write_byte_data(
|
|
|
|
- data->client,
|
|
|
|
|
|
+ ret = regmap_write(data->regmap,
|
|
BMC150_ACCEL_REG_PMU_RANGE,
|
|
BMC150_ACCEL_REG_PMU_RANGE,
|
|
data->chip_info->scale_table[i].reg_range);
|
|
data->chip_info->scale_table[i].reg_range);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev,
|
|
|
|
|
|
+ dev_err(data->dev,
|
|
"Error writing pmu_range\n");
|
|
"Error writing pmu_range\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
@@ -544,16 +524,17 @@ static int bmc150_accel_set_scale(struct bmc150_accel_data *data, int val)
|
|
static int bmc150_accel_get_temp(struct bmc150_accel_data *data, int *val)
|
|
static int bmc150_accel_get_temp(struct bmc150_accel_data *data, int *val)
|
|
{
|
|
{
|
|
int ret;
|
|
int ret;
|
|
|
|
+ unsigned int value;
|
|
|
|
|
|
mutex_lock(&data->mutex);
|
|
mutex_lock(&data->mutex);
|
|
|
|
|
|
- ret = i2c_smbus_read_byte_data(data->client, BMC150_ACCEL_REG_TEMP);
|
|
|
|
|
|
+ ret = regmap_read(data->regmap, BMC150_ACCEL_REG_TEMP, &value);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error reading reg_temp\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error reading reg_temp\n");
|
|
mutex_unlock(&data->mutex);
|
|
mutex_unlock(&data->mutex);
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
- *val = sign_extend32(ret, 7);
|
|
|
|
|
|
+ *val = sign_extend32(value, 7);
|
|
|
|
|
|
mutex_unlock(&data->mutex);
|
|
mutex_unlock(&data->mutex);
|
|
|
|
|
|
@@ -566,6 +547,7 @@ static int bmc150_accel_get_axis(struct bmc150_accel_data *data,
|
|
{
|
|
{
|
|
int ret;
|
|
int ret;
|
|
int axis = chan->scan_index;
|
|
int axis = chan->scan_index;
|
|
|
|
+ unsigned int raw_val;
|
|
|
|
|
|
mutex_lock(&data->mutex);
|
|
mutex_lock(&data->mutex);
|
|
ret = bmc150_accel_set_power_state(data, true);
|
|
ret = bmc150_accel_set_power_state(data, true);
|
|
@@ -574,15 +556,15 @@ static int bmc150_accel_get_axis(struct bmc150_accel_data *data,
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
- ret = i2c_smbus_read_word_data(data->client,
|
|
|
|
- BMC150_ACCEL_AXIS_TO_REG(axis));
|
|
|
|
|
|
+ ret = regmap_bulk_read(data->regmap, BMC150_ACCEL_AXIS_TO_REG(axis),
|
|
|
|
+ &raw_val, 2);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error reading axis %d\n", axis);
|
|
|
|
|
|
+ dev_err(data->dev, "Error reading axis %d\n", axis);
|
|
bmc150_accel_set_power_state(data, false);
|
|
bmc150_accel_set_power_state(data, false);
|
|
mutex_unlock(&data->mutex);
|
|
mutex_unlock(&data->mutex);
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
- *val = sign_extend32(ret >> chan->scan_type.shift,
|
|
|
|
|
|
+ *val = sign_extend32(raw_val >> chan->scan_type.shift,
|
|
chan->scan_type.realbits - 1);
|
|
chan->scan_type.realbits - 1);
|
|
ret = bmc150_accel_set_power_state(data, false);
|
|
ret = bmc150_accel_set_power_state(data, false);
|
|
mutex_unlock(&data->mutex);
|
|
mutex_unlock(&data->mutex);
|
|
@@ -846,52 +828,34 @@ static int bmc150_accel_set_watermark(struct iio_dev *indio_dev, unsigned val)
|
|
* We must read at least one full frame in one burst, otherwise the rest of the
|
|
* We must read at least one full frame in one burst, otherwise the rest of the
|
|
* frame data is discarded.
|
|
* frame data is discarded.
|
|
*/
|
|
*/
|
|
-static int bmc150_accel_fifo_transfer(const struct i2c_client *client,
|
|
|
|
|
|
+static int bmc150_accel_fifo_transfer(struct bmc150_accel_data *data,
|
|
char *buffer, int samples)
|
|
char *buffer, int samples)
|
|
{
|
|
{
|
|
int sample_length = 3 * 2;
|
|
int sample_length = 3 * 2;
|
|
- u8 reg_fifo_data = BMC150_ACCEL_REG_FIFO_DATA;
|
|
|
|
- int ret = -EIO;
|
|
|
|
-
|
|
|
|
- if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
|
|
|
|
- struct i2c_msg msg[2] = {
|
|
|
|
- {
|
|
|
|
- .addr = client->addr,
|
|
|
|
- .flags = 0,
|
|
|
|
- .buf = ®_fifo_data,
|
|
|
|
- .len = sizeof(reg_fifo_data),
|
|
|
|
- },
|
|
|
|
- {
|
|
|
|
- .addr = client->addr,
|
|
|
|
- .flags = I2C_M_RD,
|
|
|
|
- .buf = (u8 *)buffer,
|
|
|
|
- .len = samples * sample_length,
|
|
|
|
- }
|
|
|
|
- };
|
|
|
|
|
|
+ int ret;
|
|
|
|
+ int total_length = samples * sample_length;
|
|
|
|
+ int i;
|
|
|
|
+ size_t step = regmap_get_raw_read_max(data->regmap);
|
|
|
|
|
|
- ret = i2c_transfer(client->adapter, msg, 2);
|
|
|
|
- if (ret != 2)
|
|
|
|
- ret = -EIO;
|
|
|
|
- else
|
|
|
|
- ret = 0;
|
|
|
|
- } else {
|
|
|
|
- int i, step = I2C_SMBUS_BLOCK_MAX / sample_length;
|
|
|
|
-
|
|
|
|
- for (i = 0; i < samples * sample_length; i += step) {
|
|
|
|
- ret = i2c_smbus_read_i2c_block_data(client,
|
|
|
|
- reg_fifo_data, step,
|
|
|
|
- &buffer[i]);
|
|
|
|
- if (ret != step) {
|
|
|
|
- ret = -EIO;
|
|
|
|
- break;
|
|
|
|
- }
|
|
|
|
|
|
+ if (!step || step > total_length)
|
|
|
|
+ step = total_length;
|
|
|
|
+ else if (step < total_length)
|
|
|
|
+ step = sample_length;
|
|
|
|
|
|
- ret = 0;
|
|
|
|
- }
|
|
|
|
|
|
+ /*
|
|
|
|
+ * Seems we have a bus with size limitation so we have to execute
|
|
|
|
+ * multiple reads
|
|
|
|
+ */
|
|
|
|
+ for (i = 0; i < total_length; i += step) {
|
|
|
|
+ ret = regmap_raw_read(data->regmap, BMC150_ACCEL_REG_FIFO_DATA,
|
|
|
|
+ &buffer[i], step);
|
|
|
|
+ if (ret)
|
|
|
|
+ break;
|
|
}
|
|
}
|
|
|
|
|
|
if (ret)
|
|
if (ret)
|
|
- dev_err(&client->dev, "Error transferring data from fifo\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error transferring data from fifo in single steps of %zu\n",
|
|
|
|
+ step);
|
|
|
|
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
@@ -905,15 +869,15 @@ static int __bmc150_accel_fifo_flush(struct iio_dev *indio_dev,
|
|
u16 buffer[BMC150_ACCEL_FIFO_LENGTH * 3];
|
|
u16 buffer[BMC150_ACCEL_FIFO_LENGTH * 3];
|
|
int64_t tstamp;
|
|
int64_t tstamp;
|
|
uint64_t sample_period;
|
|
uint64_t sample_period;
|
|
|
|
+ unsigned int val;
|
|
|
|
|
|
- ret = i2c_smbus_read_byte_data(data->client,
|
|
|
|
- BMC150_ACCEL_REG_FIFO_STATUS);
|
|
|
|
|
|
+ ret = regmap_read(data->regmap, BMC150_ACCEL_REG_FIFO_STATUS, &val);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error reading reg_fifo_status\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error reading reg_fifo_status\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
- count = ret & 0x7F;
|
|
|
|
|
|
+ count = val & 0x7F;
|
|
|
|
|
|
if (!count)
|
|
if (!count)
|
|
return 0;
|
|
return 0;
|
|
@@ -952,7 +916,7 @@ static int __bmc150_accel_fifo_flush(struct iio_dev *indio_dev,
|
|
if (samples && count > samples)
|
|
if (samples && count > samples)
|
|
count = samples;
|
|
count = samples;
|
|
|
|
|
|
- ret = bmc150_accel_fifo_transfer(data->client, (u8 *)buffer, count);
|
|
|
|
|
|
+ ret = bmc150_accel_fifo_transfer(data, (u8 *)buffer, count);
|
|
if (ret)
|
|
if (ret)
|
|
return ret;
|
|
return ret;
|
|
|
|
|
|
@@ -1052,15 +1016,6 @@ static const struct iio_chan_spec bmc150_accel_channels[] =
|
|
static const struct iio_chan_spec bma280_accel_channels[] =
|
|
static const struct iio_chan_spec bma280_accel_channels[] =
|
|
BMC150_ACCEL_CHANNELS(14);
|
|
BMC150_ACCEL_CHANNELS(14);
|
|
|
|
|
|
-enum {
|
|
|
|
- bmc150,
|
|
|
|
- bmi055,
|
|
|
|
- bma255,
|
|
|
|
- bma250e,
|
|
|
|
- bma222e,
|
|
|
|
- bma280,
|
|
|
|
-};
|
|
|
|
-
|
|
|
|
static const struct bmc150_accel_chip_info bmc150_accel_chip_info_tbl[] = {
|
|
static const struct bmc150_accel_chip_info bmc150_accel_chip_info_tbl[] = {
|
|
[bmc150] = {
|
|
[bmc150] = {
|
|
.name = "BMC150A",
|
|
.name = "BMC150A",
|
|
@@ -1155,17 +1110,19 @@ static irqreturn_t bmc150_accel_trigger_handler(int irq, void *p)
|
|
struct iio_dev *indio_dev = pf->indio_dev;
|
|
struct iio_dev *indio_dev = pf->indio_dev;
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
int bit, ret, i = 0;
|
|
int bit, ret, i = 0;
|
|
|
|
+ unsigned int raw_val;
|
|
|
|
|
|
mutex_lock(&data->mutex);
|
|
mutex_lock(&data->mutex);
|
|
for_each_set_bit(bit, indio_dev->active_scan_mask,
|
|
for_each_set_bit(bit, indio_dev->active_scan_mask,
|
|
indio_dev->masklength) {
|
|
indio_dev->masklength) {
|
|
- ret = i2c_smbus_read_word_data(data->client,
|
|
|
|
- BMC150_ACCEL_AXIS_TO_REG(bit));
|
|
|
|
|
|
+ ret = regmap_bulk_read(data->regmap,
|
|
|
|
+ BMC150_ACCEL_AXIS_TO_REG(bit), &raw_val,
|
|
|
|
+ 2);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
mutex_unlock(&data->mutex);
|
|
mutex_unlock(&data->mutex);
|
|
goto err_read;
|
|
goto err_read;
|
|
}
|
|
}
|
|
- data->buffer[i++] = ret;
|
|
|
|
|
|
+ data->buffer[i++] = raw_val;
|
|
}
|
|
}
|
|
mutex_unlock(&data->mutex);
|
|
mutex_unlock(&data->mutex);
|
|
|
|
|
|
@@ -1189,13 +1146,12 @@ static int bmc150_accel_trig_try_reen(struct iio_trigger *trig)
|
|
|
|
|
|
mutex_lock(&data->mutex);
|
|
mutex_lock(&data->mutex);
|
|
/* clear any latched interrupt */
|
|
/* clear any latched interrupt */
|
|
- ret = i2c_smbus_write_byte_data(data->client,
|
|
|
|
- BMC150_ACCEL_REG_INT_RST_LATCH,
|
|
|
|
- BMC150_ACCEL_INT_MODE_LATCH_INT |
|
|
|
|
- BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
|
|
|
|
|
+ ret = regmap_write(data->regmap, BMC150_ACCEL_REG_INT_RST_LATCH,
|
|
|
|
+ BMC150_ACCEL_INT_MODE_LATCH_INT |
|
|
|
|
+ BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
|
mutex_unlock(&data->mutex);
|
|
mutex_unlock(&data->mutex);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev,
|
|
|
|
|
|
+ dev_err(data->dev,
|
|
"Error writing reg_int_rst_latch\n");
|
|
"Error writing reg_int_rst_latch\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
@@ -1249,20 +1205,20 @@ static int bmc150_accel_handle_roc_event(struct iio_dev *indio_dev)
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
int dir;
|
|
int dir;
|
|
int ret;
|
|
int ret;
|
|
|
|
+ unsigned int val;
|
|
|
|
|
|
- ret = i2c_smbus_read_byte_data(data->client,
|
|
|
|
- BMC150_ACCEL_REG_INT_STATUS_2);
|
|
|
|
|
|
+ ret = regmap_read(data->regmap, BMC150_ACCEL_REG_INT_STATUS_2, &val);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error reading reg_int_status_2\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error reading reg_int_status_2\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
- if (ret & BMC150_ACCEL_ANY_MOTION_BIT_SIGN)
|
|
|
|
|
|
+ if (val & BMC150_ACCEL_ANY_MOTION_BIT_SIGN)
|
|
dir = IIO_EV_DIR_FALLING;
|
|
dir = IIO_EV_DIR_FALLING;
|
|
else
|
|
else
|
|
dir = IIO_EV_DIR_RISING;
|
|
dir = IIO_EV_DIR_RISING;
|
|
|
|
|
|
- if (ret & BMC150_ACCEL_ANY_MOTION_BIT_X)
|
|
|
|
|
|
+ if (val & BMC150_ACCEL_ANY_MOTION_BIT_X)
|
|
iio_push_event(indio_dev,
|
|
iio_push_event(indio_dev,
|
|
IIO_MOD_EVENT_CODE(IIO_ACCEL,
|
|
IIO_MOD_EVENT_CODE(IIO_ACCEL,
|
|
0,
|
|
0,
|
|
@@ -1271,7 +1227,7 @@ static int bmc150_accel_handle_roc_event(struct iio_dev *indio_dev)
|
|
dir),
|
|
dir),
|
|
data->timestamp);
|
|
data->timestamp);
|
|
|
|
|
|
- if (ret & BMC150_ACCEL_ANY_MOTION_BIT_Y)
|
|
|
|
|
|
+ if (val & BMC150_ACCEL_ANY_MOTION_BIT_Y)
|
|
iio_push_event(indio_dev,
|
|
iio_push_event(indio_dev,
|
|
IIO_MOD_EVENT_CODE(IIO_ACCEL,
|
|
IIO_MOD_EVENT_CODE(IIO_ACCEL,
|
|
0,
|
|
0,
|
|
@@ -1280,7 +1236,7 @@ static int bmc150_accel_handle_roc_event(struct iio_dev *indio_dev)
|
|
dir),
|
|
dir),
|
|
data->timestamp);
|
|
data->timestamp);
|
|
|
|
|
|
- if (ret & BMC150_ACCEL_ANY_MOTION_BIT_Z)
|
|
|
|
|
|
+ if (val & BMC150_ACCEL_ANY_MOTION_BIT_Z)
|
|
iio_push_event(indio_dev,
|
|
iio_push_event(indio_dev,
|
|
IIO_MOD_EVENT_CODE(IIO_ACCEL,
|
|
IIO_MOD_EVENT_CODE(IIO_ACCEL,
|
|
0,
|
|
0,
|
|
@@ -1315,13 +1271,11 @@ static irqreturn_t bmc150_accel_irq_thread_handler(int irq, void *private)
|
|
}
|
|
}
|
|
|
|
|
|
if (ack) {
|
|
if (ack) {
|
|
- ret = i2c_smbus_write_byte_data(data->client,
|
|
|
|
- BMC150_ACCEL_REG_INT_RST_LATCH,
|
|
|
|
- BMC150_ACCEL_INT_MODE_LATCH_INT |
|
|
|
|
- BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
|
|
|
|
|
+ ret = regmap_write(data->regmap, BMC150_ACCEL_REG_INT_RST_LATCH,
|
|
|
|
+ BMC150_ACCEL_INT_MODE_LATCH_INT |
|
|
|
|
+ BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
|
if (ret)
|
|
if (ret)
|
|
- dev_err(&data->client->dev,
|
|
|
|
- "Error writing reg_int_rst_latch\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error writing reg_int_rst_latch\n");
|
|
|
|
|
|
ret = IRQ_HANDLED;
|
|
ret = IRQ_HANDLED;
|
|
} else {
|
|
} else {
|
|
@@ -1360,32 +1314,6 @@ static irqreturn_t bmc150_accel_irq_handler(int irq, void *private)
|
|
return IRQ_NONE;
|
|
return IRQ_NONE;
|
|
}
|
|
}
|
|
|
|
|
|
-static int bmc150_accel_gpio_probe(struct i2c_client *client,
|
|
|
|
- struct bmc150_accel_data *data)
|
|
|
|
-{
|
|
|
|
- struct device *dev;
|
|
|
|
- struct gpio_desc *gpio;
|
|
|
|
- int ret;
|
|
|
|
-
|
|
|
|
- if (!client)
|
|
|
|
- return -EINVAL;
|
|
|
|
-
|
|
|
|
- dev = &client->dev;
|
|
|
|
-
|
|
|
|
- /* data ready gpio interrupt pin */
|
|
|
|
- gpio = devm_gpiod_get_index(dev, BMC150_ACCEL_GPIO_NAME, 0, GPIOD_IN);
|
|
|
|
- if (IS_ERR(gpio)) {
|
|
|
|
- dev_err(dev, "Failed: gpio get index\n");
|
|
|
|
- return PTR_ERR(gpio);
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- ret = gpiod_to_irq(gpio);
|
|
|
|
-
|
|
|
|
- dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
|
|
|
|
-
|
|
|
|
- return ret;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
static const struct {
|
|
static const struct {
|
|
int intr;
|
|
int intr;
|
|
const char *name;
|
|
const char *name;
|
|
@@ -1423,7 +1351,7 @@ static int bmc150_accel_triggers_setup(struct iio_dev *indio_dev,
|
|
for (i = 0; i < BMC150_ACCEL_TRIGGERS; i++) {
|
|
for (i = 0; i < BMC150_ACCEL_TRIGGERS; i++) {
|
|
struct bmc150_accel_trigger *t = &data->triggers[i];
|
|
struct bmc150_accel_trigger *t = &data->triggers[i];
|
|
|
|
|
|
- t->indio_trig = devm_iio_trigger_alloc(&data->client->dev,
|
|
|
|
|
|
+ t->indio_trig = devm_iio_trigger_alloc(data->dev,
|
|
bmc150_accel_triggers[i].name,
|
|
bmc150_accel_triggers[i].name,
|
|
indio_dev->name,
|
|
indio_dev->name,
|
|
indio_dev->id);
|
|
indio_dev->id);
|
|
@@ -1432,7 +1360,7 @@ static int bmc150_accel_triggers_setup(struct iio_dev *indio_dev,
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
- t->indio_trig->dev.parent = &data->client->dev;
|
|
|
|
|
|
+ t->indio_trig->dev.parent = data->dev;
|
|
t->indio_trig->ops = &bmc150_accel_trigger_ops;
|
|
t->indio_trig->ops = &bmc150_accel_trigger_ops;
|
|
t->intr = bmc150_accel_triggers[i].intr;
|
|
t->intr = bmc150_accel_triggers[i].intr;
|
|
t->data = data;
|
|
t->data = data;
|
|
@@ -1459,20 +1387,19 @@ static int bmc150_accel_fifo_set_mode(struct bmc150_accel_data *data)
|
|
u8 reg = BMC150_ACCEL_REG_FIFO_CONFIG1;
|
|
u8 reg = BMC150_ACCEL_REG_FIFO_CONFIG1;
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
- ret = i2c_smbus_write_byte_data(data->client, reg, data->fifo_mode);
|
|
|
|
|
|
+ ret = regmap_write(data->regmap, reg, data->fifo_mode);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error writing reg_fifo_config1\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error writing reg_fifo_config1\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
if (!data->fifo_mode)
|
|
if (!data->fifo_mode)
|
|
return 0;
|
|
return 0;
|
|
|
|
|
|
- ret = i2c_smbus_write_byte_data(data->client,
|
|
|
|
- BMC150_ACCEL_REG_FIFO_CONFIG0,
|
|
|
|
- data->watermark);
|
|
|
|
|
|
+ ret = regmap_write(data->regmap, BMC150_ACCEL_REG_FIFO_CONFIG0,
|
|
|
|
+ data->watermark);
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
- dev_err(&data->client->dev, "Error writing reg_fifo_config0\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error writing reg_fifo_config0\n");
|
|
|
|
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
@@ -1557,23 +1484,25 @@ static const struct iio_buffer_setup_ops bmc150_accel_buffer_ops = {
|
|
static int bmc150_accel_chip_init(struct bmc150_accel_data *data)
|
|
static int bmc150_accel_chip_init(struct bmc150_accel_data *data)
|
|
{
|
|
{
|
|
int ret, i;
|
|
int ret, i;
|
|
|
|
+ unsigned int val;
|
|
|
|
|
|
- ret = i2c_smbus_read_byte_data(data->client, BMC150_ACCEL_REG_CHIP_ID);
|
|
|
|
|
|
+ ret = regmap_read(data->regmap, BMC150_ACCEL_REG_CHIP_ID, &val);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error: Reading chip id\n");
|
|
|
|
|
|
+ dev_err(data->dev,
|
|
|
|
+ "Error: Reading chip id\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
- dev_dbg(&data->client->dev, "Chip Id %x\n", ret);
|
|
|
|
|
|
+ dev_dbg(data->dev, "Chip Id %x\n", val);
|
|
for (i = 0; i < ARRAY_SIZE(bmc150_accel_chip_info_tbl); i++) {
|
|
for (i = 0; i < ARRAY_SIZE(bmc150_accel_chip_info_tbl); i++) {
|
|
- if (bmc150_accel_chip_info_tbl[i].chip_id == ret) {
|
|
|
|
|
|
+ if (bmc150_accel_chip_info_tbl[i].chip_id == val) {
|
|
data->chip_info = &bmc150_accel_chip_info_tbl[i];
|
|
data->chip_info = &bmc150_accel_chip_info_tbl[i];
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
if (!data->chip_info) {
|
|
if (!data->chip_info) {
|
|
- dev_err(&data->client->dev, "Unsupported chip %x\n", ret);
|
|
|
|
|
|
+ dev_err(data->dev, "Invalid chip %x\n", val);
|
|
return -ENODEV;
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1587,11 +1516,11 @@ static int bmc150_accel_chip_init(struct bmc150_accel_data *data)
|
|
return ret;
|
|
return ret;
|
|
|
|
|
|
/* Set Default Range */
|
|
/* Set Default Range */
|
|
- ret = i2c_smbus_write_byte_data(data->client,
|
|
|
|
- BMC150_ACCEL_REG_PMU_RANGE,
|
|
|
|
- BMC150_ACCEL_DEF_RANGE_4G);
|
|
|
|
|
|
+ ret = regmap_write(data->regmap, BMC150_ACCEL_REG_PMU_RANGE,
|
|
|
|
+ BMC150_ACCEL_DEF_RANGE_4G);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error writing reg_pmu_range\n");
|
|
|
|
|
|
+ dev_err(data->dev,
|
|
|
|
+ "Error writing reg_pmu_range\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1605,12 +1534,11 @@ static int bmc150_accel_chip_init(struct bmc150_accel_data *data)
|
|
return ret;
|
|
return ret;
|
|
|
|
|
|
/* Set default as latched interrupts */
|
|
/* Set default as latched interrupts */
|
|
- ret = i2c_smbus_write_byte_data(data->client,
|
|
|
|
- BMC150_ACCEL_REG_INT_RST_LATCH,
|
|
|
|
- BMC150_ACCEL_INT_MODE_LATCH_INT |
|
|
|
|
- BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
|
|
|
|
|
+ ret = regmap_write(data->regmap, BMC150_ACCEL_REG_INT_RST_LATCH,
|
|
|
|
+ BMC150_ACCEL_INT_MODE_LATCH_INT |
|
|
|
|
+ BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev,
|
|
|
|
|
|
+ dev_err(data->dev,
|
|
"Error writing reg_int_rst_latch\n");
|
|
"Error writing reg_int_rst_latch\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
@@ -1618,24 +1546,23 @@ static int bmc150_accel_chip_init(struct bmc150_accel_data *data)
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
-static int bmc150_accel_probe(struct i2c_client *client,
|
|
|
|
- const struct i2c_device_id *id)
|
|
|
|
|
|
+int bmc150_accel_core_probe(struct device *dev, struct regmap *regmap, int irq,
|
|
|
|
+ const char *name, bool block_supported)
|
|
{
|
|
{
|
|
struct bmc150_accel_data *data;
|
|
struct bmc150_accel_data *data;
|
|
struct iio_dev *indio_dev;
|
|
struct iio_dev *indio_dev;
|
|
int ret;
|
|
int ret;
|
|
- const char *name = NULL;
|
|
|
|
|
|
|
|
- indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
|
|
|
|
|
|
+ indio_dev = devm_iio_device_alloc(dev, sizeof(*data));
|
|
if (!indio_dev)
|
|
if (!indio_dev)
|
|
return -ENOMEM;
|
|
return -ENOMEM;
|
|
|
|
|
|
data = iio_priv(indio_dev);
|
|
data = iio_priv(indio_dev);
|
|
- i2c_set_clientdata(client, indio_dev);
|
|
|
|
- data->client = client;
|
|
|
|
|
|
+ dev_set_drvdata(dev, indio_dev);
|
|
|
|
+ data->dev = dev;
|
|
|
|
+ data->irq = irq;
|
|
|
|
|
|
- if (id)
|
|
|
|
- name = id->name;
|
|
|
|
|
|
+ data->regmap = regmap;
|
|
|
|
|
|
ret = bmc150_accel_chip_init(data);
|
|
ret = bmc150_accel_chip_init(data);
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
@@ -1643,7 +1570,7 @@ static int bmc150_accel_probe(struct i2c_client *client,
|
|
|
|
|
|
mutex_init(&data->mutex);
|
|
mutex_init(&data->mutex);
|
|
|
|
|
|
- indio_dev->dev.parent = &client->dev;
|
|
|
|
|
|
+ indio_dev->dev.parent = dev;
|
|
indio_dev->channels = data->chip_info->channels;
|
|
indio_dev->channels = data->chip_info->channels;
|
|
indio_dev->num_channels = data->chip_info->num_channels;
|
|
indio_dev->num_channels = data->chip_info->num_channels;
|
|
indio_dev->name = name ? name : data->chip_info->name;
|
|
indio_dev->name = name ? name : data->chip_info->name;
|
|
@@ -1655,16 +1582,13 @@ static int bmc150_accel_probe(struct i2c_client *client,
|
|
bmc150_accel_trigger_handler,
|
|
bmc150_accel_trigger_handler,
|
|
&bmc150_accel_buffer_ops);
|
|
&bmc150_accel_buffer_ops);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&client->dev, "Failed: iio triggered buffer setup\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Failed: iio triggered buffer setup\n");
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
- if (client->irq < 0)
|
|
|
|
- client->irq = bmc150_accel_gpio_probe(client, data);
|
|
|
|
-
|
|
|
|
- if (client->irq > 0) {
|
|
|
|
|
|
+ if (data->irq > 0) {
|
|
ret = devm_request_threaded_irq(
|
|
ret = devm_request_threaded_irq(
|
|
- &client->dev, client->irq,
|
|
|
|
|
|
+ data->dev, data->irq,
|
|
bmc150_accel_irq_handler,
|
|
bmc150_accel_irq_handler,
|
|
bmc150_accel_irq_thread_handler,
|
|
bmc150_accel_irq_thread_handler,
|
|
IRQF_TRIGGER_RISING,
|
|
IRQF_TRIGGER_RISING,
|
|
@@ -1679,11 +1603,10 @@ static int bmc150_accel_probe(struct i2c_client *client,
|
|
* want to use latch mode when we can to prevent interrupt
|
|
* want to use latch mode when we can to prevent interrupt
|
|
* flooding.
|
|
* flooding.
|
|
*/
|
|
*/
|
|
- ret = i2c_smbus_write_byte_data(data->client,
|
|
|
|
- BMC150_ACCEL_REG_INT_RST_LATCH,
|
|
|
|
- BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
|
|
|
|
|
+ ret = regmap_write(data->regmap, BMC150_ACCEL_REG_INT_RST_LATCH,
|
|
|
|
+ BMC150_ACCEL_INT_MODE_LATCH_RESET);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&data->client->dev, "Error writing reg_int_rst_latch\n");
|
|
|
|
|
|
+ dev_err(data->dev, "Error writing reg_int_rst_latch\n");
|
|
goto err_buffer_cleanup;
|
|
goto err_buffer_cleanup;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -1693,9 +1616,7 @@ static int bmc150_accel_probe(struct i2c_client *client,
|
|
if (ret)
|
|
if (ret)
|
|
goto err_buffer_cleanup;
|
|
goto err_buffer_cleanup;
|
|
|
|
|
|
- if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C) ||
|
|
|
|
- i2c_check_functionality(client->adapter,
|
|
|
|
- I2C_FUNC_SMBUS_READ_I2C_BLOCK)) {
|
|
|
|
|
|
+ if (block_supported) {
|
|
indio_dev->modes |= INDIO_BUFFER_SOFTWARE;
|
|
indio_dev->modes |= INDIO_BUFFER_SOFTWARE;
|
|
indio_dev->info = &bmc150_accel_info_fifo;
|
|
indio_dev->info = &bmc150_accel_info_fifo;
|
|
indio_dev->buffer->attrs = bmc150_accel_fifo_attributes;
|
|
indio_dev->buffer->attrs = bmc150_accel_fifo_attributes;
|
|
@@ -1704,18 +1625,17 @@ static int bmc150_accel_probe(struct i2c_client *client,
|
|
|
|
|
|
ret = iio_device_register(indio_dev);
|
|
ret = iio_device_register(indio_dev);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
- dev_err(&client->dev, "Unable to register iio device\n");
|
|
|
|
|
|
+ dev_err(dev, "Unable to register iio device\n");
|
|
goto err_trigger_unregister;
|
|
goto err_trigger_unregister;
|
|
}
|
|
}
|
|
|
|
|
|
- ret = pm_runtime_set_active(&client->dev);
|
|
|
|
|
|
+ ret = pm_runtime_set_active(dev);
|
|
if (ret)
|
|
if (ret)
|
|
goto err_iio_unregister;
|
|
goto err_iio_unregister;
|
|
|
|
|
|
- pm_runtime_enable(&client->dev);
|
|
|
|
- pm_runtime_set_autosuspend_delay(&client->dev,
|
|
|
|
- BMC150_AUTO_SUSPEND_DELAY_MS);
|
|
|
|
- pm_runtime_use_autosuspend(&client->dev);
|
|
|
|
|
|
+ pm_runtime_enable(dev);
|
|
|
|
+ pm_runtime_set_autosuspend_delay(dev, BMC150_AUTO_SUSPEND_DELAY_MS);
|
|
|
|
+ pm_runtime_use_autosuspend(dev);
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
|
|
|
|
@@ -1728,15 +1648,16 @@ err_buffer_cleanup:
|
|
|
|
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
+EXPORT_SYMBOL_GPL(bmc150_accel_core_probe);
|
|
|
|
|
|
-static int bmc150_accel_remove(struct i2c_client *client)
|
|
|
|
|
|
+int bmc150_accel_core_remove(struct device *dev)
|
|
{
|
|
{
|
|
- struct iio_dev *indio_dev = i2c_get_clientdata(client);
|
|
|
|
|
|
+ struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
|
|
|
|
- pm_runtime_disable(&client->dev);
|
|
|
|
- pm_runtime_set_suspended(&client->dev);
|
|
|
|
- pm_runtime_put_noidle(&client->dev);
|
|
|
|
|
|
+ pm_runtime_disable(data->dev);
|
|
|
|
+ pm_runtime_set_suspended(data->dev);
|
|
|
|
+ pm_runtime_put_noidle(data->dev);
|
|
|
|
|
|
iio_device_unregister(indio_dev);
|
|
iio_device_unregister(indio_dev);
|
|
|
|
|
|
@@ -1750,11 +1671,12 @@ static int bmc150_accel_remove(struct i2c_client *client)
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
+EXPORT_SYMBOL_GPL(bmc150_accel_core_remove);
|
|
|
|
|
|
#ifdef CONFIG_PM_SLEEP
|
|
#ifdef CONFIG_PM_SLEEP
|
|
static int bmc150_accel_suspend(struct device *dev)
|
|
static int bmc150_accel_suspend(struct device *dev)
|
|
{
|
|
{
|
|
- struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
|
|
|
|
|
+ struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
|
|
|
|
mutex_lock(&data->mutex);
|
|
mutex_lock(&data->mutex);
|
|
@@ -1766,7 +1688,7 @@ static int bmc150_accel_suspend(struct device *dev)
|
|
|
|
|
|
static int bmc150_accel_resume(struct device *dev)
|
|
static int bmc150_accel_resume(struct device *dev)
|
|
{
|
|
{
|
|
- struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
|
|
|
|
|
+ struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
|
|
|
|
mutex_lock(&data->mutex);
|
|
mutex_lock(&data->mutex);
|
|
@@ -1782,11 +1704,11 @@ static int bmc150_accel_resume(struct device *dev)
|
|
#ifdef CONFIG_PM
|
|
#ifdef CONFIG_PM
|
|
static int bmc150_accel_runtime_suspend(struct device *dev)
|
|
static int bmc150_accel_runtime_suspend(struct device *dev)
|
|
{
|
|
{
|
|
- struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
|
|
|
|
|
+ struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
- dev_dbg(&data->client->dev, __func__);
|
|
|
|
|
|
+ dev_dbg(data->dev, __func__);
|
|
ret = bmc150_accel_set_mode(data, BMC150_ACCEL_SLEEP_MODE_SUSPEND, 0);
|
|
ret = bmc150_accel_set_mode(data, BMC150_ACCEL_SLEEP_MODE_SUSPEND, 0);
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
return -EAGAIN;
|
|
return -EAGAIN;
|
|
@@ -1796,12 +1718,12 @@ static int bmc150_accel_runtime_suspend(struct device *dev)
|
|
|
|
|
|
static int bmc150_accel_runtime_resume(struct device *dev)
|
|
static int bmc150_accel_runtime_resume(struct device *dev)
|
|
{
|
|
{
|
|
- struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
|
|
|
|
|
+ struct iio_dev *indio_dev = dev_get_drvdata(dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
struct bmc150_accel_data *data = iio_priv(indio_dev);
|
|
int ret;
|
|
int ret;
|
|
int sleep_val;
|
|
int sleep_val;
|
|
|
|
|
|
- dev_dbg(&data->client->dev, __func__);
|
|
|
|
|
|
+ dev_dbg(data->dev, __func__);
|
|
|
|
|
|
ret = bmc150_accel_set_mode(data, BMC150_ACCEL_SLEEP_MODE_NORMAL, 0);
|
|
ret = bmc150_accel_set_mode(data, BMC150_ACCEL_SLEEP_MODE_NORMAL, 0);
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
@@ -1820,47 +1742,12 @@ static int bmc150_accel_runtime_resume(struct device *dev)
|
|
}
|
|
}
|
|
#endif
|
|
#endif
|
|
|
|
|
|
-static const struct dev_pm_ops bmc150_accel_pm_ops = {
|
|
|
|
|
|
+const struct dev_pm_ops bmc150_accel_pm_ops = {
|
|
SET_SYSTEM_SLEEP_PM_OPS(bmc150_accel_suspend, bmc150_accel_resume)
|
|
SET_SYSTEM_SLEEP_PM_OPS(bmc150_accel_suspend, bmc150_accel_resume)
|
|
SET_RUNTIME_PM_OPS(bmc150_accel_runtime_suspend,
|
|
SET_RUNTIME_PM_OPS(bmc150_accel_runtime_suspend,
|
|
bmc150_accel_runtime_resume, NULL)
|
|
bmc150_accel_runtime_resume, NULL)
|
|
};
|
|
};
|
|
-
|
|
|
|
-static const struct acpi_device_id bmc150_accel_acpi_match[] = {
|
|
|
|
- {"BSBA0150", bmc150},
|
|
|
|
- {"BMC150A", bmc150},
|
|
|
|
- {"BMI055A", bmi055},
|
|
|
|
- {"BMA0255", bma255},
|
|
|
|
- {"BMA250E", bma250e},
|
|
|
|
- {"BMA222E", bma222e},
|
|
|
|
- {"BMA0280", bma280},
|
|
|
|
- { },
|
|
|
|
-};
|
|
|
|
-MODULE_DEVICE_TABLE(acpi, bmc150_accel_acpi_match);
|
|
|
|
-
|
|
|
|
-static const struct i2c_device_id bmc150_accel_id[] = {
|
|
|
|
- {"bmc150_accel", bmc150},
|
|
|
|
- {"bmi055_accel", bmi055},
|
|
|
|
- {"bma255", bma255},
|
|
|
|
- {"bma250e", bma250e},
|
|
|
|
- {"bma222e", bma222e},
|
|
|
|
- {"bma280", bma280},
|
|
|
|
- {}
|
|
|
|
-};
|
|
|
|
-
|
|
|
|
-MODULE_DEVICE_TABLE(i2c, bmc150_accel_id);
|
|
|
|
-
|
|
|
|
-static struct i2c_driver bmc150_accel_driver = {
|
|
|
|
- .driver = {
|
|
|
|
- .name = BMC150_ACCEL_DRV_NAME,
|
|
|
|
- .acpi_match_table = ACPI_PTR(bmc150_accel_acpi_match),
|
|
|
|
- .pm = &bmc150_accel_pm_ops,
|
|
|
|
- },
|
|
|
|
- .probe = bmc150_accel_probe,
|
|
|
|
- .remove = bmc150_accel_remove,
|
|
|
|
- .id_table = bmc150_accel_id,
|
|
|
|
-};
|
|
|
|
-module_i2c_driver(bmc150_accel_driver);
|
|
|
|
|
|
+EXPORT_SYMBOL_GPL(bmc150_accel_pm_ops);
|
|
|
|
|
|
MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
|
|
MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_LICENSE("GPL v2");
|