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/slab.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};
51MODULE_DEVICE_TABLE(of, st_magn_of_match);
52
53static int st_magn_i2c_probe(struct i2c_client *client,
54			     const struct i2c_device_id *id)
55{
56	const struct st_sensor_settings *settings;
57	struct st_sensor_data *mdata;
58	struct iio_dev *indio_dev;
59	int err;
60
61	st_sensors_dev_name_probe(&client->dev, client->name, sizeof(client->name));
62
63	settings = st_magn_get_settings(client->name);
64	if (!settings) {
65		dev_err(&client->dev, "device name %s not recognized.\n",
66			client->name);
67		return -ENODEV;
68	}
69
70	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*mdata));
71	if (!indio_dev)
72		return -ENOMEM;
73
74	mdata = iio_priv(indio_dev);
75	mdata->sensor_settings = (struct st_sensor_settings *)settings;
76
77	err = st_sensors_i2c_configure(indio_dev, client);
78	if (err < 0)
79		return err;
80
81	err = st_sensors_power_enable(indio_dev);
82	if (err)
83		return err;
84
85	err = st_magn_common_probe(indio_dev);
86	if (err < 0)
87		goto st_magn_power_off;
88
89	return 0;
90
91st_magn_power_off:
92	st_sensors_power_disable(indio_dev);
93
94	return err;
95}
96
97static int st_magn_i2c_remove(struct i2c_client *client)
98{
99	struct iio_dev *indio_dev = i2c_get_clientdata(client);
100
101	st_magn_common_remove(indio_dev);
102
103	st_sensors_power_disable(indio_dev);
104
105	return 0;
106}
107
108static const struct i2c_device_id st_magn_id_table[] = {
109	{ LSM303DLH_MAGN_DEV_NAME },
110	{ LSM303DLHC_MAGN_DEV_NAME },
111	{ LSM303DLM_MAGN_DEV_NAME },
112	{ LIS3MDL_MAGN_DEV_NAME },
113	{ LSM303AGR_MAGN_DEV_NAME },
114	{ LIS2MDL_MAGN_DEV_NAME },
115	{ LSM9DS1_MAGN_DEV_NAME },
116	{},
117};
118MODULE_DEVICE_TABLE(i2c, st_magn_id_table);
119
120static struct i2c_driver st_magn_driver = {
121	.driver = {
122		.name = "st-magn-i2c",
123		.of_match_table = st_magn_of_match,
124	},
125	.probe = st_magn_i2c_probe,
126	.remove = st_magn_i2c_remove,
127	.id_table = st_magn_id_table,
128};
129module_i2c_driver(st_magn_driver);
130
131MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
132MODULE_DESCRIPTION("STMicroelectronics magnetometers i2c driver");
133MODULE_LICENSE("GPL v2");
134