[linux.git] / drivers / iio / gyro / st_gyro_i2c.c

/*
 * STMicroelectronics gyroscopes driver
 *
 * Copyright 2012-2013 STMicroelectronics Inc.
 *
 * Denis Ciocca <[email protected]>
 *
 * 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_name_probe(&client->dev, st_gyro_of_match,
				 client->name, sizeof(client->name));

	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 <[email protected]>");
MODULE_DESCRIPTION("STMicroelectronics gyroscopes i2c driver");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
7be56a8f DC	1	/*
	2	* STMicroelectronics gyroscopes driver
	3	*
	4	* Copyright 2012-2013 STMicroelectronics Inc.
	5	*
	6	* Denis Ciocca <[email protected]>
	7	*
	8	* Licensed under the GPL-2.
	9	*/
	10
	11	#include <linux/kernel.h>
	12	#include <linux/module.h>
	13	#include <linux/slab.h>
	14	#include <linux/i2c.h>
	15	#include <linux/iio/iio.h>
7be56a8f DC	16
	17	#include <linux/iio/common/st_sensors.h>
	18	#include <linux/iio/common/st_sensors_i2c.h>
	19	#include "st_gyro.h"
	20
2d7768a8 LW	21	#ifdef CONFIG_OF
	22	static const struct of_device_id st_gyro_of_match[] = {
	23	{
	24	.compatible = "st,l3g4200d-gyro",
	25	.data = L3G4200D_GYRO_DEV_NAME,
	26	},
	27	{
	28	.compatible = "st,lsm330d-gyro",
	29	.data = LSM330D_GYRO_DEV_NAME,
	30	},
	31	{
	32	.compatible = "st,lsm330dl-gyro",
	33	.data = LSM330DL_GYRO_DEV_NAME,
	34	},
	35	{
	36	.compatible = "st,lsm330dlc-gyro",
	37	.data = LSM330DLC_GYRO_DEV_NAME,
	38	},
	39	{
	40	.compatible = "st,l3gd20-gyro",
	41	.data = L3GD20_GYRO_DEV_NAME,
	42	},
45a4e422 LB	43	{
	44	.compatible = "st,l3gd20h-gyro",
	45	.data = L3GD20H_GYRO_DEV_NAME,
	46	},
2d7768a8 LW	47	{
	48	.compatible = "st,l3g4is-gyro",
	49	.data = L3G4IS_GYRO_DEV_NAME,
	50	},
	51	{
	52	.compatible = "st,lsm330-gyro",
	53	.data = LSM330_GYRO_DEV_NAME,
	54	},
41c128cb LC	55	{
	56	.compatible = "st,lsm9ds0-gyro",
	57	.data = LSM9DS0_GYRO_DEV_NAME,
	58	},
2d7768a8 LW	59	{},
	60	};
	61	MODULE_DEVICE_TABLE(of, st_gyro_of_match);
	62	#else
	63	#define st_gyro_of_match NULL
	64	#endif
	65
7be56a8f DC	66	static int st_gyro_i2c_probe(struct i2c_client *client,
	67	const struct i2c_device_id *id)
	68	{
	69	struct iio_dev *indio_dev;
	70	struct st_sensor_data *gdata;
	71	int err;
	72
7a842ed6 SK	73	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*gdata));
	74	if (!indio_dev)
	75	return -ENOMEM;
7be56a8f DC	76
7be56a8f DC	77	gdata = iio_priv(indio_dev);
250bbbdb LB	78	st_sensors_of_name_probe(&client->dev, st_gyro_of_match,
250bbbdb LB	79	client->name, sizeof(client->name));
7be56a8f DC	80
	81	st_sensors_i2c_configure(indio_dev, client, gdata);
	82
ef67b341	83	err = st_gyro_common_probe(indio_dev);
7be56a8f	84	if (err < 0)
7a842ed6	85	return err;
7be56a8f DC	86
7be56a8f DC	87	return 0;
7be56a8f DC	88	}
	89
	90	static int st_gyro_i2c_remove(struct i2c_client *client)
	91	{
	92	st_gyro_common_remove(i2c_get_clientdata(client));
	93
	94	return 0;
	95	}
	96
	97	static const struct i2c_device_id st_gyro_id_table[] = {
	98	{ L3G4200D_GYRO_DEV_NAME },
	99	{ LSM330D_GYRO_DEV_NAME },
	100	{ LSM330DL_GYRO_DEV_NAME },
	101	{ LSM330DLC_GYRO_DEV_NAME },
	102	{ L3GD20_GYRO_DEV_NAME },
45a4e422	103	{ L3GD20H_GYRO_DEV_NAME },
7be56a8f DC	104	{ L3G4IS_GYRO_DEV_NAME },
7be56a8f DC	105	{ LSM330_GYRO_DEV_NAME },
41c128cb	106	{ LSM9DS0_GYRO_DEV_NAME },
7be56a8f DC	107	{},
	108	};
	109	MODULE_DEVICE_TABLE(i2c, st_gyro_id_table);
	110
	111	static struct i2c_driver st_gyro_driver = {
	112	.driver = {
7be56a8f	113	.name = "st-gyro-i2c",
2d7768a8	114	.of_match_table = of_match_ptr(st_gyro_of_match),
7be56a8f DC	115	},
	116	.probe = st_gyro_i2c_probe,
	117	.remove = st_gyro_i2c_remove,
	118	.id_table = st_gyro_id_table,
	119	};
	120	module_i2c_driver(st_gyro_driver);
	121
	122	MODULE_AUTHOR("Denis Ciocca <[email protected]>");
	123	MODULE_DESCRIPTION("STMicroelectronics gyroscopes i2c driver");
	124	MODULE_LICENSE("GPL v2");