tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
1/*
2 * STMicroelectronics magnetometers driver
3 *
4 * Copyright 2012-2013 STMicroelectronics Inc.
5 *
6 * Denis Ciocca <denis.ciocca@st.com>
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>
16
17#include <linux/iio/common/st_sensors.h>
18#include <linux/iio/common/st_sensors_i2c.h>
19#include "st_magn.h"
20
21#ifdef CONFIG_OF
22static const struct of_device_id st_magn_of_match[] = {
23 {
24 .compatible = "st,lsm303dlhc-magn",
25 .data = LSM303DLHC_MAGN_DEV_NAME,
26 },
27 {
28 .compatible = "st,lsm303dlm-magn",
29 .data = LSM303DLM_MAGN_DEV_NAME,
30 },
31 {
32 .compatible = "st,lis3mdl-magn",
33 .data = LIS3MDL_MAGN_DEV_NAME,
34 },
35 {},
36};
37MODULE_DEVICE_TABLE(of, st_magn_of_match);
38#else
39#define st_magn_of_match NULL
40#endif
41
42static int st_magn_i2c_probe(struct i2c_client *client,
43 const struct i2c_device_id *id)
44{
45 struct iio_dev *indio_dev;
46 struct st_sensor_data *mdata;
47 int err;
48
49 indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*mdata));
50 if (!indio_dev)
51 return -ENOMEM;
52
53 mdata = iio_priv(indio_dev);
54 st_sensors_of_i2c_probe(client, st_magn_of_match);
55
56 st_sensors_i2c_configure(indio_dev, client, mdata);
57
58 err = st_magn_common_probe(indio_dev);
59 if (err < 0)
60 return err;
61
62 return 0;
63}
64
65static int st_magn_i2c_remove(struct i2c_client *client)
66{
67 struct iio_dev *indio_dev = i2c_get_clientdata(client);
68 st_magn_common_remove(indio_dev);
69
70 return 0;
71}
72
73static const struct i2c_device_id st_magn_id_table[] = {
74 { LSM303DLHC_MAGN_DEV_NAME },
75 { LSM303DLM_MAGN_DEV_NAME },
76 { LIS3MDL_MAGN_DEV_NAME },
77 {},
78};
79MODULE_DEVICE_TABLE(i2c, st_magn_id_table);
80
81static struct i2c_driver st_magn_driver = {
82 .driver = {
83 .owner = THIS_MODULE,
84 .name = "st-magn-i2c",
85 .of_match_table = of_match_ptr(st_magn_of_match),
86 },
87 .probe = st_magn_i2c_probe,
88 .remove = st_magn_i2c_remove,
89 .id_table = st_magn_id_table,
90};
91module_i2c_driver(st_magn_driver);
92
93MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
94MODULE_DESCRIPTION("STMicroelectronics magnetometers i2c driver");
95MODULE_LICENSE("GPL v2");