gpio-max7301.c 2.7 KB
Newer Older
1
/*
2 3
 * Copyright (C) 2006 Juergen Beisert, Pengutronix
 * Copyright (C) 2008 Guennadi Liakhovetski, Pengutronix
4
 * Copyright (C) 2009 Wolfram Sang, Pengutronix
5 6 7 8 9
 *
 * 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
 * published by the Free Software Foundation.
 *
10
 * Check max730x.c for further details.
11 12
 */

13
#include <linux/module.h>
14 15 16
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/mutex.h>
17
#include <linux/slab.h>
18 19 20
#include <linux/spi/spi.h>
#include <linux/spi/max7301.h>

21 22 23
/* A write to the MAX7301 means one message with one transfer */
static int max7301_spi_write(struct device *dev, unsigned int reg,
				unsigned int val)
24
{
25
	struct spi_device *spi = to_spi_device(dev);
26
	u16 word = ((reg & 0x7F) << 8) | (val & 0xFF);
27

28 29 30
	return spi_write(spi, (const u8 *)&word, sizeof(word));
}

31 32 33
/* A read from the MAX7301 means two transfers; here, one message each */

static int max7301_spi_read(struct device *dev, unsigned int reg)
34 35 36
{
	int ret;
	u16 word;
37
	struct spi_device *spi = to_spi_device(dev);
38 39 40 41 42 43 44 45 46 47 48 49 50 51 52

	word = 0x8000 | (reg << 8);
	ret = spi_write(spi, (const u8 *)&word, sizeof(word));
	if (ret)
		return ret;
	/*
	 * This relies on the fact, that a transfer with NULL tx_buf shifts out
	 * zero bytes (=NOOP for MAX7301)
	 */
	ret = spi_read(spi, (u8 *)&word, sizeof(word));
	if (ret)
		return ret;
	return word & 0xff;
}

B
Bill Pemberton 已提交
53
static int max7301_probe(struct spi_device *spi)
54 55
{
	struct max7301 *ts;
56
	int ret;
57

58
	/* bits_per_word cannot be configured in platform data */
59 60 61 62 63 64 65 66 67
	spi->bits_per_word = 16;
	ret = spi_setup(spi);
	if (ret < 0)
		return ret;

	ts = kzalloc(sizeof(struct max7301), GFP_KERNEL);
	if (!ts)
		return -ENOMEM;

68 69 70
	ts->read = max7301_spi_read;
	ts->write = max7301_spi_write;
	ts->dev = &spi->dev;
71

72
	ret = __max730x_probe(ts);
73
	if (ret)
74
		kfree(ts);
75 76 77
	return ret;
}

78
static int __devexit max7301_remove(struct spi_device *spi)
79
{
80
	return __max730x_remove(&spi->dev);
81 82
}

83 84 85 86 87 88
static const struct spi_device_id max7301_id[] = {
	{ "max7301", 0 },
	{ }
};
MODULE_DEVICE_TABLE(spi, max7301_id);

89 90
static struct spi_driver max7301_driver = {
	.driver = {
91 92
		.name = "max7301",
		.owner = THIS_MODULE,
93
	},
94
	.probe = max7301_probe,
B
Bill Pemberton 已提交
95
	.remove = max7301_remove,
96
	.id_table = max7301_id,
97 98 99 100 101 102
};

static int __init max7301_init(void)
{
	return spi_register_driver(&max7301_driver);
}
103 104 105 106
/* register after spi postcore initcall and before
 * subsys initcalls that may rely on these GPIOs
 */
subsys_initcall(max7301_init);
107 108 109 110 111 112 113

static void __exit max7301_exit(void)
{
	spi_unregister_driver(&max7301_driver);
}
module_exit(max7301_exit);

114
MODULE_AUTHOR("Juergen Beisert, Wolfram Sang");
115
MODULE_LICENSE("GPL v2");
116
MODULE_DESCRIPTION("MAX7301 GPIO-Expander");