[mirror_ubuntu-bionic-kernel.git] / drivers / misc / lis3lv02d / lis3lv02d_spi.c

/*
 * lis3lv02d_spi - SPI glue layer for lis3lv02d
 *
 * Copyright (c) 2009 Daniel Mack <daniel@caiaq.de>
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License version 2 as
 *  publishhed by the Free Software Foundation.
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/err.h>
#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/workqueue.h>
#include <linux/spi/spi.h>
#include <linux/pm.h>
#include <linux/of.h>
#include <linux/of_platform.h>
#include <linux/of_device.h>

#include "lis3lv02d.h"

#define DRV_NAME 	"lis3lv02d_spi"
#define LIS3_SPI_READ	0x80

static int lis3_spi_read(struct lis3lv02d *lis3, int reg, u8 *v)
{
	struct spi_device *spi = lis3->bus_priv;
	int ret = spi_w8r8(spi, reg | LIS3_SPI_READ);
	if (ret < 0)
		return -EINVAL;

	*v = (u8) ret;
	return 0;
}

static int lis3_spi_write(struct lis3lv02d *lis3, int reg, u8 val)
{
	u8 tmp[2] = { reg, val };
	struct spi_device *spi = lis3->bus_priv;
	return spi_write(spi, tmp, sizeof(tmp));
}

static int lis3_spi_init(struct lis3lv02d *lis3)
{
	u8 reg;
	int ret;

	/* power up the device */
	ret = lis3->read(lis3, CTRL_REG1, &reg);
	if (ret < 0)
		return ret;

	reg |= CTRL1_PD0 | CTRL1_Xen | CTRL1_Yen | CTRL1_Zen;
	return lis3->write(lis3, CTRL_REG1, reg);
}

static union axis_conversion lis3lv02d_axis_normal =
	{ .as_array = { 1, 2, 3 } };

#ifdef CONFIG_OF
static const struct of_device_id lis302dl_spi_dt_ids[] = {
	{ .compatible = "st,lis302dl-spi" },
	{}
};
MODULE_DEVICE_TABLE(of, lis302dl_spi_dt_ids);
#endif

static int lis302dl_spi_probe(struct spi_device *spi)
{
	int ret;

	spi->bits_per_word = 8;
	spi->mode = SPI_MODE_0;
	ret = spi_setup(spi);
	if (ret < 0)
		return ret;

	lis3_dev.bus_priv	= spi;
	lis3_dev.init		= lis3_spi_init;
	lis3_dev.read		= lis3_spi_read;
	lis3_dev.write		= lis3_spi_write;
	lis3_dev.irq		= spi->irq;
	lis3_dev.ac		= lis3lv02d_axis_normal;
	lis3_dev.pdata		= spi->dev.platform_data;

#ifdef CONFIG_OF
	if (of_match_device(lis302dl_spi_dt_ids, &spi->dev)) {
		lis3_dev.of_node = spi->dev.of_node;
		ret = lis3lv02d_init_dt(&lis3_dev);
		if (ret)
			return ret;
	}
#endif
	spi_set_drvdata(spi, &lis3_dev);

	return lis3lv02d_init_device(&lis3_dev);
}

static int lis302dl_spi_remove(struct spi_device *spi)
{
	struct lis3lv02d *lis3 = spi_get_drvdata(spi);
	lis3lv02d_joystick_disable(lis3);
	lis3lv02d_poweroff(lis3);

	return lis3lv02d_remove_fs(&lis3_dev);
}

#ifdef CONFIG_PM_SLEEP
static int lis3lv02d_spi_suspend(struct device *dev)
{
	struct spi_device *spi = to_spi_device(dev);
	struct lis3lv02d *lis3 = spi_get_drvdata(spi);

	if (!lis3->pdata || !lis3->pdata->wakeup_flags)
		lis3lv02d_poweroff(&lis3_dev);

	return 0;
}

static int lis3lv02d_spi_resume(struct device *dev)
{
	struct spi_device *spi = to_spi_device(dev);
	struct lis3lv02d *lis3 = spi_get_drvdata(spi);

	if (!lis3->pdata || !lis3->pdata->wakeup_flags)
		lis3lv02d_poweron(lis3);

	return 0;
}
#endif

static SIMPLE_DEV_PM_OPS(lis3lv02d_spi_pm, lis3lv02d_spi_suspend,
			 lis3lv02d_spi_resume);

static struct spi_driver lis302dl_spi_driver = {
	.driver	 = {
		.name   = DRV_NAME,
		.pm	= &lis3lv02d_spi_pm,
		.of_match_table = of_match_ptr(lis302dl_spi_dt_ids),
	},
	.probe	= lis302dl_spi_probe,
	.remove	= lis302dl_spi_remove,
};

module_spi_driver(lis302dl_spi_driver);

MODULE_AUTHOR("Daniel Mack <daniel@caiaq.de>");
MODULE_DESCRIPTION("lis3lv02d SPI glue layer");
MODULE_LICENSE("GPL");
MODULE_ALIAS("spi:" DRV_NAME);
Commit	Line	Data
bb233fdf DM	1	/*
	2	* lis3lv02d_spi - SPI glue layer for lis3lv02d
	3	*
	4	* Copyright (c) 2009 Daniel Mack <daniel@caiaq.de>
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License version 2 as
	8	* publishhed by the Free Software Foundation.
	9	*/
	10
	11	#include <linux/module.h>
	12	#include <linux/kernel.h>
bb233fdf DM	13	#include <linux/err.h>
	14	#include <linux/input.h>
	15	#include <linux/interrupt.h>
	16	#include <linux/workqueue.h>
	17	#include <linux/spi/spi.h>
4e9be650	18	#include <linux/pm.h>
4bcdea86 DM	19	#include <linux/of.h>
4bcdea86 DM	20	#include <linux/of_platform.h>
79df8d27	21	#include <linux/of_device.h>
bb233fdf DM	22
	23	#include "lis3lv02d.h"
	24
	25	#define DRV_NAME "lis3lv02d_spi"
	26	#define LIS3_SPI_READ 0x80
	27
	28	static int lis3_spi_read(struct lis3lv02d lis3, int reg, u8 v)
	29	{
	30	struct spi_device *spi = lis3->bus_priv;
	31	int ret = spi_w8r8(spi, reg \| LIS3_SPI_READ);
	32	if (ret < 0)
	33	return -EINVAL;
	34
	35	*v = (u8) ret;
	36	return 0;
	37	}
	38
	39	static int lis3_spi_write(struct lis3lv02d *lis3, int reg, u8 val)
	40	{
	41	u8 tmp[2] = { reg, val };
	42	struct spi_device *spi = lis3->bus_priv;
	43	return spi_write(spi, tmp, sizeof(tmp));
	44	}
	45
	46	static int lis3_spi_init(struct lis3lv02d *lis3)
	47	{
	48	u8 reg;
	49	int ret;
	50
	51	/* power up the device */
	52	ret = lis3->read(lis3, CTRL_REG1, &reg);
	53	if (ret < 0)
	54	return ret;
	55
ed37d7f6	56	reg \|= CTRL1_PD0 \| CTRL1_Xen \| CTRL1_Yen \| CTRL1_Zen;
bb233fdf DM	57	return lis3->write(lis3, CTRL_REG1, reg);
	58	}
	59
2ee32144 TI	60	static union axis_conversion lis3lv02d_axis_normal =
2ee32144 TI	61	{ .as_array = { 1, 2, 3 } };
bb233fdf	62
4bcdea86	63	#ifdef CONFIG_OF
6893d9b5	64	static const struct of_device_id lis302dl_spi_dt_ids[] = {
4bcdea86 DM	65	{ .compatible = "st,lis302dl-spi" },
	66	{}
	67	};
	68	MODULE_DEVICE_TABLE(of, lis302dl_spi_dt_ids);
	69	#endif
	70
80c8ae28	71	static int lis302dl_spi_probe(struct spi_device *spi)
bb233fdf DM	72	{
	73	int ret;
	74
	75	spi->bits_per_word = 8;
	76	spi->mode = SPI_MODE_0;
	77	ret = spi_setup(spi);
	78	if (ret < 0)
	79	return ret;
	80
dc791f8a DM	81	lis3_dev.bus_priv = spi;
	82	lis3_dev.init = lis3_spi_init;
	83	lis3_dev.read = lis3_spi_read;
	84	lis3_dev.write = lis3_spi_write;
	85	lis3_dev.irq = spi->irq;
	86	lis3_dev.ac = lis3lv02d_axis_normal;
	87	lis3_dev.pdata = spi->dev.platform_data;
4bcdea86 DM	88
4bcdea86 DM	89	#ifdef CONFIG_OF
79df8d27	90	if (of_match_device(lis302dl_spi_dt_ids, &spi->dev)) {
4bcdea86	91	lis3_dev.of_node = spi->dev.of_node;
79df8d27 AC	92	ret = lis3lv02d_init_dt(&lis3_dev);
	93	if (ret)
	94	return ret;
	95	}
4bcdea86	96	#endif
bb233fdf DM	97	spi_set_drvdata(spi, &lis3_dev);
bb233fdf DM	98
dc791f8a	99	return lis3lv02d_init_device(&lis3_dev);
bb233fdf DM	100	}
bb233fdf DM	101
486a5c28	102	static int lis302dl_spi_remove(struct spi_device *spi)
bb233fdf DM	103	{
bb233fdf DM	104	struct lis3lv02d *lis3 = spi_get_drvdata(spi);
e1e5687d	105	lis3lv02d_joystick_disable(lis3);
bb233fdf	106	lis3lv02d_poweroff(lis3);
d82e23dc SO	107
d82e23dc SO	108	return lis3lv02d_remove_fs(&lis3_dev);
bb233fdf DM	109	}
bb233fdf DM	110
4e9be650 MB	111	#ifdef CONFIG_PM_SLEEP
4e9be650 MB	112	static int lis3lv02d_spi_suspend(struct device *dev)
2cd9645e	113	{
4e9be650	114	struct spi_device *spi = to_spi_device(dev);
2cd9645e DM	115	struct lis3lv02d *lis3 = spi_get_drvdata(spi);
2cd9645e DM	116
5facb097	117	if (!lis3->pdata \|\| !lis3->pdata->wakeup_flags)
2cd9645e DM	118	lis3lv02d_poweroff(&lis3_dev);
	119
	120	return 0;
	121	}
	122
4e9be650	123	static int lis3lv02d_spi_resume(struct device *dev)
2cd9645e	124	{
4e9be650	125	struct spi_device *spi = to_spi_device(dev);
2cd9645e DM	126	struct lis3lv02d *lis3 = spi_get_drvdata(spi);
2cd9645e DM	127
5facb097	128	if (!lis3->pdata \|\| !lis3->pdata->wakeup_flags)
2cd9645e DM	129	lis3lv02d_poweron(lis3);
	130
	131	return 0;
	132	}
2cd9645e DM	133	#endif
2cd9645e DM	134
4e9be650 MB	135	static SIMPLE_DEV_PM_OPS(lis3lv02d_spi_pm, lis3lv02d_spi_suspend,
	136	lis3lv02d_spi_resume);
	137
bb233fdf DM	138	static struct spi_driver lis302dl_spi_driver = {
	139	.driver = {
	140	.name = DRV_NAME,
4e9be650	141	.pm = &lis3lv02d_spi_pm,
4bcdea86	142	.of_match_table = of_match_ptr(lis302dl_spi_dt_ids),
bb233fdf DM	143	},
bb233fdf DM	144	.probe = lis302dl_spi_probe,
2d6bed9c	145	.remove = lis302dl_spi_remove,
bb233fdf DM	146	};
bb233fdf DM	147
a3dc3c9e	148	module_spi_driver(lis302dl_spi_driver);
bb233fdf DM	149
	150	MODULE_AUTHOR("Daniel Mack <daniel@caiaq.de>");
	151	MODULE_DESCRIPTION("lis3lv02d SPI glue layer");
	152	MODULE_LICENSE("GPL");
e0626e38	153	MODULE_ALIAS("spi:" DRV_NAME);