]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * | |
3 | * smapi.c -- SMAPI interface routines | |
4 | * | |
5 | * | |
6 | * Written By: Mike Sullivan IBM Corporation | |
7 | * | |
8 | * Copyright (C) 1999 IBM Corporation | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License as published by | |
12 | * the Free Software Foundation; either version 2 of the License, or | |
13 | * (at your option) any later version. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, | |
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
18 | * GNU General Public License for more details. | |
19 | * | |
20 | * NO WARRANTY | |
21 | * THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR | |
22 | * CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT | |
23 | * LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT, | |
24 | * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is | |
25 | * solely responsible for determining the appropriateness of using and | |
26 | * distributing the Program and assumes all risks associated with its | |
27 | * exercise of rights under this Agreement, including but not limited to | |
28 | * the risks and costs of program errors, damage to or loss of data, | |
29 | * programs or equipment, and unavailability or interruption of operations. | |
30 | * | |
31 | * DISCLAIMER OF LIABILITY | |
32 | * NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY | |
33 | * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL | |
34 | * DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND | |
35 | * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR | |
36 | * TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE | |
37 | * USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED | |
38 | * HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES | |
39 | * | |
40 | * You should have received a copy of the GNU General Public License | |
41 | * along with this program; if not, write to the Free Software | |
42 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
43 | * | |
44 | * | |
45 | * 10/23/2000 - Alpha Release | |
46 | * First release to the public | |
47 | */ | |
48 | ||
49 | #include <linux/kernel.h> | |
50 | #include <linux/mc146818rtc.h> /* CMOS defines */ | |
51 | #include "smapi.h" | |
52 | #include "mwavedd.h" | |
53 | ||
54 | static unsigned short g_usSmapiPort = 0; | |
55 | ||
56 | ||
57 | static int smapi_request(unsigned short inBX, unsigned short inCX, | |
58 | unsigned short inDI, unsigned short inSI, | |
59 | unsigned short *outAX, unsigned short *outBX, | |
60 | unsigned short *outCX, unsigned short *outDX, | |
61 | unsigned short *outDI, unsigned short *outSI) | |
62 | { | |
63 | unsigned short myoutAX = 2, *pmyoutAX = &myoutAX; | |
64 | unsigned short myoutBX = 3, *pmyoutBX = &myoutBX; | |
65 | unsigned short myoutCX = 4, *pmyoutCX = &myoutCX; | |
66 | unsigned short myoutDX = 5, *pmyoutDX = &myoutDX; | |
67 | unsigned short myoutDI = 6, *pmyoutDI = &myoutDI; | |
68 | unsigned short myoutSI = 7, *pmyoutSI = &myoutSI; | |
69 | unsigned short usSmapiOK = -EIO, *pusSmapiOK = &usSmapiOK; | |
70 | unsigned int inBXCX = (inBX << 16) | inCX; | |
71 | unsigned int inDISI = (inDI << 16) | inSI; | |
72 | int retval = 0; | |
73 | ||
74 | PRINTK_5(TRACE_SMAPI, "inBX %x inCX %x inDI %x inSI %x\n", | |
75 | inBX, inCX, inDI, inSI); | |
76 | ||
77 | __asm__ __volatile__("movw $0x5380,%%ax\n\t" | |
78 | "movl %7,%%ebx\n\t" | |
79 | "shrl $16, %%ebx\n\t" | |
80 | "movw %7,%%cx\n\t" | |
81 | "movl %8,%%edi\n\t" | |
82 | "shrl $16,%%edi\n\t" | |
83 | "movw %8,%%si\n\t" | |
84 | "movw %9,%%dx\n\t" | |
85 | "out %%al,%%dx\n\t" | |
86 | "out %%al,$0x4F\n\t" | |
87 | "cmpb $0x53,%%ah\n\t" | |
88 | "je 2f\n\t" | |
89 | "1:\n\t" | |
90 | "orb %%ah,%%ah\n\t" | |
91 | "jnz 2f\n\t" | |
92 | "movw %%ax,%0\n\t" | |
93 | "movw %%bx,%1\n\t" | |
94 | "movw %%cx,%2\n\t" | |
95 | "movw %%dx,%3\n\t" | |
96 | "movw %%di,%4\n\t" | |
97 | "movw %%si,%5\n\t" | |
98 | "movw $1,%6\n\t" | |
99 | "2:\n\t":"=m"(*(unsigned short *) pmyoutAX), | |
100 | "=m"(*(unsigned short *) pmyoutBX), | |
101 | "=m"(*(unsigned short *) pmyoutCX), | |
102 | "=m"(*(unsigned short *) pmyoutDX), | |
103 | "=m"(*(unsigned short *) pmyoutDI), | |
104 | "=m"(*(unsigned short *) pmyoutSI), | |
105 | "=m"(*(unsigned short *) pusSmapiOK) | |
106 | :"m"(inBXCX), "m"(inDISI), "m"(g_usSmapiPort) | |
107 | :"%eax", "%ebx", "%ecx", "%edx", "%edi", | |
108 | "%esi"); | |
109 | ||
110 | PRINTK_8(TRACE_SMAPI, | |
111 | "myoutAX %x myoutBX %x myoutCX %x myoutDX %x myoutDI %x myoutSI %x usSmapiOK %x\n", | |
112 | myoutAX, myoutBX, myoutCX, myoutDX, myoutDI, myoutSI, | |
113 | usSmapiOK); | |
114 | *outAX = myoutAX; | |
115 | *outBX = myoutBX; | |
116 | *outCX = myoutCX; | |
117 | *outDX = myoutDX; | |
118 | *outDI = myoutDI; | |
119 | *outSI = myoutSI; | |
120 | ||
121 | retval = (usSmapiOK == 1) ? 0 : -EIO; | |
122 | PRINTK_2(TRACE_SMAPI, "smapi::smapi_request exit retval %x\n", retval); | |
123 | return retval; | |
124 | } | |
125 | ||
126 | ||
127 | int smapi_query_DSP_cfg(SMAPI_DSP_SETTINGS * pSettings) | |
128 | { | |
129 | int bRC = -EIO; | |
130 | unsigned short usAX, usBX, usCX, usDX, usDI, usSI; | |
131 | unsigned short ausDspBases[] = { 0x0030, 0x4E30, 0x8E30, 0xCE30, 0x0130, 0x0350, 0x0070, 0x0DB0 }; | |
132 | unsigned short ausUartBases[] = { 0x03F8, 0x02F8, 0x03E8, 0x02E8 }; | |
133 | unsigned short numDspBases = 8; | |
134 | unsigned short numUartBases = 4; | |
135 | ||
136 | PRINTK_1(TRACE_SMAPI, "smapi::smapi_query_DSP_cfg entry\n"); | |
137 | ||
138 | bRC = smapi_request(0x1802, 0x0000, 0, 0, | |
139 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
140 | if (bRC) { | |
141 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_query_DSP_cfg: Error: Could not get DSP Settings. Aborting.\n"); | |
142 | return bRC; | |
143 | } | |
144 | ||
145 | PRINTK_1(TRACE_SMAPI, "smapi::smapi_query_DSP_cfg, smapi_request OK\n"); | |
146 | ||
147 | pSettings->bDSPPresent = ((usBX & 0x0100) != 0); | |
148 | pSettings->bDSPEnabled = ((usCX & 0x0001) != 0); | |
149 | pSettings->usDspIRQ = usSI & 0x00FF; | |
150 | pSettings->usDspDMA = (usSI & 0xFF00) >> 8; | |
151 | if ((usDI & 0x00FF) < numDspBases) { | |
152 | pSettings->usDspBaseIO = ausDspBases[usDI & 0x00FF]; | |
153 | } else { | |
154 | pSettings->usDspBaseIO = 0; | |
155 | } | |
156 | PRINTK_6(TRACE_SMAPI, | |
157 | "smapi::smapi_query_DSP_cfg get DSP Settings bDSPPresent %x bDSPEnabled %x usDspIRQ %x usDspDMA %x usDspBaseIO %x\n", | |
158 | pSettings->bDSPPresent, pSettings->bDSPEnabled, | |
159 | pSettings->usDspIRQ, pSettings->usDspDMA, | |
160 | pSettings->usDspBaseIO); | |
161 | ||
162 | /* check for illegal values */ | |
163 | if ( pSettings->usDspBaseIO == 0 ) | |
164 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_query_DSP_cfg: Worry: DSP base I/O address is 0\n"); | |
165 | if ( pSettings->usDspIRQ == 0 ) | |
166 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_query_DSP_cfg: Worry: DSP IRQ line is 0\n"); | |
167 | ||
168 | bRC = smapi_request(0x1804, 0x0000, 0, 0, | |
169 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
170 | if (bRC) { | |
171 | PRINTK_ERROR("smapi::smapi_query_DSP_cfg: Error: Could not get DSP modem settings. Aborting.\n"); | |
172 | return bRC; | |
173 | } | |
174 | ||
175 | PRINTK_1(TRACE_SMAPI, "smapi::smapi_query_DSP_cfg, smapi_request OK\n"); | |
176 | ||
177 | pSettings->bModemEnabled = ((usCX & 0x0001) != 0); | |
178 | pSettings->usUartIRQ = usSI & 0x000F; | |
179 | if (((usSI & 0xFF00) >> 8) < numUartBases) { | |
180 | pSettings->usUartBaseIO = ausUartBases[(usSI & 0xFF00) >> 8]; | |
181 | } else { | |
182 | pSettings->usUartBaseIO = 0; | |
183 | } | |
184 | ||
185 | PRINTK_4(TRACE_SMAPI, | |
186 | "smapi::smapi_query_DSP_cfg get DSP modem settings bModemEnabled %x usUartIRQ %x usUartBaseIO %x\n", | |
187 | pSettings->bModemEnabled, | |
188 | pSettings->usUartIRQ, | |
189 | pSettings->usUartBaseIO); | |
190 | ||
191 | /* check for illegal values */ | |
192 | if ( pSettings->usUartBaseIO == 0 ) | |
193 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_query_DSP_cfg: Worry: UART base I/O address is 0\n"); | |
194 | if ( pSettings->usUartIRQ == 0 ) | |
195 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_query_DSP_cfg: Worry: UART IRQ line is 0\n"); | |
196 | ||
197 | PRINTK_2(TRACE_SMAPI, "smapi::smapi_query_DSP_cfg exit bRC %x\n", bRC); | |
198 | ||
199 | return bRC; | |
200 | } | |
201 | ||
202 | ||
203 | int smapi_set_DSP_cfg(void) | |
204 | { | |
205 | int bRC = -EIO; | |
206 | int i; | |
207 | unsigned short usAX, usBX, usCX, usDX, usDI, usSI; | |
208 | unsigned short ausDspBases[] = { 0x0030, 0x4E30, 0x8E30, 0xCE30, 0x0130, 0x0350, 0x0070, 0x0DB0 }; | |
209 | unsigned short ausUartBases[] = { 0x03F8, 0x02F8, 0x03E8, 0x02E8 }; | |
210 | unsigned short ausDspIrqs[] = { 5, 7, 10, 11, 15 }; | |
211 | unsigned short ausUartIrqs[] = { 3, 4 }; | |
212 | ||
213 | unsigned short numDspBases = 8; | |
214 | unsigned short numUartBases = 4; | |
215 | unsigned short numDspIrqs = 5; | |
216 | unsigned short numUartIrqs = 2; | |
217 | unsigned short dspio_index = 0, uartio_index = 0; | |
218 | ||
219 | PRINTK_5(TRACE_SMAPI, | |
220 | "smapi::smapi_set_DSP_cfg entry mwave_3780i_irq %x mwave_3780i_io %x mwave_uart_irq %x mwave_uart_io %x\n", | |
221 | mwave_3780i_irq, mwave_3780i_io, mwave_uart_irq, mwave_uart_io); | |
222 | ||
223 | if (mwave_3780i_io) { | |
224 | for (i = 0; i < numDspBases; i++) { | |
225 | if (mwave_3780i_io == ausDspBases[i]) | |
226 | break; | |
227 | } | |
228 | if (i == numDspBases) { | |
229 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_set_DSP_cfg: Error: Invalid mwave_3780i_io address %x. Aborting.\n", mwave_3780i_io); | |
230 | return bRC; | |
231 | } | |
232 | dspio_index = i; | |
233 | } | |
234 | ||
235 | if (mwave_3780i_irq) { | |
236 | for (i = 0; i < numDspIrqs; i++) { | |
237 | if (mwave_3780i_irq == ausDspIrqs[i]) | |
238 | break; | |
239 | } | |
240 | if (i == numDspIrqs) { | |
241 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_set_DSP_cfg: Error: Invalid mwave_3780i_irq %x. Aborting.\n", mwave_3780i_irq); | |
242 | return bRC; | |
243 | } | |
244 | } | |
245 | ||
246 | if (mwave_uart_io) { | |
247 | for (i = 0; i < numUartBases; i++) { | |
248 | if (mwave_uart_io == ausUartBases[i]) | |
249 | break; | |
250 | } | |
251 | if (i == numUartBases) { | |
252 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_set_DSP_cfg: Error: Invalid mwave_uart_io address %x. Aborting.\n", mwave_uart_io); | |
253 | return bRC; | |
254 | } | |
255 | uartio_index = i; | |
256 | } | |
257 | ||
258 | ||
259 | if (mwave_uart_irq) { | |
260 | for (i = 0; i < numUartIrqs; i++) { | |
261 | if (mwave_uart_irq == ausUartIrqs[i]) | |
262 | break; | |
263 | } | |
264 | if (i == numUartIrqs) { | |
265 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_set_DSP_cfg: Error: Invalid mwave_uart_irq %x. Aborting.\n", mwave_uart_irq); | |
266 | return bRC; | |
267 | } | |
268 | } | |
269 | ||
270 | if (mwave_uart_irq || mwave_uart_io) { | |
271 | ||
272 | /* Check serial port A */ | |
273 | bRC = smapi_request(0x1402, 0x0000, 0, 0, | |
274 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
275 | if (bRC) goto exit_smapi_request_error; | |
276 | /* bRC == 0 */ | |
277 | if (usBX & 0x0100) { /* serial port A is present */ | |
278 | if (usCX & 1) { /* serial port is enabled */ | |
279 | if ((usSI & 0xFF) == mwave_uart_irq) { | |
280 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
281 | PRINTK_ERROR(KERN_ERR_MWAVE | |
282 | "smapi::smapi_set_DSP_cfg: Serial port A irq %x conflicts with mwave_uart_irq %x\n", usSI & 0xFF, mwave_uart_irq); | |
283 | #else | |
284 | PRINTK_3(TRACE_SMAPI, | |
285 | "smapi::smapi_set_DSP_cfg: Serial port A irq %x conflicts with mwave_uart_irq %x\n", usSI & 0xFF, mwave_uart_irq); | |
286 | #endif | |
287 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
288 | PRINTK_1(TRACE_SMAPI, | |
289 | "smapi::smapi_set_DSP_cfg Disabling conflicting serial port\n"); | |
290 | bRC = smapi_request(0x1403, 0x0100, 0, usSI, | |
291 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
292 | if (bRC) goto exit_smapi_request_error; | |
293 | bRC = smapi_request(0x1402, 0x0000, 0, 0, | |
294 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
295 | if (bRC) goto exit_smapi_request_error; | |
296 | #else | |
297 | goto exit_conflict; | |
298 | #endif | |
299 | } else { | |
300 | if ((usSI >> 8) == uartio_index) { | |
301 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
302 | PRINTK_ERROR(KERN_ERR_MWAVE | |
303 | "smapi::smapi_set_DSP_cfg: Serial port A base I/O address %x conflicts with mwave uart I/O %x\n", ausUartBases[usSI >> 8], ausUartBases[uartio_index]); | |
304 | #else | |
305 | PRINTK_3(TRACE_SMAPI, | |
306 | "smapi::smapi_set_DSP_cfg: Serial port A base I/O address %x conflicts with mwave uart I/O %x\n", ausUartBases[usSI >> 8], ausUartBases[uartio_index]); | |
307 | #endif | |
308 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
309 | PRINTK_1(TRACE_SMAPI, | |
310 | "smapi::smapi_set_DSP_cfg Disabling conflicting serial port A\n"); | |
311 | bRC = smapi_request (0x1403, 0x0100, 0, usSI, | |
312 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
313 | if (bRC) goto exit_smapi_request_error; | |
314 | bRC = smapi_request (0x1402, 0x0000, 0, 0, | |
315 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
316 | if (bRC) goto exit_smapi_request_error; | |
317 | #else | |
318 | goto exit_conflict; | |
319 | #endif | |
320 | } | |
321 | } | |
322 | } | |
323 | } | |
324 | ||
325 | /* Check serial port B */ | |
326 | bRC = smapi_request(0x1404, 0x0000, 0, 0, | |
327 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
328 | if (bRC) goto exit_smapi_request_error; | |
329 | /* bRC == 0 */ | |
330 | if (usBX & 0x0100) { /* serial port B is present */ | |
331 | if (usCX & 1) { /* serial port is enabled */ | |
332 | if ((usSI & 0xFF) == mwave_uart_irq) { | |
333 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
334 | PRINTK_ERROR(KERN_ERR_MWAVE | |
335 | "smapi::smapi_set_DSP_cfg: Serial port B irq %x conflicts with mwave_uart_irq %x\n", usSI & 0xFF, mwave_uart_irq); | |
336 | #else | |
337 | PRINTK_3(TRACE_SMAPI, | |
338 | "smapi::smapi_set_DSP_cfg: Serial port B irq %x conflicts with mwave_uart_irq %x\n", usSI & 0xFF, mwave_uart_irq); | |
339 | #endif | |
340 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
341 | PRINTK_1(TRACE_SMAPI, | |
342 | "smapi::smapi_set_DSP_cfg Disabling conflicting serial port B\n"); | |
343 | bRC = smapi_request(0x1405, 0x0100, 0, usSI, | |
344 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
345 | if (bRC) goto exit_smapi_request_error; | |
346 | bRC = smapi_request(0x1404, 0x0000, 0, 0, | |
347 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
348 | if (bRC) goto exit_smapi_request_error; | |
349 | #else | |
350 | goto exit_conflict; | |
351 | #endif | |
352 | } else { | |
353 | if ((usSI >> 8) == uartio_index) { | |
354 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
355 | PRINTK_ERROR(KERN_ERR_MWAVE | |
356 | "smapi::smapi_set_DSP_cfg: Serial port B base I/O address %x conflicts with mwave uart I/O %x\n", ausUartBases[usSI >> 8], ausUartBases[uartio_index]); | |
357 | #else | |
358 | PRINTK_3(TRACE_SMAPI, | |
359 | "smapi::smapi_set_DSP_cfg: Serial port B base I/O address %x conflicts with mwave uart I/O %x\n", ausUartBases[usSI >> 8], ausUartBases[uartio_index]); | |
360 | #endif | |
361 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
362 | PRINTK_1 (TRACE_SMAPI, | |
363 | "smapi::smapi_set_DSP_cfg Disabling conflicting serial port B\n"); | |
364 | bRC = smapi_request (0x1405, 0x0100, 0, usSI, | |
365 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
366 | if (bRC) goto exit_smapi_request_error; | |
367 | bRC = smapi_request (0x1404, 0x0000, 0, 0, | |
368 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
369 | if (bRC) goto exit_smapi_request_error; | |
370 | #else | |
371 | goto exit_conflict; | |
372 | #endif | |
373 | } | |
374 | } | |
375 | } | |
376 | } | |
377 | ||
378 | /* Check IR port */ | |
379 | bRC = smapi_request(0x1700, 0x0000, 0, 0, | |
380 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
381 | if (bRC) goto exit_smapi_request_error; | |
382 | bRC = smapi_request(0x1704, 0x0000, 0, 0, | |
383 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
384 | if (bRC) goto exit_smapi_request_error; | |
385 | /* bRC == 0 */ | |
386 | if ((usCX & 0xff) != 0xff) { /* IR port not disabled */ | |
387 | if ((usCX & 0xff) == mwave_uart_irq) { | |
388 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
389 | PRINTK_ERROR(KERN_ERR_MWAVE | |
390 | "smapi::smapi_set_DSP_cfg: IR port irq %x conflicts with mwave_uart_irq %x\n", usCX & 0xff, mwave_uart_irq); | |
391 | #else | |
392 | PRINTK_3(TRACE_SMAPI, | |
393 | "smapi::smapi_set_DSP_cfg: IR port irq %x conflicts with mwave_uart_irq %x\n", usCX & 0xff, mwave_uart_irq); | |
394 | #endif | |
395 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
396 | PRINTK_1(TRACE_SMAPI, | |
397 | "smapi::smapi_set_DSP_cfg Disabling conflicting IR port\n"); | |
398 | bRC = smapi_request(0x1701, 0x0100, 0, 0, | |
399 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
400 | if (bRC) goto exit_smapi_request_error; | |
401 | bRC = smapi_request(0x1700, 0, 0, 0, | |
402 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
403 | if (bRC) goto exit_smapi_request_error; | |
404 | bRC = smapi_request(0x1705, 0x01ff, 0, usSI, | |
405 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
406 | if (bRC) goto exit_smapi_request_error; | |
407 | bRC = smapi_request(0x1704, 0x0000, 0, 0, | |
408 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
409 | if (bRC) goto exit_smapi_request_error; | |
410 | #else | |
411 | goto exit_conflict; | |
412 | #endif | |
413 | } else { | |
414 | if ((usSI & 0xff) == uartio_index) { | |
415 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
416 | PRINTK_ERROR(KERN_ERR_MWAVE | |
417 | "smapi::smapi_set_DSP_cfg: IR port base I/O address %x conflicts with mwave uart I/O %x\n", ausUartBases[usSI & 0xff], ausUartBases[uartio_index]); | |
418 | #else | |
419 | PRINTK_3(TRACE_SMAPI, | |
420 | "smapi::smapi_set_DSP_cfg: IR port base I/O address %x conflicts with mwave uart I/O %x\n", ausUartBases[usSI & 0xff], ausUartBases[uartio_index]); | |
421 | #endif | |
422 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
423 | PRINTK_1(TRACE_SMAPI, | |
424 | "smapi::smapi_set_DSP_cfg Disabling conflicting IR port\n"); | |
425 | bRC = smapi_request(0x1701, 0x0100, 0, 0, | |
426 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
427 | if (bRC) goto exit_smapi_request_error; | |
428 | bRC = smapi_request(0x1700, 0, 0, 0, | |
429 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
430 | if (bRC) goto exit_smapi_request_error; | |
431 | bRC = smapi_request(0x1705, 0x01ff, 0, usSI, | |
432 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
433 | if (bRC) goto exit_smapi_request_error; | |
434 | bRC = smapi_request(0x1704, 0x0000, 0, 0, | |
435 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
436 | if (bRC) goto exit_smapi_request_error; | |
437 | #else | |
438 | goto exit_conflict; | |
439 | #endif | |
440 | } | |
441 | } | |
442 | } | |
443 | } | |
444 | ||
445 | bRC = smapi_request(0x1802, 0x0000, 0, 0, | |
446 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
447 | if (bRC) goto exit_smapi_request_error; | |
448 | ||
449 | if (mwave_3780i_io) { | |
450 | usDI = dspio_index; | |
451 | } | |
452 | if (mwave_3780i_irq) { | |
453 | usSI = (usSI & 0xff00) | mwave_3780i_irq; | |
454 | } | |
455 | ||
456 | bRC = smapi_request(0x1803, 0x0101, usDI, usSI, | |
457 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
458 | if (bRC) goto exit_smapi_request_error; | |
459 | ||
460 | bRC = smapi_request(0x1804, 0x0000, 0, 0, | |
461 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
462 | if (bRC) goto exit_smapi_request_error; | |
463 | ||
464 | if (mwave_uart_io) { | |
465 | usSI = (usSI & 0x00ff) | (uartio_index << 8); | |
466 | } | |
467 | if (mwave_uart_irq) { | |
468 | usSI = (usSI & 0xff00) | mwave_uart_irq; | |
469 | } | |
470 | bRC = smapi_request(0x1805, 0x0101, 0, usSI, | |
471 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
472 | if (bRC) goto exit_smapi_request_error; | |
473 | ||
474 | bRC = smapi_request(0x1802, 0x0000, 0, 0, | |
475 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
476 | if (bRC) goto exit_smapi_request_error; | |
477 | ||
478 | bRC = smapi_request(0x1804, 0x0000, 0, 0, | |
479 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
480 | if (bRC) goto exit_smapi_request_error; | |
481 | ||
482 | /* normal exit: */ | |
483 | PRINTK_1(TRACE_SMAPI, "smapi::smapi_set_DSP_cfg exit\n"); | |
484 | return 0; | |
485 | ||
486 | exit_conflict: | |
487 | /* Message has already been printed */ | |
488 | return -EIO; | |
489 | ||
490 | exit_smapi_request_error: | |
491 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_set_DSP_cfg exit on smapi_request error bRC %x\n", bRC); | |
492 | return bRC; | |
493 | } | |
494 | ||
495 | ||
496 | int smapi_set_DSP_power_state(BOOLEAN bOn) | |
497 | { | |
498 | int bRC = -EIO; | |
499 | unsigned short usAX, usBX, usCX, usDX, usDI, usSI; | |
500 | unsigned short usPowerFunction; | |
501 | ||
502 | PRINTK_2(TRACE_SMAPI, "smapi::smapi_set_DSP_power_state entry bOn %x\n", bOn); | |
503 | ||
504 | usPowerFunction = (bOn) ? 1 : 0; | |
505 | ||
506 | bRC = smapi_request(0x4901, 0x0000, 0, usPowerFunction, | |
507 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
508 | ||
509 | PRINTK_2(TRACE_SMAPI, "smapi::smapi_set_DSP_power_state exit bRC %x\n", bRC); | |
510 | ||
511 | return bRC; | |
512 | } | |
513 | ||
514 | #if 0 | |
515 | static int SmapiQuerySystemID(void) | |
516 | { | |
517 | int bRC = -EIO; | |
518 | unsigned short usAX = 0xffff, usBX = 0xffff, usCX = 0xffff, | |
519 | usDX = 0xffff, usDI = 0xffff, usSI = 0xffff; | |
520 | ||
521 | printk("smapi::SmapiQUerySystemID entry\n"); | |
522 | bRC = smapi_request(0x0000, 0, 0, 0, | |
523 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
524 | ||
525 | if (bRC == 0) { | |
526 | printk("AX=%x, BX=%x, CX=%x, DX=%x, DI=%x, SI=%x\n", | |
527 | usAX, usBX, usCX, usDX, usDI, usSI); | |
528 | } else { | |
529 | printk("smapi::SmapiQuerySystemID smapi_request error\n"); | |
530 | } | |
531 | ||
532 | return bRC; | |
533 | } | |
534 | #endif /* 0 */ | |
535 | ||
536 | int smapi_init(void) | |
537 | { | |
538 | int retval = -EIO; | |
539 | unsigned short usSmapiID = 0; | |
540 | unsigned long flags; | |
541 | ||
542 | PRINTK_1(TRACE_SMAPI, "smapi::smapi_init entry\n"); | |
543 | ||
544 | spin_lock_irqsave(&rtc_lock, flags); | |
545 | usSmapiID = CMOS_READ(0x7C); | |
546 | usSmapiID |= (CMOS_READ(0x7D) << 8); | |
547 | spin_unlock_irqrestore(&rtc_lock, flags); | |
548 | PRINTK_2(TRACE_SMAPI, "smapi::smapi_init usSmapiID %x\n", usSmapiID); | |
549 | ||
550 | if (usSmapiID == 0x5349) { | |
551 | spin_lock_irqsave(&rtc_lock, flags); | |
552 | g_usSmapiPort = CMOS_READ(0x7E); | |
553 | g_usSmapiPort |= (CMOS_READ(0x7F) << 8); | |
554 | spin_unlock_irqrestore(&rtc_lock, flags); | |
555 | if (g_usSmapiPort == 0) { | |
556 | PRINTK_ERROR("smapi::smapi_init, ERROR unable to read from SMAPI port\n"); | |
557 | } else { | |
558 | PRINTK_2(TRACE_SMAPI, | |
559 | "smapi::smapi_init, exit TRUE g_usSmapiPort %x\n", | |
560 | g_usSmapiPort); | |
561 | retval = 0; | |
562 | //SmapiQuerySystemID(); | |
563 | } | |
564 | } else { | |
565 | PRINTK_ERROR("smapi::smapi_init, ERROR invalid usSmapiID\n"); | |
566 | retval = -ENXIO; | |
567 | } | |
568 | ||
569 | return retval; | |
570 | } |