Commit | Line | Data |
---|---|---|
41e840b1 MA |
1 | /* |
2 | Mantis PCI bridge driver | |
3 | ||
4 | Copyright (C) 2005, 2006 Manu Abraham (abraham.manu@gmail.com) | |
5 | ||
6 | This program is free software; you can redistribute it and/or modify | |
7 | it under the terms of the GNU General Public License as published by | |
8 | the Free Software Foundation; either version 2 of the License, or | |
9 | (at your option) any later version. | |
10 | ||
11 | This program is distributed in the hope that it will be useful, | |
12 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 | GNU General Public License for more details. | |
15 | ||
16 | You should have received a copy of the GNU General Public License | |
17 | along with this program; if not, write to the Free Software | |
18 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
19 | */ | |
20 | ||
21 | #include <linux/module.h> | |
22 | #include <linux/moduleparam.h> | |
23 | #include <linux/init.h> | |
24 | #include <linux/delay.h> | |
25 | #include <asm/io.h> | |
26 | #include <linux/ioport.h> | |
27 | #include <asm/pgtable.h> | |
28 | #include <asm/page.h> | |
29 | #include "mantis_common.h" | |
30 | ||
31 | #define I2C_HW_B_MANTIS 0x1c | |
32 | ||
33 | static int mantis_ack_wait(struct mantis_pci *mantis) | |
34 | { | |
35 | int rc = 0; | |
df0cca17 | 36 | u32 timeout = 0; |
41e840b1 MA |
37 | |
38 | if (wait_event_interruptible_timeout(mantis->i2c_wq, | |
df0cca17 MA |
39 | mantis->mantis_int_stat & MANTIS_INT_I2CDONE, |
40 | msecs_to_jiffies(50)) == -ERESTARTSYS) { | |
41e840b1 | 41 | |
715d341c | 42 | dprintk(verbose, MANTIS_DEBUG, 1, "Master !I2CDONE"); |
41e840b1 | 43 | rc = -EREMOTEIO; |
df0cca17 MA |
44 | } |
45 | while (!(mantis->mantis_int_stat & MANTIS_INT_I2CRACK)) { | |
46 | dprintk(verbose, MANTIS_DEBUG, 1, "Waiting for Slave RACK"); | |
47 | mantis->mantis_int_stat = mmread(MANTIS_INT_STAT); | |
48 | msleep(5); | |
49 | timeout++; | |
50 | if (timeout > 500) { | |
51 | dprintk(verbose, MANTIS_ERROR, 1, "Slave RACK Fail !"); | |
52 | rc = -EREMOTEIO; | |
41e840b1 MA |
53 | break; |
54 | } | |
55 | } | |
df0cca17 | 56 | udelay(350); |
41e840b1 MA |
57 | |
58 | return rc; | |
59 | } | |
60 | ||
61 | static int mantis_i2c_read(struct mantis_pci *mantis, const struct i2c_msg *msg) | |
62 | { | |
63 | u32 rxd, i; | |
64 | ||
715d341c MA |
65 | dprintk(verbose, MANTIS_INFO, 0, " %s: Address=[0x%02x] <R>[ ", |
66 | __func__, msg->addr); | |
67 | ||
41e840b1 MA |
68 | for (i = 0; i < msg->len; i++) { |
69 | rxd = (msg->addr << 25) | (1 << 24) | |
70 | | MANTIS_I2C_RATE_3 | |
71 | | MANTIS_I2C_STOP | |
72 | | MANTIS_I2C_PGMODE; | |
73 | ||
74 | if (i == (msg->len - 1)) | |
75 | rxd &= ~MANTIS_I2C_STOP; | |
76 | ||
df0cca17 | 77 | mmwrite(MANTIS_INT_I2CDONE, MANTIS_INT_STAT); |
41e840b1 | 78 | mmwrite(rxd, MANTIS_I2CDATA_CTL); |
df0cca17 | 79 | if (mantis_ack_wait(mantis) != 0) { |
41e840b1 | 80 | dprintk(verbose, MANTIS_DEBUG, 1, "ACK failed<R>"); |
df0cca17 | 81 | return -EREMOTEIO; |
41e840b1 MA |
82 | } |
83 | rxd = mmread(MANTIS_I2CDATA_CTL); | |
84 | msg->buf[i] = (u8)((rxd >> 8) & 0xFF); | |
df0cca17 | 85 | dprintk(verbose, MANTIS_INFO, 0, "%02x ", msg->buf[i]); |
41e840b1 | 86 | } |
df0cca17 | 87 | dprintk(verbose, MANTIS_INFO, 0, "]\n"); |
41e840b1 MA |
88 | |
89 | return 0; | |
90 | } | |
91 | ||
92 | static int mantis_i2c_write(struct mantis_pci *mantis, const struct i2c_msg *msg) | |
93 | { | |
94 | int i; | |
95 | u32 txd = 0; | |
96 | ||
715d341c MA |
97 | dprintk(verbose, MANTIS_INFO, 0, " %s: Address=[0x%02x] <W>[ ", |
98 | __func__, msg->addr); | |
99 | ||
41e840b1 | 100 | for (i = 0; i < msg->len; i++) { |
df0cca17 | 101 | dprintk(verbose, MANTIS_INFO, 0, "%02x ", msg->buf[i]); |
41e840b1 MA |
102 | txd = (msg->addr << 25) | (msg->buf[i] << 8) |
103 | | MANTIS_I2C_RATE_3 | |
104 | | MANTIS_I2C_STOP | |
105 | | MANTIS_I2C_PGMODE; | |
106 | ||
107 | if (i == (msg->len - 1)) | |
108 | txd &= ~MANTIS_I2C_STOP; | |
109 | ||
df0cca17 | 110 | mmwrite(MANTIS_INT_I2CDONE, MANTIS_INT_STAT); |
41e840b1 | 111 | mmwrite(txd, MANTIS_I2CDATA_CTL); |
df0cca17 | 112 | if (mantis_ack_wait(mantis) != 0) { |
41e840b1 | 113 | dprintk(verbose, MANTIS_DEBUG, 1, "ACK failed<W>"); |
df0cca17 | 114 | return -EREMOTEIO; |
41e840b1 | 115 | } |
41e840b1 | 116 | } |
df0cca17 | 117 | dprintk(verbose, MANTIS_INFO, 0, "]\n"); |
41e840b1 MA |
118 | |
119 | return 0; | |
120 | } | |
121 | ||
122 | static int mantis_i2c_xfer(struct i2c_adapter *adapter, struct i2c_msg *msgs, int num) | |
123 | { | |
124 | int ret = 0, i; | |
125 | struct mantis_pci *mantis; | |
126 | ||
127 | mantis = i2c_get_adapdata(adapter); | |
e2f67e4f | 128 | mutex_lock(&mantis->i2c_lock); |
41e840b1 MA |
129 | for (i = 0; i < num; i++) { |
130 | if (msgs[i].flags & I2C_M_RD) | |
131 | ret = mantis_i2c_read(mantis, &msgs[i]); | |
132 | else | |
133 | ret = mantis_i2c_write(mantis, &msgs[i]); | |
134 | ||
135 | if (ret < 0) | |
136 | return ret; | |
137 | } | |
e2f67e4f | 138 | mutex_unlock(&mantis->i2c_lock); |
41e840b1 MA |
139 | |
140 | return num; | |
141 | } | |
142 | ||
143 | static u32 mantis_i2c_func(struct i2c_adapter *adapter) | |
144 | { | |
145 | return I2C_FUNC_SMBUS_EMUL; | |
146 | } | |
147 | ||
148 | static struct i2c_algorithm mantis_algo = { | |
149 | .master_xfer = mantis_i2c_xfer, | |
150 | .functionality = mantis_i2c_func, | |
151 | }; | |
152 | ||
153 | static struct i2c_adapter mantis_i2c_adapter = { | |
154 | .owner = THIS_MODULE, | |
155 | .name = "Mantis I2C", | |
156 | .id = I2C_HW_B_MANTIS, | |
157 | .class = I2C_CLASS_TV_DIGITAL, | |
158 | .algo = &mantis_algo, | |
159 | }; | |
160 | ||
161 | int __devinit mantis_i2c_init(struct mantis_pci *mantis) | |
162 | { | |
df0cca17 | 163 | u32 intstat, intmask; |
41e840b1 | 164 | |
e2f67e4f | 165 | mutex_init(&mantis->i2c_lock); |
41e840b1 MA |
166 | memcpy(&mantis->adapter, &mantis_i2c_adapter, sizeof (mantis_i2c_adapter)); |
167 | i2c_set_adapdata(&mantis->adapter, mantis); | |
168 | mantis->i2c_rc = i2c_add_adapter(&mantis->adapter); | |
169 | if (mantis->i2c_rc < 0) | |
170 | return mantis->i2c_rc; | |
171 | ||
172 | dprintk(verbose, MANTIS_DEBUG, 1, "Initializing I2C .."); | |
173 | ||
41e840b1 | 174 | intstat = mmread(MANTIS_INT_STAT); |
df0cca17 | 175 | intmask = mmread(MANTIS_INT_MASK); |
41e840b1 | 176 | mmwrite(intstat, MANTIS_INT_STAT); |
df0cca17 | 177 | mmwrite(intmask | MANTIS_INT_I2CDONE, MANTIS_INT_MASK); |
41e840b1 | 178 | |
df0cca17 | 179 | dprintk(verbose, MANTIS_DEBUG, 1, "[0x%08x/%08x]", intstat, intmask); |
41e840b1 MA |
180 | |
181 | return 0; | |
182 | } | |
183 | ||
184 | int __devexit mantis_i2c_exit(struct mantis_pci *mantis) | |
185 | { | |
186 | dprintk(verbose, MANTIS_DEBUG, 1, "Removing I2C adapter"); | |
187 | return i2c_del_adapter(&mantis->adapter); | |
188 | } |