2 * ddbridge-i2c.c: Digital Devices bridge i2c driver
4 * Copyright (C) 2010-2017 Digital Devices GmbH
5 * Ralph Metzler <rjkm@metzlerbros.de>
6 * Marcus Metzler <mocm@metzlerbros.de>
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * version 2 only, as published by the Free Software Foundation.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
19 #include <linux/module.h>
20 #include <linux/init.h>
21 #include <linux/interrupt.h>
22 #include <linux/delay.h>
23 #include <linux/slab.h>
24 #include <linux/poll.h>
26 #include <linux/pci.h>
27 #include <linux/pci_ids.h>
28 #include <linux/timer.h>
29 #include <linux/i2c.h>
30 #include <linux/swab.h>
31 #include <linux/vmalloc.h>
34 #include "ddbridge-i2c.h"
35 #include "ddbridge-regs.h"
36 #include "ddbridge-io.h"
38 /******************************************************************************/
40 static int ddb_i2c_cmd(struct ddb_i2c *i2c, u32 adr, u32 cmd)
42 struct ddb *dev = i2c->dev;
46 ddbwritel(dev, (adr << 9) | cmd, i2c->regs + I2C_COMMAND);
47 stat = wait_for_completion_timeout(&i2c->completion, HZ);
48 val = ddbreadl(dev, i2c->regs + I2C_COMMAND);
50 dev_err(dev->dev, "I2C timeout, card %d, port %d, link %u\n",
51 dev->nr, i2c->nr, i2c->link);
53 u32 istat = ddbreadl(dev, INTERRUPT_STATUS);
55 dev_err(dev->dev, "DDBridge IRS %08x\n", istat);
57 u32 listat = ddbreadl(dev,
58 DDB_LINK_TAG(i2c->link) |
61 dev_err(dev->dev, "DDBridge link %u IRS %08x\n",
65 ddbwritel(dev, istat & 1, INTERRUPT_ACK);
67 u32 mon = ddbreadl(dev,
68 i2c->regs + I2C_MONITOR);
70 dev_err(dev->dev, "I2C cmd=%08x mon=%08x\n",
81 static int ddb_i2c_master_xfer(struct i2c_adapter *adapter,
82 struct i2c_msg msg[], int num)
84 struct ddb_i2c *i2c = (struct ddb_i2c *) i2c_get_adapdata(adapter);
85 struct ddb *dev = i2c->dev;
89 if (msg[0].len > i2c->bsize)
93 if (msg[0].flags & I2C_M_RD) {
94 ddbwritel(dev, msg[0].len << 16,
95 i2c->regs + I2C_TASKLENGTH);
96 if (ddb_i2c_cmd(i2c, addr, 3))
98 ddbcpyfrom(dev, msg[0].buf,
99 i2c->rbuf, msg[0].len);
102 ddbcpyto(dev, i2c->wbuf, msg[0].buf, msg[0].len);
103 ddbwritel(dev, msg[0].len, i2c->regs + I2C_TASKLENGTH);
104 if (ddb_i2c_cmd(i2c, addr, 2))
108 if ((msg[0].flags & I2C_M_RD) == I2C_M_RD)
110 if ((msg[1].flags & I2C_M_RD) != I2C_M_RD)
112 if (msg[1].len > i2c->bsize)
114 ddbcpyto(dev, i2c->wbuf, msg[0].buf, msg[0].len);
115 ddbwritel(dev, msg[0].len | (msg[1].len << 16),
116 i2c->regs + I2C_TASKLENGTH);
117 if (ddb_i2c_cmd(i2c, addr, 1))
119 ddbcpyfrom(dev, msg[1].buf,
129 static u32 ddb_i2c_functionality(struct i2c_adapter *adap)
131 return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
134 static const struct i2c_algorithm ddb_i2c_algo = {
135 .master_xfer = ddb_i2c_master_xfer,
136 .functionality = ddb_i2c_functionality,
139 void ddb_i2c_release(struct ddb *dev)
144 for (i = 0; i < dev->i2c_num; i++) {
146 i2c_del_adapter(&i2c->adap);
150 static void i2c_handler(unsigned long priv)
152 struct ddb_i2c *i2c = (struct ddb_i2c *) priv;
154 complete(&i2c->completion);
157 static int ddb_i2c_add(struct ddb *dev, struct ddb_i2c *i2c,
158 const struct ddb_regmap *regmap, int link,
161 struct i2c_adapter *adap;
166 i2c->bsize = regmap->i2c_buf->size;
167 i2c->wbuf = DDB_LINK_TAG(link) |
168 (regmap->i2c_buf->base + i2c->bsize * i);
169 i2c->rbuf = i2c->wbuf; /* + i2c->bsize / 2 */
170 i2c->regs = DDB_LINK_TAG(link) |
171 (regmap->i2c->base + regmap->i2c->size * i);
172 ddbwritel(dev, I2C_SPEED_100, i2c->regs + I2C_TIMING);
173 ddbwritel(dev, ((i2c->rbuf & 0xffff) << 16) | (i2c->wbuf & 0xffff),
174 i2c->regs + I2C_TASKADDRESS);
175 init_completion(&i2c->completion);
178 i2c_set_adapdata(adap, i2c);
179 #ifdef I2C_ADAP_CLASS_TV_DIGITAL
180 adap->class = I2C_ADAP_CLASS_TV_DIGITAL|I2C_CLASS_TV_ANALOG;
182 #ifdef I2C_CLASS_TV_ANALOG
183 adap->class = I2C_CLASS_TV_ANALOG;
186 snprintf(adap->name, I2C_NAME_SIZE, "ddbridge_%02x.%x.%x",
187 dev->nr, i2c->link, i);
188 adap->algo = &ddb_i2c_algo;
189 adap->algo_data = (void *)i2c;
190 adap->dev.parent = dev->dev;
191 return i2c_add_adapter(adap);
194 int ddb_i2c_init(struct ddb *dev)
197 u32 i, j, num = 0, l, base;
199 struct i2c_adapter *adap;
200 const struct ddb_regmap *regmap;
202 for (l = 0; l < DDB_MAX_LINK; l++) {
203 if (!dev->link[l].info)
205 regmap = dev->link[l].info->regmap;
206 if (!regmap || !regmap->i2c)
208 base = regmap->irq_base_i2c;
209 for (i = 0; i < regmap->i2c->num; i++) {
210 if (!(dev->link[l].info->i2c_mask & (1 << i)))
212 i2c = &dev->i2c[num];
213 dev->handler_data[l][i + base] = (unsigned long) i2c;
214 dev->handler[l][i + base] = i2c_handler;
215 stat = ddb_i2c_add(dev, i2c, regmap, l, i, num);
222 for (j = 0; j < num; j++) {
225 i2c_del_adapter(adap);