17
17
struct i2c_msg msg = {
18
18
.addr = mst->i2c_addr,.flags = 0,.buf = b,.len = 4
20
21
return i2c_transfer(mst->i2c_adap, &msg, 1) != 1 ? -EREMOTEIO : 0;
24
static u16 dibx000_read_word(struct dibx000_i2c_master *mst, u16 reg)
26
u8 wb[2] = { reg >> 8, reg & 0xff };
28
struct i2c_msg msg[2] = {
29
{.addr = mst->i2c_addr, .flags = 0, .buf = wb, .len = 2},
30
{.addr = mst->i2c_addr, .flags = I2C_M_RD, .buf = rb, .len = 2},
33
if (i2c_transfer(mst->i2c_adap, msg, 2) != 2)
34
dprintk("i2c read error on %d", reg);
36
return (rb[0] << 8) | rb[1];
39
static int dibx000_is_i2c_done(struct dibx000_i2c_master *mst)
44
while (((status = dibx000_read_word(mst, mst->base_reg + 2)) & 0x0100) == 0 && --i > 0)
52
if ((status & 0x0080) == 0)
58
static int dibx000_master_i2c_write(struct dibx000_i2c_master *mst, struct i2c_msg *msg, u8 stop)
63
u16 txlen = msg->len, len;
64
const u8 *b = msg->buf;
67
dibx000_read_word(mst, mst->base_reg + 2);
69
len = txlen > 8 ? 8 : txlen;
70
for (i = 0; i < len; i += 2) {
74
dibx000_write_word(mst, mst->base_reg, data);
76
da = (((u8) (msg->addr)) << 9) |
85
if (txlen == msg->len)
86
da |= 1 << 5; /* start */
88
if (txlen-len == 0 && stop)
89
da |= 1 << 6; /* stop */
91
dibx000_write_word(mst, mst->base_reg+1, da);
93
if (dibx000_is_i2c_done(mst) != 0)
101
static int dibx000_master_i2c_read(struct dibx000_i2c_master *mst, struct i2c_msg *msg)
105
u16 rxlen = msg->len, len;
108
len = rxlen > 8 ? 8 : rxlen;
109
da = (((u8) (msg->addr)) << 9) |
118
if (rxlen == msg->len)
119
da |= 1 << 5; /* start */
122
da |= 1 << 6; /* stop */
123
dibx000_write_word(mst, mst->base_reg+1, da);
125
if (dibx000_is_i2c_done(mst) != 0)
131
da = dibx000_read_word(mst, mst->base_reg);
132
*b++ = (da >> 8) & 0xff;
144
int dibx000_i2c_set_speed(struct i2c_adapter *i2c_adap, u16 speed)
146
struct dibx000_i2c_master *mst = i2c_get_adapdata(i2c_adap);
148
if (mst->device_rev < DIB7000MC && speed < 235)
150
return dibx000_write_word(mst, mst->base_reg + 3, (u16)(60000 / speed));
153
EXPORT_SYMBOL(dibx000_i2c_set_speed);
155
static u32 dibx000_i2c_func(struct i2c_adapter *adapter)
24
160
static int dibx000_i2c_select_interface(struct dibx000_i2c_master *mst,
25
161
enum dibx000_i2c_interface intf)
171
static int dibx000_i2c_master_xfer_gpio12(struct i2c_adapter *i2c_adap, struct i2c_msg msg[], int num)
173
struct dibx000_i2c_master *mst = i2c_get_adapdata(i2c_adap);
177
dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_GPIO_1_2);
178
for (msg_index = 0; msg_index < num; msg_index++) {
179
if (msg[msg_index].flags & I2C_M_RD) {
180
ret = dibx000_master_i2c_read(mst, &msg[msg_index]);
184
ret = dibx000_master_i2c_write(mst, &msg[msg_index], 1);
193
static int dibx000_i2c_master_xfer_gpio34(struct i2c_adapter *i2c_adap, struct i2c_msg msg[], int num)
195
struct dibx000_i2c_master *mst = i2c_get_adapdata(i2c_adap);
199
dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_GPIO_3_4);
200
for (msg_index = 0; msg_index < num; msg_index++) {
201
if (msg[msg_index].flags & I2C_M_RD) {
202
ret = dibx000_master_i2c_read(mst, &msg[msg_index]);
206
ret = dibx000_master_i2c_write(mst, &msg[msg_index], 1);
215
static struct i2c_algorithm dibx000_i2c_master_gpio12_xfer_algo = {
216
.master_xfer = dibx000_i2c_master_xfer_gpio12,
217
.functionality = dibx000_i2c_func,
220
static struct i2c_algorithm dibx000_i2c_master_gpio34_xfer_algo = {
221
.master_xfer = dibx000_i2c_master_xfer_gpio34,
222
.functionality = dibx000_i2c_func,
35
225
static int dibx000_i2c_gate_ctrl(struct dibx000_i2c_master *mst, u8 tx[4],
36
226
u8 addr, int onoff)
57
static u32 dibx000_i2c_func(struct i2c_adapter *adapter)
247
static int dibx000_i2c_gated_gpio67_xfer(struct i2c_adapter *i2c_adap,
248
struct i2c_msg msg[], int num)
250
struct dibx000_i2c_master *mst = i2c_get_adapdata(i2c_adap);
251
struct i2c_msg m[2 + num];
252
u8 tx_open[4], tx_close[4];
254
memset(m, 0, sizeof(struct i2c_msg) * (2 + num));
256
dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_GPIO_6_7);
258
dibx000_i2c_gate_ctrl(mst, tx_open, msg[0].addr, 1);
259
m[0].addr = mst->i2c_addr;
263
memcpy(&m[1], msg, sizeof(struct i2c_msg) * num);
265
dibx000_i2c_gate_ctrl(mst, tx_close, 0, 0);
266
m[num + 1].addr = mst->i2c_addr;
267
m[num + 1].buf = tx_close;
270
return i2c_transfer(mst->i2c_adap, m, 2 + num) == 2 + num ? num : -EIO;
273
static struct i2c_algorithm dibx000_i2c_gated_gpio67_algo = {
274
.master_xfer = dibx000_i2c_gated_gpio67_xfer,
275
.functionality = dibx000_i2c_func,
62
278
static int dibx000_i2c_gated_tuner_xfer(struct i2c_adapter *i2c_adap,
63
279
struct i2c_msg msg[], int num)
102
318
i2c = &mst->gated_tuner_i2c_adap;
320
case DIBX000_I2C_INTERFACE_GPIO_1_2:
322
i2c = &mst->master_i2c_adap_gpio12;
324
case DIBX000_I2C_INTERFACE_GPIO_3_4:
326
i2c = &mst->master_i2c_adap_gpio34;
328
case DIBX000_I2C_INTERFACE_GPIO_6_7:
330
i2c = &mst->master_i2c_adap_gpio67;
105
333
printk(KERN_ERR "DiBX000: incorrect I2C interface selected\n");
126
354
EXPORT_SYMBOL(dibx000_reset_i2c_master);
128
356
static int i2c_adapter_init(struct i2c_adapter *i2c_adap,
129
struct i2c_algorithm *algo, const char *name,
130
struct dibx000_i2c_master *mst)
357
struct i2c_algorithm *algo, const char *name,
358
struct dibx000_i2c_master *mst)
132
360
strncpy(i2c_adap->name, name, sizeof(i2c_adap->name));
133
361
i2c_adap->algo = algo;
154
382
mst->base_reg = 768;
157
(&mst->gated_tuner_i2c_adap, &dibx000_i2c_gated_tuner_algo,
158
"DiBX000 tuner I2C bus", mst) != 0)
160
"DiBX000: could not initialize the tuner i2c_adapter\n");
384
mst->gated_tuner_i2c_adap.dev.parent = mst->i2c_adap->dev.parent;
386
(&mst->gated_tuner_i2c_adap, &dibx000_i2c_gated_tuner_algo,
387
"DiBX000 tuner I2C bus", mst) != 0)
389
"DiBX000: could not initialize the tuner i2c_adapter\n");
391
mst->master_i2c_adap_gpio12.dev.parent = mst->i2c_adap->dev.parent;
393
(&mst->master_i2c_adap_gpio12, &dibx000_i2c_master_gpio12_xfer_algo,
394
"DiBX000 master GPIO12 I2C bus", mst) != 0)
396
"DiBX000: could not initialize the master i2c_adapter\n");
398
mst->master_i2c_adap_gpio34.dev.parent = mst->i2c_adap->dev.parent;
400
(&mst->master_i2c_adap_gpio34, &dibx000_i2c_master_gpio34_xfer_algo,
401
"DiBX000 master GPIO34 I2C bus", mst) != 0)
403
"DiBX000: could not initialize the master i2c_adapter\n");
405
mst->master_i2c_adap_gpio67.dev.parent = mst->i2c_adap->dev.parent;
407
(&mst->master_i2c_adap_gpio67, &dibx000_i2c_gated_gpio67_algo,
408
"DiBX000 master GPIO67 I2C bus", mst) != 0)
410
"DiBX000: could not initialize the master i2c_adapter\n");
162
412
/* initialize the i2c-master by closing the gate */
163
413
dibx000_i2c_gate_ctrl(mst, tx, 0, 0);
170
420
void dibx000_exit_i2c_master(struct dibx000_i2c_master *mst)
172
422
i2c_del_adapter(&mst->gated_tuner_i2c_adap);
423
i2c_del_adapter(&mst->master_i2c_adap_gpio12);
424
i2c_del_adapter(&mst->master_i2c_adap_gpio34);
425
i2c_del_adapter(&mst->master_i2c_adap_gpio67);
174
427
EXPORT_SYMBOL(dibx000_exit_i2c_master);
177
430
u32 systime(void)
181
t = current_kernel_time();
182
return (t.tv_sec * 10000) + (t.tv_nsec / 100000);
434
t = current_kernel_time();
435
return (t.tv_sec * 10000) + (t.tv_nsec / 100000);
184
437
EXPORT_SYMBOL(systime);