45a4e4220b
Add proper support for L3GD20H gyroscope sensor. In particular: - use L3GD20H as device name instead of L3GD20 - fix available full scales - fix available sample frequencies Note that the original patch listed first below introduced broken support for this part. The second patch drops the support as it didn't work. This new patch brings in working support. Fixes:9444a300c2(IIO: Add support for L3GD20H gyroscope) Fixes:a065771641("iio:gyro: bug on L3GD20H gyroscope support") Signed-off-by: Lorenzo Bianconi <lorenzo.bianconi@st.com> Signed-off-by: Jonathan Cameron <jic23@kernel.org>
124 lines
2.6 KiB
C
124 lines
2.6 KiB
C
/*
|
|
* STMicroelectronics gyroscopes 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_gyro.h"
|
|
|
|
#ifdef CONFIG_OF
|
|
static const struct of_device_id st_gyro_of_match[] = {
|
|
{
|
|
.compatible = "st,l3g4200d-gyro",
|
|
.data = L3G4200D_GYRO_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,lsm330d-gyro",
|
|
.data = LSM330D_GYRO_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,lsm330dl-gyro",
|
|
.data = LSM330DL_GYRO_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,lsm330dlc-gyro",
|
|
.data = LSM330DLC_GYRO_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,l3gd20-gyro",
|
|
.data = L3GD20_GYRO_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,l3gd20h-gyro",
|
|
.data = L3GD20H_GYRO_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,l3g4is-gyro",
|
|
.data = L3G4IS_GYRO_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,lsm330-gyro",
|
|
.data = LSM330_GYRO_DEV_NAME,
|
|
},
|
|
{
|
|
.compatible = "st,lsm9ds0-gyro",
|
|
.data = LSM9DS0_GYRO_DEV_NAME,
|
|
},
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, st_gyro_of_match);
|
|
#else
|
|
#define st_gyro_of_match NULL
|
|
#endif
|
|
|
|
static int st_gyro_i2c_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
struct iio_dev *indio_dev;
|
|
struct st_sensor_data *gdata;
|
|
int err;
|
|
|
|
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*gdata));
|
|
if (!indio_dev)
|
|
return -ENOMEM;
|
|
|
|
gdata = iio_priv(indio_dev);
|
|
st_sensors_of_i2c_probe(client, st_gyro_of_match);
|
|
|
|
st_sensors_i2c_configure(indio_dev, client, gdata);
|
|
|
|
err = st_gyro_common_probe(indio_dev);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int st_gyro_i2c_remove(struct i2c_client *client)
|
|
{
|
|
st_gyro_common_remove(i2c_get_clientdata(client));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct i2c_device_id st_gyro_id_table[] = {
|
|
{ L3G4200D_GYRO_DEV_NAME },
|
|
{ LSM330D_GYRO_DEV_NAME },
|
|
{ LSM330DL_GYRO_DEV_NAME },
|
|
{ LSM330DLC_GYRO_DEV_NAME },
|
|
{ L3GD20_GYRO_DEV_NAME },
|
|
{ L3GD20H_GYRO_DEV_NAME },
|
|
{ L3G4IS_GYRO_DEV_NAME },
|
|
{ LSM330_GYRO_DEV_NAME },
|
|
{ LSM9DS0_GYRO_DEV_NAME },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, st_gyro_id_table);
|
|
|
|
static struct i2c_driver st_gyro_driver = {
|
|
.driver = {
|
|
.name = "st-gyro-i2c",
|
|
.of_match_table = of_match_ptr(st_gyro_of_match),
|
|
},
|
|
.probe = st_gyro_i2c_probe,
|
|
.remove = st_gyro_i2c_remove,
|
|
.id_table = st_gyro_id_table,
|
|
};
|
|
module_i2c_driver(st_gyro_driver);
|
|
|
|
MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
|
|
MODULE_DESCRIPTION("STMicroelectronics gyroscopes i2c driver");
|
|
MODULE_LICENSE("GPL v2");
|