1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * STMicroelectronics magnetometers driver
4 *
5 * Copyright 2012-2013 STMicroelectronics Inc.
6 *
7 * Denis Ciocca <denis.ciocca@st.com>
8 */
9
10#include <linux/kernel.h>
11#include <linux/module.h>
12#include <linux/mod_devicetable.h>
13#include <linux/i2c.h>
14#include <linux/iio/iio.h>
15
16#include <linux/iio/common/st_sensors.h>
17#include <linux/iio/common/st_sensors_i2c.h>
18#include "st_magn.h"
19
20static const struct of_device_id st_magn_of_match[] = {
21	{
22		.compatible = "st,lsm303dlh-magn",
23		.data = LSM303DLH_MAGN_DEV_NAME,
24	},
25	{
26		.compatible = "st,lsm303dlhc-magn",
27		.data = LSM303DLHC_MAGN_DEV_NAME,
28	},
29	{
30		.compatible = "st,lsm303dlm-magn",
31		.data = LSM303DLM_MAGN_DEV_NAME,
32	},
33	{
34		.compatible = "st,lis3mdl-magn",
35		.data = LIS3MDL_MAGN_DEV_NAME,
36	},
37	{
38		.compatible = "st,lsm303agr-magn",
39		.data = LSM303AGR_MAGN_DEV_NAME,
40	},
41	{
42		.compatible = "st,lis2mdl",
43		.data = LIS2MDL_MAGN_DEV_NAME,
44	},
45	{
46		.compatible = "st,lsm9ds1-magn",
47		.data = LSM9DS1_MAGN_DEV_NAME,
48	},
49	{
50		.compatible = "st,iis2mdc",
51		.data = IIS2MDC_MAGN_DEV_NAME,
52	},
53	{
54		.compatible = "st,lsm303c-magn",
55		.data = LSM303C_MAGN_DEV_NAME,
56	},
57	{},
58};
59MODULE_DEVICE_TABLE(of, st_magn_of_match);
60
61static int st_magn_i2c_probe(struct i2c_client *client)
62{
63	const struct st_sensor_settings *settings;
64	struct st_sensor_data *mdata;
65	struct iio_dev *indio_dev;
66	int err;
67
68	st_sensors_dev_name_probe(&client->dev, client->name, sizeof(client->name));
69
70	settings = st_magn_get_settings(client->name);
71	if (!settings) {
72		dev_err(&client->dev, "device name %s not recognized.\n",
73			client->name);
74		return -ENODEV;
75	}
76
77	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*mdata));
78	if (!indio_dev)
79		return -ENOMEM;
80
81	mdata = iio_priv(indio_dev);
82	mdata->sensor_settings = (struct st_sensor_settings *)settings;
83
84	err = st_sensors_i2c_configure(indio_dev, client);
85	if (err < 0)
86		return err;
87
88	err = st_sensors_power_enable(indio_dev);
89	if (err)
90		return err;
91
92	return st_magn_common_probe(indio_dev);
93}
94
95static const struct i2c_device_id st_magn_id_table[] = {
96	{ LSM303DLH_MAGN_DEV_NAME },
97	{ LSM303DLHC_MAGN_DEV_NAME },
98	{ LSM303DLM_MAGN_DEV_NAME },
99	{ LIS3MDL_MAGN_DEV_NAME },
100	{ LSM303AGR_MAGN_DEV_NAME },
101	{ LIS2MDL_MAGN_DEV_NAME },
102	{ LSM9DS1_MAGN_DEV_NAME },
103	{ IIS2MDC_MAGN_DEV_NAME },
104	{ LSM303C_MAGN_DEV_NAME },
105	{},
106};
107MODULE_DEVICE_TABLE(i2c, st_magn_id_table);
108
109static struct i2c_driver st_magn_driver = {
110	.driver = {
111		.name = "st-magn-i2c",
112		.of_match_table = st_magn_of_match,
113	},
114	.probe = st_magn_i2c_probe,
115	.id_table = st_magn_id_table,
116};
117module_i2c_driver(st_magn_driver);
118
119MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
120MODULE_DESCRIPTION("STMicroelectronics magnetometers i2c driver");
121MODULE_LICENSE("GPL v2");
122MODULE_IMPORT_NS(IIO_ST_SENSORS);
123