Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit b25862c5 authored by Daniel Baluta's avatar Daniel Baluta Committed by Jonathan Cameron
Browse files

iio: imu: kmx61: Add acpi support 



Signed-off-by: default avatarDaniel Baluta <daniel.baluta@intel.com>
Signed-off-by: default avatarJonathan Cameron <jic23@kernel.org>
parent 20ffac27

drivers/iio/imu/kmx61.c

+59 −0
Original line number Diff line number Diff line
@@ -13,10 +13,13 @@ 


#include <linux/module.h>

#include <linux/i2c.h>

#include <linux/acpi.h>

#include <linux/gpio/consumer.h>

#include <linux/iio/iio.h>

#include <linux/iio/sysfs.h>



#define KMX61_DRV_NAME "kmx61"

#define KMX61_GPIO_NAME "kmx61_int"



#define KMX61_REG_WHO_AM_I	0x00
@@ -573,6 +576,44 @@ static const struct iio_info kmx61_mag_info = { 
	.attrs			= &kmx61_mag_attribute_group,

};



static const char *kmx61_match_acpi_device(struct device *dev)

{

	const struct acpi_device_id *id;



	id = acpi_match_device(dev->driver->acpi_match_table, dev);

	if (!id)

		return NULL;

	return dev_name(dev);

}



static int kmx61_gpio_probe(struct i2c_client *client, struct kmx61_data *data)

{

	struct device *dev;

	struct gpio_desc *gpio;

	int ret;



	if (!client)

		return -EINVAL;



	dev = &client->dev;



	/* data ready gpio interrupt pin */

	gpio = devm_gpiod_get_index(dev, KMX61_GPIO_NAME, 0);

	if (IS_ERR(gpio)) {

		dev_err(dev, "acpi gpio get index failed\n");

		return PTR_ERR(gpio);

	}



	ret = gpiod_direction_input(gpio);

	if (ret)

		return ret;



	ret = gpiod_to_irq(gpio);



	dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);

	return ret;

}



static struct iio_dev *kmx61_indiodev_setup(struct kmx61_data *data,

					    const struct iio_info *info,

					    const struct iio_chan_spec *chan,
@@ -613,6 +654,13 @@ static int kmx61_probe(struct i2c_client *client, 


	mutex_init(&data->lock);



	if (id)

		name = id->name;

	else if (ACPI_HANDLE(&client->dev))

		name = kmx61_match_acpi_device(&client->dev);

	else

		return -ENODEV;



	data->acc_indio_dev =

		kmx61_indiodev_setup(data, &kmx61_acc_info,

				     kmx61_acc_channels,
@@ -633,6 +681,9 @@ static int kmx61_probe(struct i2c_client *client, 
	if (ret < 0)

		return ret;



	if (client->irq < 0)

		client->irq = kmx61_gpio_probe(client, data);



	ret = iio_device_register(data->acc_indio_dev);

	if (ret < 0) {

		dev_err(&client->dev, "Failed to register acc iio device\n");
@@ -668,6 +719,13 @@ static int kmx61_remove(struct i2c_client *client) 
	return 0;

}



static const struct acpi_device_id kmx61_acpi_match[] = {

	{"KMX61021", 0},

	{}

};



MODULE_DEVICE_TABLE(acpi, kmx61_acpi_match);



static const struct i2c_device_id kmx61_id[] = {

	{"kmx611021", 0},

	{}
@@ -678,6 +736,7 @@ MODULE_DEVICE_TABLE(i2c, kmx61_id); 
static struct i2c_driver kmx61_driver = {

	.driver = {

		.name = KMX61_DRV_NAME,

		.acpi_match_table = ACPI_PTR(kmx61_acpi_match),

	},

	.probe		= kmx61_probe,

	.remove		= kmx61_remove,