1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/module.h>
24#include <linux/kernel.h>
25#include <linux/types.h>
26#include <linux/i2c.h>
27#include <linux/init.h>
28#include <linux/device.h>
29#include <linux/platform_device.h>
30#include <asm/prom.h>
31#include <asm/pmac_low_i2c.h>
32
33MODULE_AUTHOR("Benjamin Herrenschmidt <benh@kernel.crashing.org>");
34MODULE_DESCRIPTION("I2C driver for Apple PowerMac");
35MODULE_LICENSE("GPL");
36
37
38
39
40static s32 i2c_powermac_smbus_xfer( struct i2c_adapter* adap,
41 u16 addr,
42 unsigned short flags,
43 char read_write,
44 u8 command,
45 int size,
46 union i2c_smbus_data* data)
47{
48 struct pmac_i2c_bus *bus = i2c_get_adapdata(adap);
49 int rc = 0;
50 int read = (read_write == I2C_SMBUS_READ);
51 int addrdir = (addr << 1) | read;
52 u8 local[2];
53
54 rc = pmac_i2c_open(bus, 0);
55 if (rc)
56 return rc;
57
58 switch (size) {
59 case I2C_SMBUS_QUICK:
60 rc = pmac_i2c_setmode(bus, pmac_i2c_mode_std);
61 if (rc)
62 goto bail;
63 rc = pmac_i2c_xfer(bus, addrdir, 0, 0, NULL, 0);
64 break;
65 case I2C_SMBUS_BYTE:
66 rc = pmac_i2c_setmode(bus, pmac_i2c_mode_std);
67 if (rc)
68 goto bail;
69 rc = pmac_i2c_xfer(bus, addrdir, 0, 0, &data->byte, 1);
70 break;
71 case I2C_SMBUS_BYTE_DATA:
72 rc = pmac_i2c_setmode(bus, read ?
73 pmac_i2c_mode_combined :
74 pmac_i2c_mode_stdsub);
75 if (rc)
76 goto bail;
77 rc = pmac_i2c_xfer(bus, addrdir, 1, command, &data->byte, 1);
78 break;
79 case I2C_SMBUS_WORD_DATA:
80 rc = pmac_i2c_setmode(bus, read ?
81 pmac_i2c_mode_combined :
82 pmac_i2c_mode_stdsub);
83 if (rc)
84 goto bail;
85 if (!read) {
86 local[0] = data->word & 0xff;
87 local[1] = (data->word >> 8) & 0xff;
88 }
89 rc = pmac_i2c_xfer(bus, addrdir, 1, command, local, 2);
90 if (rc == 0 && read) {
91 data->word = ((u16)local[1]) << 8;
92 data->word |= local[0];
93 }
94 break;
95
96
97
98
99
100
101
102
103
104
105
106
107 case I2C_SMBUS_BLOCK_DATA:
108 rc = pmac_i2c_setmode(bus, read ?
109 pmac_i2c_mode_combined :
110 pmac_i2c_mode_stdsub);
111 if (rc)
112 goto bail;
113 rc = pmac_i2c_xfer(bus, addrdir, 1, command, data->block,
114 data->block[0] + 1);
115
116 break;
117 case I2C_SMBUS_I2C_BLOCK_DATA:
118 rc = pmac_i2c_setmode(bus, read ?
119 pmac_i2c_mode_combined :
120 pmac_i2c_mode_stdsub);
121 if (rc)
122 goto bail;
123 rc = pmac_i2c_xfer(bus, addrdir, 1, command,
124 &data->block[1], data->block[0]);
125 break;
126
127 default:
128 rc = -EINVAL;
129 }
130 bail:
131 pmac_i2c_close(bus);
132 return rc;
133}
134
135
136
137
138
139
140static int i2c_powermac_master_xfer( struct i2c_adapter *adap,
141 struct i2c_msg *msgs,
142 int num)
143{
144 struct pmac_i2c_bus *bus = i2c_get_adapdata(adap);
145 int rc = 0;
146 int read;
147 int addrdir;
148
149 if (msgs->flags & I2C_M_TEN)
150 return -EINVAL;
151 read = (msgs->flags & I2C_M_RD) != 0;
152 addrdir = (msgs->addr << 1) | read;
153 if (msgs->flags & I2C_M_REV_DIR_ADDR)
154 addrdir ^= 1;
155
156 rc = pmac_i2c_open(bus, 0);
157 if (rc)
158 return rc;
159 rc = pmac_i2c_setmode(bus, pmac_i2c_mode_std);
160 if (rc)
161 goto bail;
162 rc = pmac_i2c_xfer(bus, addrdir, 0, 0, msgs->buf, msgs->len);
163 bail:
164 pmac_i2c_close(bus);
165 return rc < 0 ? rc : 1;
166}
167
168static u32 i2c_powermac_func(struct i2c_adapter * adapter)
169{
170 return I2C_FUNC_SMBUS_QUICK | I2C_FUNC_SMBUS_BYTE |
171 I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA |
172 I2C_FUNC_SMBUS_BLOCK_DATA | I2C_FUNC_I2C;
173}
174
175
176static const struct i2c_algorithm i2c_powermac_algorithm = {
177 .smbus_xfer = i2c_powermac_smbus_xfer,
178 .master_xfer = i2c_powermac_master_xfer,
179 .functionality = i2c_powermac_func,
180};
181
182
183static int __devexit i2c_powermac_remove(struct platform_device *dev)
184{
185 struct i2c_adapter *adapter = platform_get_drvdata(dev);
186 struct pmac_i2c_bus *bus = i2c_get_adapdata(adapter);
187 int rc;
188
189 rc = i2c_del_adapter(adapter);
190 pmac_i2c_detach_adapter(bus, adapter);
191 i2c_set_adapdata(adapter, NULL);
192
193 if (rc)
194 printk(KERN_WARNING
195 "i2c-powermac.c: Failed to remove bus %s !\n",
196 adapter->name);
197 platform_set_drvdata(dev, NULL);
198 kfree(adapter);
199
200 return 0;
201}
202
203
204static int __devinit i2c_powermac_probe(struct platform_device *dev)
205{
206 struct pmac_i2c_bus *bus = dev->dev.platform_data;
207 struct device_node *parent = NULL;
208 struct i2c_adapter *adapter;
209 char name[32];
210 const char *basename;
211 int rc;
212
213 if (bus == NULL)
214 return -EINVAL;
215
216
217
218
219
220
221 switch(pmac_i2c_get_type(bus)) {
222 case pmac_i2c_bus_keywest:
223 parent = of_get_parent(pmac_i2c_get_controller(bus));
224 if (parent == NULL)
225 return -EINVAL;
226 basename = parent->name;
227 break;
228 case pmac_i2c_bus_pmu:
229 basename = "pmu";
230 break;
231 case pmac_i2c_bus_smu:
232
233
234
235 basename = "smu";
236 break;
237 default:
238 return -EINVAL;
239 }
240 snprintf(name, 32, "%s %d", basename, pmac_i2c_get_channel(bus));
241 of_node_put(parent);
242
243 adapter = kzalloc(sizeof(struct i2c_adapter), GFP_KERNEL);
244 if (adapter == NULL) {
245 printk(KERN_ERR "i2c-powermac: can't allocate inteface !\n");
246 return -ENOMEM;
247 }
248 platform_set_drvdata(dev, adapter);
249 strcpy(adapter->name, name);
250 adapter->algo = &i2c_powermac_algorithm;
251 i2c_set_adapdata(adapter, bus);
252 adapter->dev.parent = &dev->dev;
253 pmac_i2c_attach_adapter(bus, adapter);
254 rc = i2c_add_adapter(adapter);
255 if (rc) {
256 printk(KERN_ERR "i2c-powermac: Adapter %s registration "
257 "failed\n", name);
258 i2c_set_adapdata(adapter, NULL);
259 pmac_i2c_detach_adapter(bus, adapter);
260 }
261
262 printk(KERN_INFO "PowerMac i2c bus %s registered\n", name);
263
264 if (!strncmp(basename, "uni-n", 5)) {
265 struct device_node *np;
266 const u32 *prop;
267 struct i2c_board_info info;
268
269
270 np = of_find_node_by_name(NULL, "accelerometer");
271 if (np && of_device_is_compatible(np, "AAPL,accelerometer_1") &&
272 (prop = of_get_property(np, "reg", NULL))) {
273 int i2c_bus;
274 const char *tmp_bus;
275
276
277 tmp_bus = strstr(np->full_name, "/i2c-bus@");
278 if (tmp_bus)
279 i2c_bus = *(tmp_bus + 9) - '0';
280 else
281 i2c_bus = ((*prop) >> 8) & 0x0f;
282
283 if (pmac_i2c_get_channel(bus) == i2c_bus) {
284 memset(&info, 0, sizeof(struct i2c_board_info));
285 info.addr = ((*prop) & 0xff) >> 1;
286 strlcpy(info.type, "ams", I2C_NAME_SIZE);
287 i2c_new_device(adapter, &info);
288 }
289 }
290 }
291
292 return rc;
293}
294
295
296
297MODULE_ALIAS("platform:i2c-powermac");
298
299static struct platform_driver i2c_powermac_driver = {
300 .probe = i2c_powermac_probe,
301 .remove = __devexit_p(i2c_powermac_remove),
302 .driver = {
303 .name = "i2c-powermac",
304 .bus = &platform_bus_type,
305 },
306};
307
308static int __init i2c_powermac_init(void)
309{
310 platform_driver_register(&i2c_powermac_driver);
311 return 0;
312}
313
314
315static void __exit i2c_powermac_cleanup(void)
316{
317 platform_driver_unregister(&i2c_powermac_driver);
318}
319
320module_init(i2c_powermac_init);
321module_exit(i2c_powermac_cleanup);
322