smapi.c (19457B)
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 54static unsigned short g_usSmapiPort = 0; 55 56 57static 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 127int smapi_query_DSP_cfg(SMAPI_DSP_SETTINGS * pSettings) 128{ 129 int bRC; 130 unsigned short usAX, usBX, usCX, usDX, usDI, usSI; 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 }; 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; 152 if ((usDI & 0x00FF) < ARRAY_SIZE(ausDspBases)) { 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; 180 if (((usSI & 0xFF00) >> 8) < ARRAY_SIZE(ausUartBases)) { 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 204int smapi_set_DSP_cfg(void) 205{ 206 int bRC = -EIO; 207 int i; 208 unsigned short usAX, usBX, usCX, usDX, usDI, usSI; 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 }; 218 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) { 226 for (i = 0; i < ARRAY_SIZE(ausDspBases); i++) { 227 if (mwave_3780i_io == ausDspBases[i]) 228 break; 229 } 230 if (i == ARRAY_SIZE(ausDspBases)) { 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) { 238 for (i = 0; i < ARRAY_SIZE(ausDspIrqs); i++) { 239 if (mwave_3780i_irq == ausDspIrqs[i]) 240 break; 241 } 242 if (i == ARRAY_SIZE(ausDspIrqs)) { 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) { 249 for (i = 0; i < ARRAY_SIZE(ausUartBases); i++) { 250 if (mwave_uart_io == ausUartBases[i]) 251 break; 252 } 253 if (i == ARRAY_SIZE(ausUartBases)) { 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) { 262 for (i = 0; i < ARRAY_SIZE(ausUartIrqs); i++) { 263 if (mwave_uart_irq == ausUartIrqs[i]) 264 break; 265 } 266 if (i == ARRAY_SIZE(ausUartIrqs)) { 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 488exit_conflict: 489 /* Message has already been printed */ 490 return -EIO; 491 492exit_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 498int smapi_set_DSP_power_state(bool bOn) 499{ 500 int bRC; 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 517static 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 538int 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, 561 "smapi::smapi_init, exit true g_usSmapiPort %x\n", 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}