]>
Commit | Line | Data |
---|---|---|
41e840b1 MA |
1 | /* |
2 | Mantis PCI bridge driver | |
3 | ||
8825a097 | 4 | Copyright (C) Manu Abraham (abraham.manu@gmail.com) |
41e840b1 MA |
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 | ||
41e840b1 MA |
21 | #include <asm/io.h> |
22 | #include <linux/ioport.h> | |
b3b96144 MA |
23 | #include <linux/pci.h> |
24 | #include <linux/i2c.h> | |
25 | ||
26 | #include "dmxdev.h" | |
27 | #include "dvbdev.h" | |
28 | #include "dvb_demux.h" | |
29 | #include "dvb_frontend.h" | |
30 | #include "dvb_net.h" | |
31 | ||
41e840b1 | 32 | #include "mantis_common.h" |
b3b96144 MA |
33 | #include "mantis_reg.h" |
34 | #include "mantis_i2c.h" | |
41e840b1 | 35 | |
bc832fa2 MA |
36 | #define TRIALS 10000 |
37 | ||
41e840b1 MA |
38 | static int mantis_i2c_read(struct mantis_pci *mantis, const struct i2c_msg *msg) |
39 | { | |
3e978a82 | 40 | u32 rxd, i, stat, trials; |
41e840b1 | 41 | |
b3b96144 | 42 | dprintk(MANTIS_INFO, 0, " %s: Address=[0x%02x] <R>[ ", |
715d341c MA |
43 | __func__, msg->addr); |
44 | ||
41e840b1 MA |
45 | for (i = 0; i < msg->len; i++) { |
46 | rxd = (msg->addr << 25) | (1 << 24) | |
47 | | MANTIS_I2C_RATE_3 | |
48 | | MANTIS_I2C_STOP | |
49 | | MANTIS_I2C_PGMODE; | |
50 | ||
51 | if (i == (msg->len - 1)) | |
52 | rxd &= ~MANTIS_I2C_STOP; | |
53 | ||
df0cca17 | 54 | mmwrite(MANTIS_INT_I2CDONE, MANTIS_INT_STAT); |
41e840b1 | 55 | mmwrite(rxd, MANTIS_I2CDATA_CTL); |
3e978a82 MA |
56 | |
57 | /* wait for xfer completion */ | |
bc832fa2 | 58 | for (trials = 0; trials < TRIALS; trials++) { |
3e978a82 MA |
59 | stat = mmread(MANTIS_INT_STAT); |
60 | if (stat & MANTIS_INT_I2CDONE) | |
61 | break; | |
41e840b1 | 62 | } |
3e978a82 | 63 | |
bc832fa2 MA |
64 | dprintk(MANTIS_TMG, 0, "I2CDONE: trials=%d\n", trials); |
65 | ||
66 | /* wait for xfer completion */ | |
67 | for (trials = 0; trials < TRIALS; trials++) { | |
68 | stat = mmread(MANTIS_INT_STAT); | |
69 | if (stat & MANTIS_INT_I2CRACK) | |
70 | break; | |
bc832fa2 MA |
71 | } |
72 | ||
73 | dprintk(MANTIS_TMG, 0, "I2CRACK: trials=%d\n", trials); | |
74 | ||
41e840b1 MA |
75 | rxd = mmread(MANTIS_I2CDATA_CTL); |
76 | msg->buf[i] = (u8)((rxd >> 8) & 0xFF); | |
b3b96144 | 77 | dprintk(MANTIS_INFO, 0, "%02x ", msg->buf[i]); |
41e840b1 | 78 | } |
b3b96144 | 79 | dprintk(MANTIS_INFO, 0, "]\n"); |
41e840b1 MA |
80 | |
81 | return 0; | |
82 | } | |
83 | ||
84 | static int mantis_i2c_write(struct mantis_pci *mantis, const struct i2c_msg *msg) | |
85 | { | |
86 | int i; | |
3e978a82 | 87 | u32 txd = 0, stat, trials; |
41e840b1 | 88 | |
b3b96144 | 89 | dprintk(MANTIS_INFO, 0, " %s: Address=[0x%02x] <W>[ ", |
715d341c MA |
90 | __func__, msg->addr); |
91 | ||
41e840b1 | 92 | for (i = 0; i < msg->len; i++) { |
b3b96144 | 93 | dprintk(MANTIS_INFO, 0, "%02x ", msg->buf[i]); |
41e840b1 MA |
94 | txd = (msg->addr << 25) | (msg->buf[i] << 8) |
95 | | MANTIS_I2C_RATE_3 | |
96 | | MANTIS_I2C_STOP | |
97 | | MANTIS_I2C_PGMODE; | |
98 | ||
99 | if (i == (msg->len - 1)) | |
100 | txd &= ~MANTIS_I2C_STOP; | |
101 | ||
df0cca17 | 102 | mmwrite(MANTIS_INT_I2CDONE, MANTIS_INT_STAT); |
41e840b1 | 103 | mmwrite(txd, MANTIS_I2CDATA_CTL); |
3e978a82 MA |
104 | |
105 | /* wait for xfer completion */ | |
bc832fa2 | 106 | for (trials = 0; trials < TRIALS; trials++) { |
3e978a82 MA |
107 | stat = mmread(MANTIS_INT_STAT); |
108 | if (stat & MANTIS_INT_I2CDONE) | |
109 | break; | |
41e840b1 | 110 | } |
bc832fa2 MA |
111 | |
112 | dprintk(MANTIS_TMG, 0, "I2CDONE: trials=%d\n", trials); | |
113 | ||
114 | /* wait for xfer completion */ | |
115 | for (trials = 0; trials < TRIALS; trials++) { | |
116 | stat = mmread(MANTIS_INT_STAT); | |
117 | if (stat & MANTIS_INT_I2CRACK) | |
118 | break; | |
bc832fa2 MA |
119 | } |
120 | ||
121 | dprintk(MANTIS_TMG, 0, "I2CRACK: trials=%d\n", trials); | |
41e840b1 | 122 | } |
b3b96144 | 123 | dprintk(MANTIS_INFO, 0, "]\n"); |
41e840b1 MA |
124 | |
125 | return 0; | |
126 | } | |
127 | ||
128 | static int mantis_i2c_xfer(struct i2c_adapter *adapter, struct i2c_msg *msgs, int num) | |
129 | { | |
3e978a82 MA |
130 | int ret = 0, i = 0, trials; |
131 | u32 stat, data, txd; | |
41e840b1 | 132 | struct mantis_pci *mantis; |
3e978a82 | 133 | struct mantis_hwconfig *config; |
41e840b1 MA |
134 | |
135 | mantis = i2c_get_adapdata(adapter); | |
3e978a82 MA |
136 | BUG_ON(!mantis); |
137 | config = mantis->hwconfig; | |
138 | BUG_ON(!config); | |
139 | ||
140 | dprintk(MANTIS_DEBUG, 1, "Messages:%d", num); | |
e2f67e4f | 141 | mutex_lock(&mantis->i2c_lock); |
3e978a82 MA |
142 | |
143 | while (i < num) { | |
144 | /* Byte MODE */ | |
bc832fa2 MA |
145 | if ((config->i2c_mode & MANTIS_BYTE_MODE) && |
146 | ((i + 1) < num) && | |
147 | (msgs[i].len < 2) && | |
148 | (msgs[i + 1].len < 2) && | |
149 | (msgs[i + 1].flags & I2C_M_RD)) { | |
3e978a82 MA |
150 | |
151 | dprintk(MANTIS_DEBUG, 0, " Byte MODE:\n"); | |
152 | ||
153 | /* Read operation */ | |
154 | txd = msgs[i].addr << 25 | (0x1 << 24) | |
155 | | (msgs[i].buf[0] << 16) | |
156 | | MANTIS_I2C_RATE_3; | |
157 | ||
158 | mmwrite(txd, MANTIS_I2CDATA_CTL); | |
159 | /* wait for xfer completion */ | |
bc832fa2 | 160 | for (trials = 0; trials < TRIALS; trials++) { |
3e978a82 MA |
161 | stat = mmread(MANTIS_INT_STAT); |
162 | if (stat & MANTIS_INT_I2CDONE) | |
163 | break; | |
164 | } | |
165 | ||
166 | /* check for xfer completion */ | |
167 | if (stat & MANTIS_INT_I2CDONE) { | |
168 | /* check xfer was acknowledged */ | |
169 | if (stat & MANTIS_INT_I2CRACK) { | |
170 | data = mmread(MANTIS_I2CDATA_CTL); | |
171 | msgs[i + 1].buf[0] = (data >> 8) & 0xff; | |
172 | dprintk(MANTIS_DEBUG, 0, " Byte <%d> RXD=0x%02x [%02x]\n", 0x0, data, msgs[i + 1].buf[0]); | |
173 | } else { | |
174 | /* I/O error */ | |
175 | dprintk(MANTIS_ERROR, 1, " I/O error, LINE:%d", __LINE__); | |
176 | ret = -EIO; | |
177 | break; | |
178 | } | |
179 | } else { | |
180 | /* I/O error */ | |
181 | dprintk(MANTIS_ERROR, 1, " I/O error, LINE:%d", __LINE__); | |
182 | ret = -EIO; | |
183 | break; | |
184 | } | |
185 | i += 2; /* Write/Read operation in one go */ | |
186 | } | |
187 | ||
188 | if (i < num) { | |
189 | if (msgs[i].flags & I2C_M_RD) | |
190 | ret = mantis_i2c_read(mantis, &msgs[i]); | |
191 | else | |
192 | ret = mantis_i2c_write(mantis, &msgs[i]); | |
193 | ||
194 | i++; | |
195 | if (ret < 0) | |
196 | goto bail_out; | |
197 | } | |
198 | ||
41e840b1 | 199 | } |
3e978a82 | 200 | |
e2f67e4f | 201 | mutex_unlock(&mantis->i2c_lock); |
41e840b1 MA |
202 | |
203 | return num; | |
99d96e4e MA |
204 | |
205 | bail_out: | |
206 | mutex_unlock(&mantis->i2c_lock); | |
207 | return ret; | |
41e840b1 MA |
208 | } |
209 | ||
210 | static u32 mantis_i2c_func(struct i2c_adapter *adapter) | |
211 | { | |
212 | return I2C_FUNC_SMBUS_EMUL; | |
213 | } | |
214 | ||
e46ab9dc | 215 | static const struct i2c_algorithm mantis_algo = { |
41e840b1 MA |
216 | .master_xfer = mantis_i2c_xfer, |
217 | .functionality = mantis_i2c_func, | |
218 | }; | |
219 | ||
4c62e976 | 220 | int mantis_i2c_init(struct mantis_pci *mantis) |
41e840b1 | 221 | { |
6fe2d69c | 222 | u32 intstat; |
8154bad4 MA |
223 | struct i2c_adapter *i2c_adapter = &mantis->adapter; |
224 | struct pci_dev *pdev = mantis->pdev; | |
41e840b1 | 225 | |
b3b96144 | 226 | init_waitqueue_head(&mantis->i2c_wq); |
e2f67e4f | 227 | mutex_init(&mantis->i2c_lock); |
f5ae4f6f | 228 | strncpy(i2c_adapter->name, "Mantis I2C", sizeof(i2c_adapter->name)); |
8154bad4 MA |
229 | i2c_set_adapdata(i2c_adapter, mantis); |
230 | ||
b3b96144 | 231 | i2c_adapter->owner = THIS_MODULE; |
b3b96144 MA |
232 | i2c_adapter->algo = &mantis_algo; |
233 | i2c_adapter->algo_data = NULL; | |
b3b96144 MA |
234 | i2c_adapter->timeout = 500; |
235 | i2c_adapter->retries = 3; | |
236 | i2c_adapter->dev.parent = &pdev->dev; | |
237 | ||
8154bad4 | 238 | mantis->i2c_rc = i2c_add_adapter(i2c_adapter); |
41e840b1 MA |
239 | if (mantis->i2c_rc < 0) |
240 | return mantis->i2c_rc; | |
241 | ||
b3b96144 | 242 | dprintk(MANTIS_DEBUG, 1, "Initializing I2C .."); |
41e840b1 | 243 | |
41e840b1 | 244 | intstat = mmread(MANTIS_INT_STAT); |
6fe2d69c | 245 | mmread(MANTIS_INT_MASK); |
41e840b1 | 246 | mmwrite(intstat, MANTIS_INT_STAT); |
3e978a82 | 247 | dprintk(MANTIS_DEBUG, 1, "Disabling I2C interrupt"); |
a96762da | 248 | mantis_mask_ints(mantis, MANTIS_INT_I2CDONE); |
41e840b1 MA |
249 | |
250 | return 0; | |
251 | } | |
b3b96144 | 252 | EXPORT_SYMBOL_GPL(mantis_i2c_init); |
41e840b1 | 253 | |
4cf0b3f1 | 254 | int mantis_i2c_exit(struct mantis_pci *mantis) |
41e840b1 | 255 | { |
3e978a82 | 256 | dprintk(MANTIS_DEBUG, 1, "Disabling I2C interrupt"); |
a96762da | 257 | mantis_mask_ints(mantis, MANTIS_INT_I2CDONE); |
3e978a82 | 258 | |
b3b96144 | 259 | dprintk(MANTIS_DEBUG, 1, "Removing I2C adapter"); |
bf51a8c5 LPC |
260 | i2c_del_adapter(&mantis->adapter); |
261 | ||
262 | return 0; | |
41e840b1 | 263 | } |
b3b96144 | 264 | EXPORT_SYMBOL_GPL(mantis_i2c_exit); |