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; | |
caa97be1 CIK |
131 | static const unsigned short ausDspBases[] = { |
132 | 0x0030, 0x4E30, 0x8E30, 0xCE30, | |
133 | 0x0130, 0x0350, 0x0070, 0x0DB0 }; | |
134 | static const unsigned short ausUartBases[] = { | |
135 | 0x03F8, 0x02F8, 0x03E8, 0x02E8 }; | |
1da177e4 LT |
136 | |
137 | PRINTK_1(TRACE_SMAPI, "smapi::smapi_query_DSP_cfg entry\n"); | |
138 | ||
139 | bRC = smapi_request(0x1802, 0x0000, 0, 0, | |
140 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
141 | if (bRC) { | |
142 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_query_DSP_cfg: Error: Could not get DSP Settings. Aborting.\n"); | |
143 | return bRC; | |
144 | } | |
145 | ||
146 | PRINTK_1(TRACE_SMAPI, "smapi::smapi_query_DSP_cfg, smapi_request OK\n"); | |
147 | ||
148 | pSettings->bDSPPresent = ((usBX & 0x0100) != 0); | |
149 | pSettings->bDSPEnabled = ((usCX & 0x0001) != 0); | |
150 | pSettings->usDspIRQ = usSI & 0x00FF; | |
151 | pSettings->usDspDMA = (usSI & 0xFF00) >> 8; | |
caa97be1 | 152 | if ((usDI & 0x00FF) < ARRAY_SIZE(ausDspBases)) { |
1da177e4 LT |
153 | pSettings->usDspBaseIO = ausDspBases[usDI & 0x00FF]; |
154 | } else { | |
155 | pSettings->usDspBaseIO = 0; | |
156 | } | |
157 | PRINTK_6(TRACE_SMAPI, | |
158 | "smapi::smapi_query_DSP_cfg get DSP Settings bDSPPresent %x bDSPEnabled %x usDspIRQ %x usDspDMA %x usDspBaseIO %x\n", | |
159 | pSettings->bDSPPresent, pSettings->bDSPEnabled, | |
160 | pSettings->usDspIRQ, pSettings->usDspDMA, | |
161 | pSettings->usDspBaseIO); | |
162 | ||
163 | /* check for illegal values */ | |
164 | if ( pSettings->usDspBaseIO == 0 ) | |
165 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_query_DSP_cfg: Worry: DSP base I/O address is 0\n"); | |
166 | if ( pSettings->usDspIRQ == 0 ) | |
167 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_query_DSP_cfg: Worry: DSP IRQ line is 0\n"); | |
168 | ||
169 | bRC = smapi_request(0x1804, 0x0000, 0, 0, | |
170 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
171 | if (bRC) { | |
172 | PRINTK_ERROR("smapi::smapi_query_DSP_cfg: Error: Could not get DSP modem settings. Aborting.\n"); | |
173 | return bRC; | |
174 | } | |
175 | ||
176 | PRINTK_1(TRACE_SMAPI, "smapi::smapi_query_DSP_cfg, smapi_request OK\n"); | |
177 | ||
178 | pSettings->bModemEnabled = ((usCX & 0x0001) != 0); | |
179 | pSettings->usUartIRQ = usSI & 0x000F; | |
caa97be1 | 180 | if (((usSI & 0xFF00) >> 8) < ARRAY_SIZE(ausUartBases)) { |
1da177e4 LT |
181 | pSettings->usUartBaseIO = ausUartBases[(usSI & 0xFF00) >> 8]; |
182 | } else { | |
183 | pSettings->usUartBaseIO = 0; | |
184 | } | |
185 | ||
186 | PRINTK_4(TRACE_SMAPI, | |
187 | "smapi::smapi_query_DSP_cfg get DSP modem settings bModemEnabled %x usUartIRQ %x usUartBaseIO %x\n", | |
188 | pSettings->bModemEnabled, | |
189 | pSettings->usUartIRQ, | |
190 | pSettings->usUartBaseIO); | |
191 | ||
192 | /* check for illegal values */ | |
193 | if ( pSettings->usUartBaseIO == 0 ) | |
194 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_query_DSP_cfg: Worry: UART base I/O address is 0\n"); | |
195 | if ( pSettings->usUartIRQ == 0 ) | |
196 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_query_DSP_cfg: Worry: UART IRQ line is 0\n"); | |
197 | ||
198 | PRINTK_2(TRACE_SMAPI, "smapi::smapi_query_DSP_cfg exit bRC %x\n", bRC); | |
199 | ||
200 | return bRC; | |
201 | } | |
202 | ||
203 | ||
204 | int smapi_set_DSP_cfg(void) | |
205 | { | |
206 | int bRC = -EIO; | |
207 | int i; | |
208 | unsigned short usAX, usBX, usCX, usDX, usDI, usSI; | |
caa97be1 CIK |
209 | static const unsigned short ausDspBases[] = { |
210 | 0x0030, 0x4E30, 0x8E30, 0xCE30, | |
211 | 0x0130, 0x0350, 0x0070, 0x0DB0 }; | |
212 | static const unsigned short ausUartBases[] = { | |
213 | 0x03F8, 0x02F8, 0x03E8, 0x02E8 }; | |
214 | static const unsigned short ausDspIrqs[] = { | |
215 | 5, 7, 10, 11, 15 }; | |
216 | static const unsigned short ausUartIrqs[] = { | |
217 | 3, 4 }; | |
1da177e4 | 218 | |
1da177e4 LT |
219 | unsigned short dspio_index = 0, uartio_index = 0; |
220 | ||
221 | PRINTK_5(TRACE_SMAPI, | |
222 | "smapi::smapi_set_DSP_cfg entry mwave_3780i_irq %x mwave_3780i_io %x mwave_uart_irq %x mwave_uart_io %x\n", | |
223 | mwave_3780i_irq, mwave_3780i_io, mwave_uart_irq, mwave_uart_io); | |
224 | ||
225 | if (mwave_3780i_io) { | |
caa97be1 | 226 | for (i = 0; i < ARRAY_SIZE(ausDspBases); i++) { |
1da177e4 LT |
227 | if (mwave_3780i_io == ausDspBases[i]) |
228 | break; | |
229 | } | |
caa97be1 | 230 | if (i == ARRAY_SIZE(ausDspBases)) { |
1da177e4 LT |
231 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_set_DSP_cfg: Error: Invalid mwave_3780i_io address %x. Aborting.\n", mwave_3780i_io); |
232 | return bRC; | |
233 | } | |
234 | dspio_index = i; | |
235 | } | |
236 | ||
237 | if (mwave_3780i_irq) { | |
caa97be1 | 238 | for (i = 0; i < ARRAY_SIZE(ausDspIrqs); i++) { |
1da177e4 LT |
239 | if (mwave_3780i_irq == ausDspIrqs[i]) |
240 | break; | |
241 | } | |
caa97be1 | 242 | if (i == ARRAY_SIZE(ausDspIrqs)) { |
1da177e4 LT |
243 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_set_DSP_cfg: Error: Invalid mwave_3780i_irq %x. Aborting.\n", mwave_3780i_irq); |
244 | return bRC; | |
245 | } | |
246 | } | |
247 | ||
248 | if (mwave_uart_io) { | |
caa97be1 | 249 | for (i = 0; i < ARRAY_SIZE(ausUartBases); i++) { |
1da177e4 LT |
250 | if (mwave_uart_io == ausUartBases[i]) |
251 | break; | |
252 | } | |
caa97be1 | 253 | if (i == ARRAY_SIZE(ausUartBases)) { |
1da177e4 LT |
254 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_set_DSP_cfg: Error: Invalid mwave_uart_io address %x. Aborting.\n", mwave_uart_io); |
255 | return bRC; | |
256 | } | |
257 | uartio_index = i; | |
258 | } | |
259 | ||
260 | ||
261 | if (mwave_uart_irq) { | |
caa97be1 | 262 | for (i = 0; i < ARRAY_SIZE(ausUartIrqs); i++) { |
1da177e4 LT |
263 | if (mwave_uart_irq == ausUartIrqs[i]) |
264 | break; | |
265 | } | |
caa97be1 | 266 | if (i == ARRAY_SIZE(ausUartIrqs)) { |
1da177e4 LT |
267 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_set_DSP_cfg: Error: Invalid mwave_uart_irq %x. Aborting.\n", mwave_uart_irq); |
268 | return bRC; | |
269 | } | |
270 | } | |
271 | ||
272 | if (mwave_uart_irq || mwave_uart_io) { | |
273 | ||
274 | /* Check serial port A */ | |
275 | bRC = smapi_request(0x1402, 0x0000, 0, 0, | |
276 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
277 | if (bRC) goto exit_smapi_request_error; | |
278 | /* bRC == 0 */ | |
279 | if (usBX & 0x0100) { /* serial port A is present */ | |
280 | if (usCX & 1) { /* serial port is enabled */ | |
281 | if ((usSI & 0xFF) == mwave_uart_irq) { | |
282 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
283 | PRINTK_ERROR(KERN_ERR_MWAVE | |
284 | "smapi::smapi_set_DSP_cfg: Serial port A irq %x conflicts with mwave_uart_irq %x\n", usSI & 0xFF, mwave_uart_irq); | |
285 | #else | |
286 | PRINTK_3(TRACE_SMAPI, | |
287 | "smapi::smapi_set_DSP_cfg: Serial port A irq %x conflicts with mwave_uart_irq %x\n", usSI & 0xFF, mwave_uart_irq); | |
288 | #endif | |
289 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
290 | PRINTK_1(TRACE_SMAPI, | |
291 | "smapi::smapi_set_DSP_cfg Disabling conflicting serial port\n"); | |
292 | bRC = smapi_request(0x1403, 0x0100, 0, usSI, | |
293 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
294 | if (bRC) goto exit_smapi_request_error; | |
295 | bRC = smapi_request(0x1402, 0x0000, 0, 0, | |
296 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
297 | if (bRC) goto exit_smapi_request_error; | |
298 | #else | |
299 | goto exit_conflict; | |
300 | #endif | |
301 | } else { | |
302 | if ((usSI >> 8) == uartio_index) { | |
303 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
304 | PRINTK_ERROR(KERN_ERR_MWAVE | |
305 | "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]); | |
306 | #else | |
307 | PRINTK_3(TRACE_SMAPI, | |
308 | "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]); | |
309 | #endif | |
310 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
311 | PRINTK_1(TRACE_SMAPI, | |
312 | "smapi::smapi_set_DSP_cfg Disabling conflicting serial port A\n"); | |
313 | bRC = smapi_request (0x1403, 0x0100, 0, usSI, | |
314 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
315 | if (bRC) goto exit_smapi_request_error; | |
316 | bRC = smapi_request (0x1402, 0x0000, 0, 0, | |
317 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
318 | if (bRC) goto exit_smapi_request_error; | |
319 | #else | |
320 | goto exit_conflict; | |
321 | #endif | |
322 | } | |
323 | } | |
324 | } | |
325 | } | |
326 | ||
327 | /* Check serial port B */ | |
328 | bRC = smapi_request(0x1404, 0x0000, 0, 0, | |
329 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
330 | if (bRC) goto exit_smapi_request_error; | |
331 | /* bRC == 0 */ | |
332 | if (usBX & 0x0100) { /* serial port B is present */ | |
333 | if (usCX & 1) { /* serial port is enabled */ | |
334 | if ((usSI & 0xFF) == mwave_uart_irq) { | |
335 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
336 | PRINTK_ERROR(KERN_ERR_MWAVE | |
337 | "smapi::smapi_set_DSP_cfg: Serial port B irq %x conflicts with mwave_uart_irq %x\n", usSI & 0xFF, mwave_uart_irq); | |
338 | #else | |
339 | PRINTK_3(TRACE_SMAPI, | |
340 | "smapi::smapi_set_DSP_cfg: Serial port B irq %x conflicts with mwave_uart_irq %x\n", usSI & 0xFF, mwave_uart_irq); | |
341 | #endif | |
342 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
343 | PRINTK_1(TRACE_SMAPI, | |
344 | "smapi::smapi_set_DSP_cfg Disabling conflicting serial port B\n"); | |
345 | bRC = smapi_request(0x1405, 0x0100, 0, usSI, | |
346 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
347 | if (bRC) goto exit_smapi_request_error; | |
348 | bRC = smapi_request(0x1404, 0x0000, 0, 0, | |
349 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
350 | if (bRC) goto exit_smapi_request_error; | |
351 | #else | |
352 | goto exit_conflict; | |
353 | #endif | |
354 | } else { | |
355 | if ((usSI >> 8) == uartio_index) { | |
356 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
357 | PRINTK_ERROR(KERN_ERR_MWAVE | |
358 | "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]); | |
359 | #else | |
360 | PRINTK_3(TRACE_SMAPI, | |
361 | "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]); | |
362 | #endif | |
363 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
364 | PRINTK_1 (TRACE_SMAPI, | |
365 | "smapi::smapi_set_DSP_cfg Disabling conflicting serial port B\n"); | |
366 | bRC = smapi_request (0x1405, 0x0100, 0, usSI, | |
367 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
368 | if (bRC) goto exit_smapi_request_error; | |
369 | bRC = smapi_request (0x1404, 0x0000, 0, 0, | |
370 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
371 | if (bRC) goto exit_smapi_request_error; | |
372 | #else | |
373 | goto exit_conflict; | |
374 | #endif | |
375 | } | |
376 | } | |
377 | } | |
378 | } | |
379 | ||
380 | /* Check IR port */ | |
381 | bRC = smapi_request(0x1700, 0x0000, 0, 0, | |
382 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
383 | if (bRC) goto exit_smapi_request_error; | |
384 | bRC = smapi_request(0x1704, 0x0000, 0, 0, | |
385 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
386 | if (bRC) goto exit_smapi_request_error; | |
387 | /* bRC == 0 */ | |
388 | if ((usCX & 0xff) != 0xff) { /* IR port not disabled */ | |
389 | if ((usCX & 0xff) == mwave_uart_irq) { | |
390 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
391 | PRINTK_ERROR(KERN_ERR_MWAVE | |
392 | "smapi::smapi_set_DSP_cfg: IR port irq %x conflicts with mwave_uart_irq %x\n", usCX & 0xff, mwave_uart_irq); | |
393 | #else | |
394 | PRINTK_3(TRACE_SMAPI, | |
395 | "smapi::smapi_set_DSP_cfg: IR port irq %x conflicts with mwave_uart_irq %x\n", usCX & 0xff, mwave_uart_irq); | |
396 | #endif | |
397 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
398 | PRINTK_1(TRACE_SMAPI, | |
399 | "smapi::smapi_set_DSP_cfg Disabling conflicting IR port\n"); | |
400 | bRC = smapi_request(0x1701, 0x0100, 0, 0, | |
401 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
402 | if (bRC) goto exit_smapi_request_error; | |
403 | bRC = smapi_request(0x1700, 0, 0, 0, | |
404 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
405 | if (bRC) goto exit_smapi_request_error; | |
406 | bRC = smapi_request(0x1705, 0x01ff, 0, usSI, | |
407 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
408 | if (bRC) goto exit_smapi_request_error; | |
409 | bRC = smapi_request(0x1704, 0x0000, 0, 0, | |
410 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
411 | if (bRC) goto exit_smapi_request_error; | |
412 | #else | |
413 | goto exit_conflict; | |
414 | #endif | |
415 | } else { | |
416 | if ((usSI & 0xff) == uartio_index) { | |
417 | #ifndef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
418 | PRINTK_ERROR(KERN_ERR_MWAVE | |
419 | "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]); | |
420 | #else | |
421 | PRINTK_3(TRACE_SMAPI, | |
422 | "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]); | |
423 | #endif | |
424 | #ifdef MWAVE_FUTZ_WITH_OTHER_DEVICES | |
425 | PRINTK_1(TRACE_SMAPI, | |
426 | "smapi::smapi_set_DSP_cfg Disabling conflicting IR port\n"); | |
427 | bRC = smapi_request(0x1701, 0x0100, 0, 0, | |
428 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
429 | if (bRC) goto exit_smapi_request_error; | |
430 | bRC = smapi_request(0x1700, 0, 0, 0, | |
431 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
432 | if (bRC) goto exit_smapi_request_error; | |
433 | bRC = smapi_request(0x1705, 0x01ff, 0, usSI, | |
434 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
435 | if (bRC) goto exit_smapi_request_error; | |
436 | bRC = smapi_request(0x1704, 0x0000, 0, 0, | |
437 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
438 | if (bRC) goto exit_smapi_request_error; | |
439 | #else | |
440 | goto exit_conflict; | |
441 | #endif | |
442 | } | |
443 | } | |
444 | } | |
445 | } | |
446 | ||
447 | bRC = smapi_request(0x1802, 0x0000, 0, 0, | |
448 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
449 | if (bRC) goto exit_smapi_request_error; | |
450 | ||
451 | if (mwave_3780i_io) { | |
452 | usDI = dspio_index; | |
453 | } | |
454 | if (mwave_3780i_irq) { | |
455 | usSI = (usSI & 0xff00) | mwave_3780i_irq; | |
456 | } | |
457 | ||
458 | bRC = smapi_request(0x1803, 0x0101, usDI, usSI, | |
459 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
460 | if (bRC) goto exit_smapi_request_error; | |
461 | ||
462 | bRC = smapi_request(0x1804, 0x0000, 0, 0, | |
463 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
464 | if (bRC) goto exit_smapi_request_error; | |
465 | ||
466 | if (mwave_uart_io) { | |
467 | usSI = (usSI & 0x00ff) | (uartio_index << 8); | |
468 | } | |
469 | if (mwave_uart_irq) { | |
470 | usSI = (usSI & 0xff00) | mwave_uart_irq; | |
471 | } | |
472 | bRC = smapi_request(0x1805, 0x0101, 0, usSI, | |
473 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
474 | if (bRC) goto exit_smapi_request_error; | |
475 | ||
476 | bRC = smapi_request(0x1802, 0x0000, 0, 0, | |
477 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
478 | if (bRC) goto exit_smapi_request_error; | |
479 | ||
480 | bRC = smapi_request(0x1804, 0x0000, 0, 0, | |
481 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
482 | if (bRC) goto exit_smapi_request_error; | |
483 | ||
484 | /* normal exit: */ | |
485 | PRINTK_1(TRACE_SMAPI, "smapi::smapi_set_DSP_cfg exit\n"); | |
486 | return 0; | |
487 | ||
488 | exit_conflict: | |
489 | /* Message has already been printed */ | |
490 | return -EIO; | |
491 | ||
492 | exit_smapi_request_error: | |
493 | PRINTK_ERROR(KERN_ERR_MWAVE "smapi::smapi_set_DSP_cfg exit on smapi_request error bRC %x\n", bRC); | |
494 | return bRC; | |
495 | } | |
496 | ||
497 | ||
26ec99b1 | 498 | int smapi_set_DSP_power_state(bool bOn) |
1da177e4 LT |
499 | { |
500 | int bRC = -EIO; | |
501 | unsigned short usAX, usBX, usCX, usDX, usDI, usSI; | |
502 | unsigned short usPowerFunction; | |
503 | ||
504 | PRINTK_2(TRACE_SMAPI, "smapi::smapi_set_DSP_power_state entry bOn %x\n", bOn); | |
505 | ||
506 | usPowerFunction = (bOn) ? 1 : 0; | |
507 | ||
508 | bRC = smapi_request(0x4901, 0x0000, 0, usPowerFunction, | |
509 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
510 | ||
511 | PRINTK_2(TRACE_SMAPI, "smapi::smapi_set_DSP_power_state exit bRC %x\n", bRC); | |
512 | ||
513 | return bRC; | |
514 | } | |
515 | ||
516 | #if 0 | |
517 | static int SmapiQuerySystemID(void) | |
518 | { | |
519 | int bRC = -EIO; | |
520 | unsigned short usAX = 0xffff, usBX = 0xffff, usCX = 0xffff, | |
521 | usDX = 0xffff, usDI = 0xffff, usSI = 0xffff; | |
522 | ||
523 | printk("smapi::SmapiQUerySystemID entry\n"); | |
524 | bRC = smapi_request(0x0000, 0, 0, 0, | |
525 | &usAX, &usBX, &usCX, &usDX, &usDI, &usSI); | |
526 | ||
527 | if (bRC == 0) { | |
528 | printk("AX=%x, BX=%x, CX=%x, DX=%x, DI=%x, SI=%x\n", | |
529 | usAX, usBX, usCX, usDX, usDI, usSI); | |
530 | } else { | |
531 | printk("smapi::SmapiQuerySystemID smapi_request error\n"); | |
532 | } | |
533 | ||
534 | return bRC; | |
535 | } | |
536 | #endif /* 0 */ | |
537 | ||
538 | int smapi_init(void) | |
539 | { | |
540 | int retval = -EIO; | |
541 | unsigned short usSmapiID = 0; | |
542 | unsigned long flags; | |
543 | ||
544 | PRINTK_1(TRACE_SMAPI, "smapi::smapi_init entry\n"); | |
545 | ||
546 | spin_lock_irqsave(&rtc_lock, flags); | |
547 | usSmapiID = CMOS_READ(0x7C); | |
548 | usSmapiID |= (CMOS_READ(0x7D) << 8); | |
549 | spin_unlock_irqrestore(&rtc_lock, flags); | |
550 | PRINTK_2(TRACE_SMAPI, "smapi::smapi_init usSmapiID %x\n", usSmapiID); | |
551 | ||
552 | if (usSmapiID == 0x5349) { | |
553 | spin_lock_irqsave(&rtc_lock, flags); | |
554 | g_usSmapiPort = CMOS_READ(0x7E); | |
555 | g_usSmapiPort |= (CMOS_READ(0x7F) << 8); | |
556 | spin_unlock_irqrestore(&rtc_lock, flags); | |
557 | if (g_usSmapiPort == 0) { | |
558 | PRINTK_ERROR("smapi::smapi_init, ERROR unable to read from SMAPI port\n"); | |
559 | } else { | |
560 | PRINTK_2(TRACE_SMAPI, | |
26ec99b1 | 561 | "smapi::smapi_init, exit true g_usSmapiPort %x\n", |
1da177e4 LT |
562 | g_usSmapiPort); |
563 | retval = 0; | |
564 | //SmapiQuerySystemID(); | |
565 | } | |
566 | } else { | |
567 | PRINTK_ERROR("smapi::smapi_init, ERROR invalid usSmapiID\n"); | |
568 | retval = -ENXIO; | |
569 | } | |
570 | ||
571 | return retval; | |
572 | } |