forked from Minki/linux
0d92aa2c27
Update the sensor settings to support the LSM9DS1 sensor. Although the LSM9DS1 accelerometer and gyroscope are coupled together to use the same FIFO, the magnetometer is separate and can be cleanly supported without refactoring the existing driver. Signed-off-by: Martin Kelly <martin@martingkelly.com> Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
116 lines
2.5 KiB
C
116 lines
2.5 KiB
C
/*
|
|
* STMicroelectronics magnetometers driver
|
|
*
|
|
* Copyright 2012-2013 STMicroelectronics Inc.
|
|
*
|
|
* Denis Ciocca <denis.ciocca@st.com>
|
|
*
|
|
* Licensed under the GPL-2.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/iio/iio.h>
|
|
|
|
#include <linux/iio/common/st_sensors.h>
|
|
#include <linux/iio/common/st_sensors_i2c.h>
|
|
#include "st_magn.h"
|
|
|
|
#ifdef CONFIG_OF
|
|
static const struct of_device_id st_magn_of_match[] = {
|
|
{
|
|
.compatible = "st,lsm303dlh-magn",
|
|
.data = LSM303DLH_MAGN_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,lsm303dlhc-magn",
|
|
.data = LSM303DLHC_MAGN_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,lsm303dlm-magn",
|
|
.data = LSM303DLM_MAGN_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,lis3mdl-magn",
|
|
.data = LIS3MDL_MAGN_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,lsm303agr-magn",
|
|
.data = LSM303AGR_MAGN_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,lis2mdl",
|
|
.data = LIS2MDL_MAGN_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,lsm9ds1-magn",
|
|
.data = LSM9DS1_MAGN_DEV_NAME,
|
|
},
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, st_magn_of_match);
|
|
#else
|
|
#define st_magn_of_match NULL
|
|
#endif
|
|
|
|
static int st_magn_i2c_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
struct iio_dev *indio_dev;
|
|
struct st_sensor_data *mdata;
|
|
int err;
|
|
|
|
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*mdata));
|
|
if (!indio_dev)
|
|
return -ENOMEM;
|
|
|
|
mdata = iio_priv(indio_dev);
|
|
st_sensors_of_name_probe(&client->dev, st_magn_of_match,
|
|
client->name, sizeof(client->name));
|
|
|
|
st_sensors_i2c_configure(indio_dev, client, mdata);
|
|
|
|
err = st_magn_common_probe(indio_dev);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int st_magn_i2c_remove(struct i2c_client *client)
|
|
{
|
|
struct iio_dev *indio_dev = i2c_get_clientdata(client);
|
|
st_magn_common_remove(indio_dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct i2c_device_id st_magn_id_table[] = {
|
|
{ LSM303DLH_MAGN_DEV_NAME },
|
|
{ LSM303DLHC_MAGN_DEV_NAME },
|
|
{ LSM303DLM_MAGN_DEV_NAME },
|
|
{ LIS3MDL_MAGN_DEV_NAME },
|
|
{ LSM303AGR_MAGN_DEV_NAME },
|
|
{ LIS2MDL_MAGN_DEV_NAME },
|
|
{ LSM9DS1_MAGN_DEV_NAME },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, st_magn_id_table);
|
|
|
|
static struct i2c_driver st_magn_driver = {
|
|
.driver = {
|
|
.name = "st-magn-i2c",
|
|
.of_match_table = of_match_ptr(st_magn_of_match),
|
|
},
|
|
.probe = st_magn_i2c_probe,
|
|
.remove = st_magn_i2c_remove,
|
|
.id_table = st_magn_id_table,
|
|
};
|
|
module_i2c_driver(st_magn_driver);
|
|
|
|
MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
|
|
MODULE_DESCRIPTION("STMicroelectronics magnetometers i2c driver");
|
|
MODULE_LICENSE("GPL v2");
|