ad714x-spi.c 3.0 KB
Newer Older
1 2 3
/*
 * AD714X CapTouch Programmable Controller driver (SPI bus)
 *
4
 * Copyright 2009-2011 Analog Devices Inc.
5 6 7 8
 *
 * Licensed under the GPL-2 or later.
 */

9
#include <linux/input.h>	/* BUS_SPI */
10 11
#include <linux/module.h>
#include <linux/spi/spi.h>
12
#include <linux/pm.h>
13 14 15 16 17 18 19
#include <linux/types.h>
#include "ad714x.h"

#define AD714x_SPI_CMD_PREFIX      0xE000   /* bits 15:11 */
#define AD714x_SPI_READ            BIT(10)

#ifdef CONFIG_PM
20
static int ad714x_spi_suspend(struct device *dev)
21
{
22
	return ad714x_disable(spi_get_drvdata(to_spi_device(dev)));
23 24
}

25
static int ad714x_spi_resume(struct device *dev)
26
{
27
	return ad714x_enable(spi_get_drvdata(to_spi_device(dev)));
28 29 30
}
#endif

31 32
static SIMPLE_DEV_PM_OPS(ad714x_spi_pm, ad714x_spi_suspend, ad714x_spi_resume);

33
static int ad714x_spi_read(struct ad714x_chip *chip,
34
			   unsigned short reg, unsigned short *data, size_t len)
35
{
36 37 38
	struct spi_device *spi = to_spi_device(chip->dev);
	struct spi_message message;
	struct spi_transfer xfer[2];
39
	int i;
40 41 42 43 44 45
	int error;

	spi_message_init(&message);
	memset(xfer, 0, sizeof(xfer));

	chip->xfer_buf[0] = cpu_to_be16(AD714x_SPI_CMD_PREFIX |
46
					AD714x_SPI_READ | reg);
47 48 49
	xfer[0].tx_buf = &chip->xfer_buf[0];
	xfer[0].len = sizeof(chip->xfer_buf[0]);
	spi_message_add_tail(&xfer[0], &message);
50

51
	xfer[1].rx_buf = &chip->xfer_buf[1];
52
	xfer[1].len = sizeof(chip->xfer_buf[1]) * len;
53
	spi_message_add_tail(&xfer[1], &message);
54

55 56 57 58 59
	error = spi_sync(spi, &message);
	if (unlikely(error)) {
		dev_err(chip->dev, "SPI read error: %d\n", error);
		return error;
	}
60

61 62 63
	for (i = 0; i < len; i++)
		data[i] = be16_to_cpu(chip->xfer_buf[i + 1]);

64
	return 0;
65 66
}

67
static int ad714x_spi_write(struct ad714x_chip *chip,
68
			    unsigned short reg, unsigned short data)
69
{
70 71 72 73 74 75 76 77 78 79 80 81
	struct spi_device *spi = to_spi_device(chip->dev);
	int error;

	chip->xfer_buf[0] = cpu_to_be16(AD714x_SPI_CMD_PREFIX | reg);
	chip->xfer_buf[1] = cpu_to_be16(data);

	error = spi_write(spi, (u8 *)chip->xfer_buf,
			  2 * sizeof(*chip->xfer_buf));
	if (unlikely(error)) {
		dev_err(chip->dev, "SPI write error: %d\n", error);
		return error;
	}
82

83
	return 0;
84 85 86 87 88
}

static int __devinit ad714x_spi_probe(struct spi_device *spi)
{
	struct ad714x_chip *chip;
89 90 91 92 93 94
	int err;

	spi->bits_per_word = 8;
	err = spi_setup(spi);
	if (err < 0)
		return err;
95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119

	chip = ad714x_probe(&spi->dev, BUS_SPI, spi->irq,
			    ad714x_spi_read, ad714x_spi_write);
	if (IS_ERR(chip))
		return PTR_ERR(chip);

	spi_set_drvdata(spi, chip);

	return 0;
}

static int __devexit ad714x_spi_remove(struct spi_device *spi)
{
	struct ad714x_chip *chip = spi_get_drvdata(spi);

	ad714x_remove(chip);
	spi_set_drvdata(spi, NULL);

	return 0;
}

static struct spi_driver ad714x_spi_driver = {
	.driver = {
		.name	= "ad714x_captouch",
		.owner	= THIS_MODULE,
120
		.pm	= &ad714x_spi_pm,
121 122
	},
	.probe		= ad714x_spi_probe,
B
Bill Pemberton 已提交
123
	.remove		= ad714x_spi_remove,
124 125
};

126
module_spi_driver(ad714x_spi_driver);
127 128 129 130

MODULE_DESCRIPTION("Analog Devices AD714X Capacitance Touch Sensor SPI Bus Driver");
MODULE_AUTHOR("Barry Song <21cnbao@gmail.com>");
MODULE_LICENSE("GPL");