88pm860x-i2c.c revision bbd51b1ff1bf57b9ed7f062486a415509968d4d9 
1/*
2 * I2C driver for Marvell 88PM8607
3 *
4 * Copyright (C) 2009 Marvell International Ltd.
5 * 	Haojian Zhuang <haojian.zhuang@marvell.com>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
10 */
11#include <linux/kernel.h>
12#include <linux/module.h>
13#include <linux/platform_device.h>
14#include <linux/i2c.h>
15#include <linux/mfd/88pm8607.h>
16
17static inline int pm8607_read_device(struct pm8607_chip *chip,
18				     int reg, int bytes, void *dest)
19{
20	struct i2c_client *i2c = chip->client;
21	unsigned char data;
22	int ret;
23
24	data = (unsigned char)reg;
25	ret = i2c_master_send(i2c, &data, 1);
26	if (ret < 0)
27		return ret;
28
29	ret = i2c_master_recv(i2c, dest, bytes);
30	if (ret < 0)
31		return ret;
32	return 0;
33}
34
35static inline int pm8607_write_device(struct pm8607_chip *chip,
36				      int reg, int bytes, void *src)
37{
38	struct i2c_client *i2c = chip->client;
39	unsigned char buf[bytes + 1];
40	int ret;
41
42	buf[0] = (unsigned char)reg;
43	memcpy(&buf[1], src, bytes);
44
45	ret = i2c_master_send(i2c, buf, bytes + 1);
46	if (ret < 0)
47		return ret;
48	return 0;
49}
50
51int pm8607_reg_read(struct pm8607_chip *chip, int reg)
52{
53	unsigned char data;
54	int ret;
55
56	mutex_lock(&chip->io_lock);
57	ret = chip->read(chip, reg, 1, &data);
58	mutex_unlock(&chip->io_lock);
59
60	if (ret < 0)
61		return ret;
62	else
63		return (int)data;
64}
65EXPORT_SYMBOL(pm8607_reg_read);
66
67int pm8607_reg_write(struct pm8607_chip *chip, int reg,
68		     unsigned char data)
69{
70	int ret;
71
72	mutex_lock(&chip->io_lock);
73	ret = chip->write(chip, reg, 1, &data);
74	mutex_unlock(&chip->io_lock);
75
76	return ret;
77}
78EXPORT_SYMBOL(pm8607_reg_write);
79
80int pm8607_bulk_read(struct pm8607_chip *chip, int reg,
81		     int count, unsigned char *buf)
82{
83	int ret;
84
85	mutex_lock(&chip->io_lock);
86	ret = chip->read(chip, reg, count, buf);
87	mutex_unlock(&chip->io_lock);
88
89	return ret;
90}
91EXPORT_SYMBOL(pm8607_bulk_read);
92
93int pm8607_bulk_write(struct pm8607_chip *chip, int reg,
94		      int count, unsigned char *buf)
95{
96	int ret;
97
98	mutex_lock(&chip->io_lock);
99	ret = chip->write(chip, reg, count, buf);
100	mutex_unlock(&chip->io_lock);
101
102	return ret;
103}
104EXPORT_SYMBOL(pm8607_bulk_write);
105
106int pm8607_set_bits(struct pm8607_chip *chip, int reg,
107		    unsigned char mask, unsigned char data)
108{
109	unsigned char value;
110	int ret;
111
112	mutex_lock(&chip->io_lock);
113	ret = chip->read(chip, reg, 1, &value);
114	if (ret < 0)
115		goto out;
116	value &= ~mask;
117	value |= data;
118	ret = chip->write(chip, reg, 1, &value);
119out:
120	mutex_unlock(&chip->io_lock);
121	return ret;
122}
123EXPORT_SYMBOL(pm8607_set_bits);
124
125
126static const struct i2c_device_id pm860x_id_table[] = {
127	{ "88PM8607", 0 },
128	{}
129};
130MODULE_DEVICE_TABLE(i2c, pm860x_id_table);
131
132static int __devinit pm860x_probe(struct i2c_client *client,
133				  const struct i2c_device_id *id)
134{
135	struct pm8607_platform_data *pdata = client->dev.platform_data;
136	struct pm8607_chip *chip;
137	int ret;
138
139	chip = kzalloc(sizeof(struct pm8607_chip), GFP_KERNEL);
140	if (chip == NULL)
141		return -ENOMEM;
142
143	chip->client = client;
144	chip->dev = &client->dev;
145	chip->read = pm8607_read_device;
146	chip->write = pm8607_write_device;
147	memcpy(&chip->id, id, sizeof(struct i2c_device_id));
148	i2c_set_clientdata(client, chip);
149
150	mutex_init(&chip->io_lock);
151	dev_set_drvdata(chip->dev, chip);
152
153	ret = pm860x_device_init(chip, pdata);
154	if (ret < 0)
155		goto out;
156
157
158	return 0;
159
160out:
161	i2c_set_clientdata(client, NULL);
162	kfree(chip);
163	return ret;
164}
165
166static int __devexit pm860x_remove(struct i2c_client *client)
167{
168	struct pm8607_chip *chip = i2c_get_clientdata(client);
169
170	kfree(chip);
171	return 0;
172}
173
174static struct i2c_driver pm860x_driver = {
175	.driver	= {
176		.name	= "88PM860x",
177		.owner	= THIS_MODULE,
178	},
179	.probe		= pm860x_probe,
180	.remove		= __devexit_p(pm860x_remove),
181	.id_table	= pm860x_id_table,
182};
183
184static int __init pm860x_i2c_init(void)
185{
186	int ret;
187	ret = i2c_add_driver(&pm860x_driver);
188	if (ret != 0)
189		pr_err("Failed to register 88PM860x I2C driver: %d\n", ret);
190	return ret;
191}
192subsys_initcall(pm860x_i2c_init);
193
194static void __exit pm860x_i2c_exit(void)
195{
196	i2c_del_driver(&pm860x_driver);
197}
198module_exit(pm860x_i2c_exit);
199
200MODULE_DESCRIPTION("I2C Driver for Marvell 88PM860x");
201MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com>");
202MODULE_LICENSE("GPL");
203