1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /* bbc_i2c.c: I2C low-level driver for BBC device on UltraSPARC-III
3*4882a593Smuzhiyun * platforms.
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (C) 2001, 2008 David S. Miller (davem@davemloft.net)
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <linux/module.h>
9*4882a593Smuzhiyun #include <linux/kernel.h>
10*4882a593Smuzhiyun #include <linux/types.h>
11*4882a593Smuzhiyun #include <linux/slab.h>
12*4882a593Smuzhiyun #include <linux/sched.h>
13*4882a593Smuzhiyun #include <linux/wait.h>
14*4882a593Smuzhiyun #include <linux/delay.h>
15*4882a593Smuzhiyun #include <linux/interrupt.h>
16*4882a593Smuzhiyun #include <linux/of.h>
17*4882a593Smuzhiyun #include <linux/of_device.h>
18*4882a593Smuzhiyun #include <asm/bbc.h>
19*4882a593Smuzhiyun #include <asm/io.h>
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun #include "bbc_i2c.h"
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun /* Convert this driver to use i2c bus layer someday... */
24*4882a593Smuzhiyun #define I2C_PCF_PIN 0x80
25*4882a593Smuzhiyun #define I2C_PCF_ESO 0x40
26*4882a593Smuzhiyun #define I2C_PCF_ES1 0x20
27*4882a593Smuzhiyun #define I2C_PCF_ES2 0x10
28*4882a593Smuzhiyun #define I2C_PCF_ENI 0x08
29*4882a593Smuzhiyun #define I2C_PCF_STA 0x04
30*4882a593Smuzhiyun #define I2C_PCF_STO 0x02
31*4882a593Smuzhiyun #define I2C_PCF_ACK 0x01
32*4882a593Smuzhiyun
33*4882a593Smuzhiyun #define I2C_PCF_START (I2C_PCF_PIN | I2C_PCF_ESO | I2C_PCF_ENI | I2C_PCF_STA | I2C_PCF_ACK)
34*4882a593Smuzhiyun #define I2C_PCF_STOP (I2C_PCF_PIN | I2C_PCF_ESO | I2C_PCF_STO | I2C_PCF_ACK)
35*4882a593Smuzhiyun #define I2C_PCF_REPSTART ( I2C_PCF_ESO | I2C_PCF_STA | I2C_PCF_ACK)
36*4882a593Smuzhiyun #define I2C_PCF_IDLE (I2C_PCF_PIN | I2C_PCF_ESO | I2C_PCF_ACK)
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun #define I2C_PCF_INI 0x40 /* 1 if not initialized */
39*4882a593Smuzhiyun #define I2C_PCF_STS 0x20
40*4882a593Smuzhiyun #define I2C_PCF_BER 0x10
41*4882a593Smuzhiyun #define I2C_PCF_AD0 0x08
42*4882a593Smuzhiyun #define I2C_PCF_LRB 0x08
43*4882a593Smuzhiyun #define I2C_PCF_AAS 0x04
44*4882a593Smuzhiyun #define I2C_PCF_LAB 0x02
45*4882a593Smuzhiyun #define I2C_PCF_BB 0x01
46*4882a593Smuzhiyun
47*4882a593Smuzhiyun /* The BBC devices have two I2C controllers. The first I2C controller
48*4882a593Smuzhiyun * connects mainly to configuration proms (NVRAM, cpu configuration,
49*4882a593Smuzhiyun * dimm types, etc.). Whereas the second I2C controller connects to
50*4882a593Smuzhiyun * environmental control devices such as fans and temperature sensors.
51*4882a593Smuzhiyun * The second controller also connects to the smartcard reader, if present.
52*4882a593Smuzhiyun */
53*4882a593Smuzhiyun
set_device_claimage(struct bbc_i2c_bus * bp,struct platform_device * op,int val)54*4882a593Smuzhiyun static void set_device_claimage(struct bbc_i2c_bus *bp, struct platform_device *op, int val)
55*4882a593Smuzhiyun {
56*4882a593Smuzhiyun int i;
57*4882a593Smuzhiyun
58*4882a593Smuzhiyun for (i = 0; i < NUM_CHILDREN; i++) {
59*4882a593Smuzhiyun if (bp->devs[i].device == op) {
60*4882a593Smuzhiyun bp->devs[i].client_claimed = val;
61*4882a593Smuzhiyun return;
62*4882a593Smuzhiyun }
63*4882a593Smuzhiyun }
64*4882a593Smuzhiyun }
65*4882a593Smuzhiyun
66*4882a593Smuzhiyun #define claim_device(BP,ECHILD) set_device_claimage(BP,ECHILD,1)
67*4882a593Smuzhiyun #define release_device(BP,ECHILD) set_device_claimage(BP,ECHILD,0)
68*4882a593Smuzhiyun
bbc_i2c_getdev(struct bbc_i2c_bus * bp,int index)69*4882a593Smuzhiyun struct platform_device *bbc_i2c_getdev(struct bbc_i2c_bus *bp, int index)
70*4882a593Smuzhiyun {
71*4882a593Smuzhiyun struct platform_device *op = NULL;
72*4882a593Smuzhiyun int curidx = 0, i;
73*4882a593Smuzhiyun
74*4882a593Smuzhiyun for (i = 0; i < NUM_CHILDREN; i++) {
75*4882a593Smuzhiyun if (!(op = bp->devs[i].device))
76*4882a593Smuzhiyun break;
77*4882a593Smuzhiyun if (curidx == index)
78*4882a593Smuzhiyun goto out;
79*4882a593Smuzhiyun op = NULL;
80*4882a593Smuzhiyun curidx++;
81*4882a593Smuzhiyun }
82*4882a593Smuzhiyun
83*4882a593Smuzhiyun out:
84*4882a593Smuzhiyun if (curidx == index)
85*4882a593Smuzhiyun return op;
86*4882a593Smuzhiyun return NULL;
87*4882a593Smuzhiyun }
88*4882a593Smuzhiyun
bbc_i2c_attach(struct bbc_i2c_bus * bp,struct platform_device * op)89*4882a593Smuzhiyun struct bbc_i2c_client *bbc_i2c_attach(struct bbc_i2c_bus *bp, struct platform_device *op)
90*4882a593Smuzhiyun {
91*4882a593Smuzhiyun struct bbc_i2c_client *client;
92*4882a593Smuzhiyun const u32 *reg;
93*4882a593Smuzhiyun
94*4882a593Smuzhiyun client = kzalloc(sizeof(*client), GFP_KERNEL);
95*4882a593Smuzhiyun if (!client)
96*4882a593Smuzhiyun return NULL;
97*4882a593Smuzhiyun client->bp = bp;
98*4882a593Smuzhiyun client->op = op;
99*4882a593Smuzhiyun
100*4882a593Smuzhiyun reg = of_get_property(op->dev.of_node, "reg", NULL);
101*4882a593Smuzhiyun if (!reg) {
102*4882a593Smuzhiyun kfree(client);
103*4882a593Smuzhiyun return NULL;
104*4882a593Smuzhiyun }
105*4882a593Smuzhiyun
106*4882a593Smuzhiyun client->bus = reg[0];
107*4882a593Smuzhiyun client->address = reg[1];
108*4882a593Smuzhiyun
109*4882a593Smuzhiyun claim_device(bp, op);
110*4882a593Smuzhiyun
111*4882a593Smuzhiyun return client;
112*4882a593Smuzhiyun }
113*4882a593Smuzhiyun
bbc_i2c_detach(struct bbc_i2c_client * client)114*4882a593Smuzhiyun void bbc_i2c_detach(struct bbc_i2c_client *client)
115*4882a593Smuzhiyun {
116*4882a593Smuzhiyun struct bbc_i2c_bus *bp = client->bp;
117*4882a593Smuzhiyun struct platform_device *op = client->op;
118*4882a593Smuzhiyun
119*4882a593Smuzhiyun release_device(bp, op);
120*4882a593Smuzhiyun kfree(client);
121*4882a593Smuzhiyun }
122*4882a593Smuzhiyun
wait_for_pin(struct bbc_i2c_bus * bp,u8 * status)123*4882a593Smuzhiyun static int wait_for_pin(struct bbc_i2c_bus *bp, u8 *status)
124*4882a593Smuzhiyun {
125*4882a593Smuzhiyun DECLARE_WAITQUEUE(wait, current);
126*4882a593Smuzhiyun int limit = 32;
127*4882a593Smuzhiyun int ret = 1;
128*4882a593Smuzhiyun
129*4882a593Smuzhiyun bp->waiting = 1;
130*4882a593Smuzhiyun add_wait_queue(&bp->wq, &wait);
131*4882a593Smuzhiyun while (limit-- > 0) {
132*4882a593Smuzhiyun long val;
133*4882a593Smuzhiyun
134*4882a593Smuzhiyun val = wait_event_interruptible_timeout(
135*4882a593Smuzhiyun bp->wq,
136*4882a593Smuzhiyun (((*status = readb(bp->i2c_control_regs + 0))
137*4882a593Smuzhiyun & I2C_PCF_PIN) == 0),
138*4882a593Smuzhiyun msecs_to_jiffies(250));
139*4882a593Smuzhiyun if (val > 0) {
140*4882a593Smuzhiyun ret = 0;
141*4882a593Smuzhiyun break;
142*4882a593Smuzhiyun }
143*4882a593Smuzhiyun }
144*4882a593Smuzhiyun remove_wait_queue(&bp->wq, &wait);
145*4882a593Smuzhiyun bp->waiting = 0;
146*4882a593Smuzhiyun
147*4882a593Smuzhiyun return ret;
148*4882a593Smuzhiyun }
149*4882a593Smuzhiyun
bbc_i2c_writeb(struct bbc_i2c_client * client,unsigned char val,int off)150*4882a593Smuzhiyun int bbc_i2c_writeb(struct bbc_i2c_client *client, unsigned char val, int off)
151*4882a593Smuzhiyun {
152*4882a593Smuzhiyun struct bbc_i2c_bus *bp = client->bp;
153*4882a593Smuzhiyun int address = client->address;
154*4882a593Smuzhiyun u8 status;
155*4882a593Smuzhiyun int ret = -1;
156*4882a593Smuzhiyun
157*4882a593Smuzhiyun if (bp->i2c_bussel_reg != NULL)
158*4882a593Smuzhiyun writeb(client->bus, bp->i2c_bussel_reg);
159*4882a593Smuzhiyun
160*4882a593Smuzhiyun writeb(address, bp->i2c_control_regs + 0x1);
161*4882a593Smuzhiyun writeb(I2C_PCF_START, bp->i2c_control_regs + 0x0);
162*4882a593Smuzhiyun if (wait_for_pin(bp, &status))
163*4882a593Smuzhiyun goto out;
164*4882a593Smuzhiyun
165*4882a593Smuzhiyun writeb(off, bp->i2c_control_regs + 0x1);
166*4882a593Smuzhiyun if (wait_for_pin(bp, &status) ||
167*4882a593Smuzhiyun (status & I2C_PCF_LRB) != 0)
168*4882a593Smuzhiyun goto out;
169*4882a593Smuzhiyun
170*4882a593Smuzhiyun writeb(val, bp->i2c_control_regs + 0x1);
171*4882a593Smuzhiyun if (wait_for_pin(bp, &status))
172*4882a593Smuzhiyun goto out;
173*4882a593Smuzhiyun
174*4882a593Smuzhiyun ret = 0;
175*4882a593Smuzhiyun
176*4882a593Smuzhiyun out:
177*4882a593Smuzhiyun writeb(I2C_PCF_STOP, bp->i2c_control_regs + 0x0);
178*4882a593Smuzhiyun return ret;
179*4882a593Smuzhiyun }
180*4882a593Smuzhiyun
bbc_i2c_readb(struct bbc_i2c_client * client,unsigned char * byte,int off)181*4882a593Smuzhiyun int bbc_i2c_readb(struct bbc_i2c_client *client, unsigned char *byte, int off)
182*4882a593Smuzhiyun {
183*4882a593Smuzhiyun struct bbc_i2c_bus *bp = client->bp;
184*4882a593Smuzhiyun unsigned char address = client->address, status;
185*4882a593Smuzhiyun int ret = -1;
186*4882a593Smuzhiyun
187*4882a593Smuzhiyun if (bp->i2c_bussel_reg != NULL)
188*4882a593Smuzhiyun writeb(client->bus, bp->i2c_bussel_reg);
189*4882a593Smuzhiyun
190*4882a593Smuzhiyun writeb(address, bp->i2c_control_regs + 0x1);
191*4882a593Smuzhiyun writeb(I2C_PCF_START, bp->i2c_control_regs + 0x0);
192*4882a593Smuzhiyun if (wait_for_pin(bp, &status))
193*4882a593Smuzhiyun goto out;
194*4882a593Smuzhiyun
195*4882a593Smuzhiyun writeb(off, bp->i2c_control_regs + 0x1);
196*4882a593Smuzhiyun if (wait_for_pin(bp, &status) ||
197*4882a593Smuzhiyun (status & I2C_PCF_LRB) != 0)
198*4882a593Smuzhiyun goto out;
199*4882a593Smuzhiyun
200*4882a593Smuzhiyun writeb(I2C_PCF_STOP, bp->i2c_control_regs + 0x0);
201*4882a593Smuzhiyun
202*4882a593Smuzhiyun address |= 0x1; /* READ */
203*4882a593Smuzhiyun
204*4882a593Smuzhiyun writeb(address, bp->i2c_control_regs + 0x1);
205*4882a593Smuzhiyun writeb(I2C_PCF_START, bp->i2c_control_regs + 0x0);
206*4882a593Smuzhiyun if (wait_for_pin(bp, &status))
207*4882a593Smuzhiyun goto out;
208*4882a593Smuzhiyun
209*4882a593Smuzhiyun /* Set PIN back to one so the device sends the first
210*4882a593Smuzhiyun * byte.
211*4882a593Smuzhiyun */
212*4882a593Smuzhiyun (void) readb(bp->i2c_control_regs + 0x1);
213*4882a593Smuzhiyun if (wait_for_pin(bp, &status))
214*4882a593Smuzhiyun goto out;
215*4882a593Smuzhiyun
216*4882a593Smuzhiyun writeb(I2C_PCF_ESO | I2C_PCF_ENI, bp->i2c_control_regs + 0x0);
217*4882a593Smuzhiyun *byte = readb(bp->i2c_control_regs + 0x1);
218*4882a593Smuzhiyun if (wait_for_pin(bp, &status))
219*4882a593Smuzhiyun goto out;
220*4882a593Smuzhiyun
221*4882a593Smuzhiyun ret = 0;
222*4882a593Smuzhiyun
223*4882a593Smuzhiyun out:
224*4882a593Smuzhiyun writeb(I2C_PCF_STOP, bp->i2c_control_regs + 0x0);
225*4882a593Smuzhiyun (void) readb(bp->i2c_control_regs + 0x1);
226*4882a593Smuzhiyun
227*4882a593Smuzhiyun return ret;
228*4882a593Smuzhiyun }
229*4882a593Smuzhiyun
bbc_i2c_write_buf(struct bbc_i2c_client * client,char * buf,int len,int off)230*4882a593Smuzhiyun int bbc_i2c_write_buf(struct bbc_i2c_client *client,
231*4882a593Smuzhiyun char *buf, int len, int off)
232*4882a593Smuzhiyun {
233*4882a593Smuzhiyun int ret = 0;
234*4882a593Smuzhiyun
235*4882a593Smuzhiyun while (len > 0) {
236*4882a593Smuzhiyun ret = bbc_i2c_writeb(client, *buf, off);
237*4882a593Smuzhiyun if (ret < 0)
238*4882a593Smuzhiyun break;
239*4882a593Smuzhiyun len--;
240*4882a593Smuzhiyun buf++;
241*4882a593Smuzhiyun off++;
242*4882a593Smuzhiyun }
243*4882a593Smuzhiyun return ret;
244*4882a593Smuzhiyun }
245*4882a593Smuzhiyun
bbc_i2c_read_buf(struct bbc_i2c_client * client,char * buf,int len,int off)246*4882a593Smuzhiyun int bbc_i2c_read_buf(struct bbc_i2c_client *client,
247*4882a593Smuzhiyun char *buf, int len, int off)
248*4882a593Smuzhiyun {
249*4882a593Smuzhiyun int ret = 0;
250*4882a593Smuzhiyun
251*4882a593Smuzhiyun while (len > 0) {
252*4882a593Smuzhiyun ret = bbc_i2c_readb(client, buf, off);
253*4882a593Smuzhiyun if (ret < 0)
254*4882a593Smuzhiyun break;
255*4882a593Smuzhiyun len--;
256*4882a593Smuzhiyun buf++;
257*4882a593Smuzhiyun off++;
258*4882a593Smuzhiyun }
259*4882a593Smuzhiyun
260*4882a593Smuzhiyun return ret;
261*4882a593Smuzhiyun }
262*4882a593Smuzhiyun
263*4882a593Smuzhiyun EXPORT_SYMBOL(bbc_i2c_getdev);
264*4882a593Smuzhiyun EXPORT_SYMBOL(bbc_i2c_attach);
265*4882a593Smuzhiyun EXPORT_SYMBOL(bbc_i2c_detach);
266*4882a593Smuzhiyun EXPORT_SYMBOL(bbc_i2c_writeb);
267*4882a593Smuzhiyun EXPORT_SYMBOL(bbc_i2c_readb);
268*4882a593Smuzhiyun EXPORT_SYMBOL(bbc_i2c_write_buf);
269*4882a593Smuzhiyun EXPORT_SYMBOL(bbc_i2c_read_buf);
270*4882a593Smuzhiyun
bbc_i2c_interrupt(int irq,void * dev_id)271*4882a593Smuzhiyun static irqreturn_t bbc_i2c_interrupt(int irq, void *dev_id)
272*4882a593Smuzhiyun {
273*4882a593Smuzhiyun struct bbc_i2c_bus *bp = dev_id;
274*4882a593Smuzhiyun
275*4882a593Smuzhiyun /* PIN going from set to clear is the only event which
276*4882a593Smuzhiyun * makes the i2c assert an interrupt.
277*4882a593Smuzhiyun */
278*4882a593Smuzhiyun if (bp->waiting &&
279*4882a593Smuzhiyun !(readb(bp->i2c_control_regs + 0x0) & I2C_PCF_PIN))
280*4882a593Smuzhiyun wake_up_interruptible(&bp->wq);
281*4882a593Smuzhiyun
282*4882a593Smuzhiyun return IRQ_HANDLED;
283*4882a593Smuzhiyun }
284*4882a593Smuzhiyun
reset_one_i2c(struct bbc_i2c_bus * bp)285*4882a593Smuzhiyun static void reset_one_i2c(struct bbc_i2c_bus *bp)
286*4882a593Smuzhiyun {
287*4882a593Smuzhiyun writeb(I2C_PCF_PIN, bp->i2c_control_regs + 0x0);
288*4882a593Smuzhiyun writeb(bp->own, bp->i2c_control_regs + 0x1);
289*4882a593Smuzhiyun writeb(I2C_PCF_PIN | I2C_PCF_ES1, bp->i2c_control_regs + 0x0);
290*4882a593Smuzhiyun writeb(bp->clock, bp->i2c_control_regs + 0x1);
291*4882a593Smuzhiyun writeb(I2C_PCF_IDLE, bp->i2c_control_regs + 0x0);
292*4882a593Smuzhiyun }
293*4882a593Smuzhiyun
attach_one_i2c(struct platform_device * op,int index)294*4882a593Smuzhiyun static struct bbc_i2c_bus * attach_one_i2c(struct platform_device *op, int index)
295*4882a593Smuzhiyun {
296*4882a593Smuzhiyun struct bbc_i2c_bus *bp;
297*4882a593Smuzhiyun struct device_node *dp;
298*4882a593Smuzhiyun int entry;
299*4882a593Smuzhiyun
300*4882a593Smuzhiyun bp = kzalloc(sizeof(*bp), GFP_KERNEL);
301*4882a593Smuzhiyun if (!bp)
302*4882a593Smuzhiyun return NULL;
303*4882a593Smuzhiyun
304*4882a593Smuzhiyun INIT_LIST_HEAD(&bp->temps);
305*4882a593Smuzhiyun INIT_LIST_HEAD(&bp->fans);
306*4882a593Smuzhiyun
307*4882a593Smuzhiyun bp->i2c_control_regs = of_ioremap(&op->resource[0], 0, 0x2, "bbc_i2c_regs");
308*4882a593Smuzhiyun if (!bp->i2c_control_regs)
309*4882a593Smuzhiyun goto fail;
310*4882a593Smuzhiyun
311*4882a593Smuzhiyun if (op->num_resources == 2) {
312*4882a593Smuzhiyun bp->i2c_bussel_reg = of_ioremap(&op->resource[1], 0, 0x1, "bbc_i2c_bussel");
313*4882a593Smuzhiyun if (!bp->i2c_bussel_reg)
314*4882a593Smuzhiyun goto fail;
315*4882a593Smuzhiyun }
316*4882a593Smuzhiyun
317*4882a593Smuzhiyun bp->waiting = 0;
318*4882a593Smuzhiyun init_waitqueue_head(&bp->wq);
319*4882a593Smuzhiyun if (request_irq(op->archdata.irqs[0], bbc_i2c_interrupt,
320*4882a593Smuzhiyun IRQF_SHARED, "bbc_i2c", bp))
321*4882a593Smuzhiyun goto fail;
322*4882a593Smuzhiyun
323*4882a593Smuzhiyun bp->index = index;
324*4882a593Smuzhiyun bp->op = op;
325*4882a593Smuzhiyun
326*4882a593Smuzhiyun spin_lock_init(&bp->lock);
327*4882a593Smuzhiyun
328*4882a593Smuzhiyun entry = 0;
329*4882a593Smuzhiyun for (dp = op->dev.of_node->child;
330*4882a593Smuzhiyun dp && entry < 8;
331*4882a593Smuzhiyun dp = dp->sibling, entry++) {
332*4882a593Smuzhiyun struct platform_device *child_op;
333*4882a593Smuzhiyun
334*4882a593Smuzhiyun child_op = of_find_device_by_node(dp);
335*4882a593Smuzhiyun bp->devs[entry].device = child_op;
336*4882a593Smuzhiyun bp->devs[entry].client_claimed = 0;
337*4882a593Smuzhiyun }
338*4882a593Smuzhiyun
339*4882a593Smuzhiyun writeb(I2C_PCF_PIN, bp->i2c_control_regs + 0x0);
340*4882a593Smuzhiyun bp->own = readb(bp->i2c_control_regs + 0x01);
341*4882a593Smuzhiyun writeb(I2C_PCF_PIN | I2C_PCF_ES1, bp->i2c_control_regs + 0x0);
342*4882a593Smuzhiyun bp->clock = readb(bp->i2c_control_regs + 0x01);
343*4882a593Smuzhiyun
344*4882a593Smuzhiyun printk(KERN_INFO "i2c-%d: Regs at %p, %d devices, own %02x, clock %02x.\n",
345*4882a593Smuzhiyun bp->index, bp->i2c_control_regs, entry, bp->own, bp->clock);
346*4882a593Smuzhiyun
347*4882a593Smuzhiyun reset_one_i2c(bp);
348*4882a593Smuzhiyun
349*4882a593Smuzhiyun return bp;
350*4882a593Smuzhiyun
351*4882a593Smuzhiyun fail:
352*4882a593Smuzhiyun if (bp->i2c_bussel_reg)
353*4882a593Smuzhiyun of_iounmap(&op->resource[1], bp->i2c_bussel_reg, 1);
354*4882a593Smuzhiyun if (bp->i2c_control_regs)
355*4882a593Smuzhiyun of_iounmap(&op->resource[0], bp->i2c_control_regs, 2);
356*4882a593Smuzhiyun kfree(bp);
357*4882a593Smuzhiyun return NULL;
358*4882a593Smuzhiyun }
359*4882a593Smuzhiyun
360*4882a593Smuzhiyun extern int bbc_envctrl_init(struct bbc_i2c_bus *bp);
361*4882a593Smuzhiyun extern void bbc_envctrl_cleanup(struct bbc_i2c_bus *bp);
362*4882a593Smuzhiyun
bbc_i2c_probe(struct platform_device * op)363*4882a593Smuzhiyun static int bbc_i2c_probe(struct platform_device *op)
364*4882a593Smuzhiyun {
365*4882a593Smuzhiyun struct bbc_i2c_bus *bp;
366*4882a593Smuzhiyun int err, index = 0;
367*4882a593Smuzhiyun
368*4882a593Smuzhiyun bp = attach_one_i2c(op, index);
369*4882a593Smuzhiyun if (!bp)
370*4882a593Smuzhiyun return -EINVAL;
371*4882a593Smuzhiyun
372*4882a593Smuzhiyun err = bbc_envctrl_init(bp);
373*4882a593Smuzhiyun if (err) {
374*4882a593Smuzhiyun free_irq(op->archdata.irqs[0], bp);
375*4882a593Smuzhiyun if (bp->i2c_bussel_reg)
376*4882a593Smuzhiyun of_iounmap(&op->resource[0], bp->i2c_bussel_reg, 1);
377*4882a593Smuzhiyun if (bp->i2c_control_regs)
378*4882a593Smuzhiyun of_iounmap(&op->resource[1], bp->i2c_control_regs, 2);
379*4882a593Smuzhiyun kfree(bp);
380*4882a593Smuzhiyun } else {
381*4882a593Smuzhiyun dev_set_drvdata(&op->dev, bp);
382*4882a593Smuzhiyun }
383*4882a593Smuzhiyun
384*4882a593Smuzhiyun return err;
385*4882a593Smuzhiyun }
386*4882a593Smuzhiyun
bbc_i2c_remove(struct platform_device * op)387*4882a593Smuzhiyun static int bbc_i2c_remove(struct platform_device *op)
388*4882a593Smuzhiyun {
389*4882a593Smuzhiyun struct bbc_i2c_bus *bp = dev_get_drvdata(&op->dev);
390*4882a593Smuzhiyun
391*4882a593Smuzhiyun bbc_envctrl_cleanup(bp);
392*4882a593Smuzhiyun
393*4882a593Smuzhiyun free_irq(op->archdata.irqs[0], bp);
394*4882a593Smuzhiyun
395*4882a593Smuzhiyun if (bp->i2c_bussel_reg)
396*4882a593Smuzhiyun of_iounmap(&op->resource[0], bp->i2c_bussel_reg, 1);
397*4882a593Smuzhiyun if (bp->i2c_control_regs)
398*4882a593Smuzhiyun of_iounmap(&op->resource[1], bp->i2c_control_regs, 2);
399*4882a593Smuzhiyun
400*4882a593Smuzhiyun kfree(bp);
401*4882a593Smuzhiyun
402*4882a593Smuzhiyun return 0;
403*4882a593Smuzhiyun }
404*4882a593Smuzhiyun
405*4882a593Smuzhiyun static const struct of_device_id bbc_i2c_match[] = {
406*4882a593Smuzhiyun {
407*4882a593Smuzhiyun .name = "i2c",
408*4882a593Smuzhiyun .compatible = "SUNW,bbc-i2c",
409*4882a593Smuzhiyun },
410*4882a593Smuzhiyun {},
411*4882a593Smuzhiyun };
412*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, bbc_i2c_match);
413*4882a593Smuzhiyun
414*4882a593Smuzhiyun static struct platform_driver bbc_i2c_driver = {
415*4882a593Smuzhiyun .driver = {
416*4882a593Smuzhiyun .name = "bbc_i2c",
417*4882a593Smuzhiyun .of_match_table = bbc_i2c_match,
418*4882a593Smuzhiyun },
419*4882a593Smuzhiyun .probe = bbc_i2c_probe,
420*4882a593Smuzhiyun .remove = bbc_i2c_remove,
421*4882a593Smuzhiyun };
422*4882a593Smuzhiyun
423*4882a593Smuzhiyun module_platform_driver(bbc_i2c_driver);
424*4882a593Smuzhiyun
425*4882a593Smuzhiyun MODULE_LICENSE("GPL");
426