git.oblomov.eu Git - linux-2.6/blob - drivers/char/mwave/smapi.c

   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 }