sys/dev/pms/RefTisa/tisa/sassata/sata/host/sat.c

   1 /*******************************************************************************
   2 *Copyright (c) 2014 PMC-Sierra, Inc.  All rights reserved.
   3 *
   4 *Redistribution and use in source and binary forms, with or without modification, are permitted provided
   5 *that the following conditions are met:
   6 *1. Redistributions of source code must retain the above copyright notice, this list of conditions and the
   7 *following disclaimer.
   8 *2. Redistributions in binary form must reproduce the above copyright notice,
   9 *this list of conditions and the following disclaimer in the documentation and/or other materials provided
  10 *with the distribution.
  11 *
  12 *THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND ANY EXPRESS OR IMPLIED
  13 *WARRANTIES,INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
  14 *FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  15 *FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  16 *NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
  17 *BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  18 *LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  19 *SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE
  20
  21 ********************************************************************************/
  22 /*****************************************************************************/
  23 /** \file
  24  *
  25  * The file implementing SCSI/ATA Translation (SAT).
  26  * The routines in this file are independent from HW LL API.
  27  *
  28  */
  29 /*****************************************************************************/
  30 #include <sys/cdefs.h>
  31 __FBSDID("$FreeBSD$");
  32 #include <dev/pms/config.h>
  33
  34 #include <dev/pms/freebsd/driver/common/osenv.h>
  35 #include <dev/pms/freebsd/driver/common/ostypes.h>
  36 #include <dev/pms/freebsd/driver/common/osdebug.h>
  37
  38 #ifdef SATA_ENABLE
  39
  40 #include <dev/pms/RefTisa/sallsdk/api/sa.h>
  41 #include <dev/pms/RefTisa/sallsdk/api/saapi.h>
  42 #include <dev/pms/RefTisa/sallsdk/api/saosapi.h>
  43
  44 #include <dev/pms/RefTisa/tisa/api/titypes.h>
  45 #include <dev/pms/RefTisa/tisa/api/ostiapi.h>
  46 #include <dev/pms/RefTisa/tisa/api/tiapi.h>
  47 #include <dev/pms/RefTisa/tisa/api/tiglobal.h>
  48
  49 #ifdef FDS_SM
  50 #include <dev/pms/RefTisa/sat/api/sm.h>
  51 #include <dev/pms/RefTisa/sat/api/smapi.h>
  52 #include <dev/pms/RefTisa/sat/api/tdsmapi.h>
  53 #endif
  54
  55 #ifdef FDS_DM
  56 #include <dev/pms/RefTisa/discovery/api/dm.h>
  57 #include <dev/pms/RefTisa/discovery/api/dmapi.h>
  58 #include <dev/pms/RefTisa/discovery/api/tddmapi.h>
  59 #endif
  60
  61 #include <dev/pms/RefTisa/tisa/sassata/sas/common/tdtypes.h>
  62 #include <dev/pms/freebsd/driver/common/osstring.h>
  63 #include <dev/pms/RefTisa/tisa/sassata/common/tdutil.h>
  64
  65 #ifdef INITIATOR_DRIVER
  66 #include <dev/pms/RefTisa/tisa/sassata/sas/ini/itdtypes.h>
  67 #include <dev/pms/RefTisa/tisa/sassata/sas/ini/itddefs.h>
  68 #include <dev/pms/RefTisa/tisa/sassata/sas/ini/itdglobl.h>
  69 #endif
  70
  71 #ifdef TARGET_DRIVER
  72 #include <dev/pms/RefTisa/tisa/sassata/sas/tgt/ttdglobl.h>
  73 #include <dev/pms/RefTisa/tisa/sassata/sas/tgt/ttdxchg.h>
  74 #include <dev/pms/RefTisa/tisa/sassata/sas/tgt/ttdtypes.h>
  75 #endif
  76
  77 #include <dev/pms/RefTisa/tisa/sassata/common/tdsatypes.h>
  78 #include <dev/pms/RefTisa/tisa/sassata/common/tdproto.h>
  79
  80 #include <dev/pms/RefTisa/tisa/sassata/sata/host/sat.h>
  81 #include <dev/pms/RefTisa/tisa/sassata/sata/host/satproto.h>
  82
  83 /*****************************************************************************
  84  *! \brief  satIOStart
  85  *
  86  *   This routine is called to initiate a new SCSI request to SATL.
  87  *
  88  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
  89  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
  90  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
  91  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
  92  *  \param   satIOContext_t:   Pointer to the SAT IO Context
  93  *
  94  *  \return:
  95  *
  96  *  \e tiSuccess:     I/O request successfully initiated.
  97  *  \e tiBusy:        No resources available, try again later.
  98  *  \e tiIONoDevice:  Invalid device handle.
  99  *  \e tiError:       Other errors that prevent the I/O request to be started.
 100  *
 101  *
 102  *****************************************************************************/
 103 GLOBAL bit32  satIOStart(
 104                    tiRoot_t                  *tiRoot,
 105                    tiIORequest_t             *tiIORequest,
 106                    tiDeviceHandle_t          *tiDeviceHandle,
 107                    tiScsiInitiatorRequest_t  *tiScsiRequest,
 108                    satIOContext_t            *satIOContext
 109                   )
 110 {
 111
 112   bit32             retVal = tiSuccess;
 113   satDeviceData_t   *pSatDevData;
 114   scsiRspSense_t    *pSense;
 115   tiIniScsiCmnd_t   *scsiCmnd;
 116   tiLUN_t           *pLun;
 117   satInternalIo_t   *pSatIntIo;
 118 #ifdef  TD_DEBUG_ENABLE
 119   tdsaDeviceData_t  *oneDeviceData;
 120 #endif
 121
 122   pSense        = satIOContext->pSense;
 123   pSatDevData   = satIOContext->pSatDevData;
 124   scsiCmnd      = &tiScsiRequest->scsiCmnd;
 125   pLun          = &scsiCmnd->lun;
 126
 127   /*
 128    * Reject all other LUN other than LUN 0.
 129    */
 130   if ( ((pLun->lun[0] | pLun->lun[1] | pLun->lun[2] | pLun->lun[3] |
 131          pLun->lun[4] | pLun->lun[5] | pLun->lun[6] | pLun->lun[7] ) != 0) &&
 132         (scsiCmnd->cdb[0] != SCSIOPC_INQUIRY)
 133      )
 134   {
 135     TI_DBG1(("satIOStart: *** REJECT *** LUN not zero, cdb[0]=0x%x tiIORequest=%p tiDeviceHandle=%p\n",
 136                  scsiCmnd->cdb[0], tiIORequest, tiDeviceHandle));
 137     satSetSensePayload( pSense,
 138                         SCSI_SNSKEY_ILLEGAL_REQUEST,
 139                         0,
 140                         SCSI_SNSCODE_LOGICAL_NOT_SUPPORTED,
 141                         satIOContext);
 142
 143     ostiInitiatorIOCompleted( tiRoot,
 144                               tiIORequest,
 145                               tiIOSuccess,
 146                               SCSI_STAT_CHECK_CONDITION,
 147                               satIOContext->pTiSenseData,
 148                               satIOContext->interruptContext );
 149     retVal = tiSuccess;
 150     goto ext;
 151   }
 152
 153   TI_DBG6(("satIOStart: satPendingIO %d satNCQMaxIO %d\n",pSatDevData->satPendingIO, pSatDevData->satNCQMaxIO ));
 154
 155   /* this may happen after tiCOMReset until OS sends inquiry */
 156   if (pSatDevData->IDDeviceValid == agFALSE && (scsiCmnd->cdb[0] != SCSIOPC_INQUIRY))
 157   {
 158 #ifdef  TD_DEBUG_ENABLE
 159     oneDeviceData = (tdsaDeviceData_t *)tiDeviceHandle->tdData;
 160 #endif
 161     TI_DBG1(("satIOStart: invalid identify device data did %d\n", oneDeviceData->id));
 162     retVal = tiIONoDevice;
 163     goto ext;
 164   }
 165   /*
 166    * Check if we need to return BUSY, i.e. recovery in progress
 167    */
 168   if (pSatDevData->satDriveState == SAT_DEV_STATE_IN_RECOVERY)
 169   {
 170 #ifdef  TD_DEBUG_ENABLE
 171     oneDeviceData = (tdsaDeviceData_t *)tiDeviceHandle->tdData;
 172 #endif
 173     TI_DBG1(("satIOStart: IN RECOVERY STATE cdb[0]=0x%x tiIORequest=%p tiDeviceHandle=%p\n",
 174                  scsiCmnd->cdb[0], tiIORequest, tiDeviceHandle));
 175     TI_DBG1(("satIOStart: IN RECOVERY STATE did %d\n", oneDeviceData->id));
 176
 177     TI_DBG1(("satIOStart: device %p satPendingIO %d satNCQMaxIO %d\n",pSatDevData, pSatDevData->satPendingIO, pSatDevData->satNCQMaxIO ));
 178     TI_DBG1(("satIOStart: device %p satPendingNCQIO %d satPendingNONNCQIO %d\n",pSatDevData, pSatDevData->satPendingNCQIO, pSatDevData->satPendingNONNCQIO));
 179     retVal = tiError;
 180     goto ext;
 181 //    return tiBusy;
 182   }
 183
 184   if (pSatDevData->satDeviceType == SATA_ATAPI_DEVICE)
 185   {
 186      if (scsiCmnd->cdb[0] == SCSIOPC_REPORT_LUN)
 187      {
 188         return satReportLun(tiRoot, tiIORequest, tiDeviceHandle, tiScsiRequest, satIOContext);
 189      }
 190      else
 191      {
 192         return satPacket(tiRoot, tiIORequest, tiDeviceHandle, tiScsiRequest, satIOContext);
 193      }
 194   }
 195   else /* pSatDevData->satDeviceType != SATA_ATAPI_DEVICE */
 196   {
 197      /* Parse CDB */
 198      switch(scsiCmnd->cdb[0])
 199      {
 200        case SCSIOPC_READ_6:
 201          retVal = satRead6( tiRoot,
 202                             tiIORequest,
 203                             tiDeviceHandle,
 204                             tiScsiRequest,
 205                             satIOContext);
 206          break;
 207
 208        case SCSIOPC_READ_10:
 209          retVal = satRead10( tiRoot,
 210                              tiIORequest,
 211                              tiDeviceHandle,
 212                              tiScsiRequest,
 213                              satIOContext);
 214          break;
 215
 216        case SCSIOPC_READ_12:
 217          TI_DBG5(("satIOStart: SCSIOPC_READ_12\n"));
 218          retVal = satRead12( tiRoot,
 219                              tiIORequest,
 220                              tiDeviceHandle,
 221                              tiScsiRequest,
 222                              satIOContext);
 223          break;
 224
 225        case SCSIOPC_READ_16:
 226          retVal = satRead16( tiRoot,
 227                              tiIORequest,
 228                              tiDeviceHandle,
 229                              tiScsiRequest,
 230                              satIOContext);
 231          break;
 232
 233        case SCSIOPC_WRITE_6:
 234          retVal = satWrite6( tiRoot,
 235                              tiIORequest,
 236                              tiDeviceHandle,
 237                              tiScsiRequest,
 238                              satIOContext);
 239          break;
 240
 241        case SCSIOPC_WRITE_10:
 242          retVal = satWrite10( tiRoot,
 243                               tiIORequest,
 244                               tiDeviceHandle,
 245                               tiScsiRequest,
 246                               satIOContext);
 247          break;
 248
 249        case SCSIOPC_WRITE_12:
 250          TI_DBG5(("satIOStart: SCSIOPC_WRITE_12 \n"));
 251          retVal = satWrite12( tiRoot,
 252                               tiIORequest,
 253                               tiDeviceHandle,
 254                               tiScsiRequest,
 255                               satIOContext);
 256
 257          break;
 258
 259        case SCSIOPC_WRITE_16:
 260          TI_DBG5(("satIOStart: SCSIOPC_WRITE_16\n"));
 261          retVal = satWrite16( tiRoot,
 262                               tiIORequest,
 263                               tiDeviceHandle,
 264                               tiScsiRequest,
 265                               satIOContext);
 266
 267          break;
 268
 269        case SCSIOPC_VERIFY_10:
 270          retVal = satVerify10( tiRoot,
 271                                tiIORequest,
 272                                tiDeviceHandle,
 273                                tiScsiRequest,
 274                                satIOContext);
 275          break;
 276
 277        case SCSIOPC_VERIFY_12:
 278          TI_DBG5(("satIOStart: SCSIOPC_VERIFY_12\n"));
 279          retVal = satVerify12( tiRoot,
 280                                tiIORequest,
 281                                tiDeviceHandle,
 282                                tiScsiRequest,
 283                                satIOContext);
 284          break;
 285
 286        case SCSIOPC_VERIFY_16:
 287          TI_DBG5(("satIOStart: SCSIOPC_VERIFY_16\n"));
 288          retVal = satVerify16( tiRoot,
 289                                tiIORequest,
 290                                tiDeviceHandle,
 291                                tiScsiRequest,
 292                                satIOContext);
 293          break;
 294
 295        case SCSIOPC_TEST_UNIT_READY:
 296          retVal = satTestUnitReady( tiRoot,
 297                                     tiIORequest,
 298                                     tiDeviceHandle,
 299                                     tiScsiRequest,
 300                                     satIOContext);
 301          break;
 302
 303        case SCSIOPC_INQUIRY:
 304          retVal = satInquiry( tiRoot,
 305                               tiIORequest,
 306                               tiDeviceHandle,
 307                               tiScsiRequest,
 308                               satIOContext);
 309          break;
 310
 311        case SCSIOPC_REQUEST_SENSE:
 312          retVal = satRequestSense( tiRoot,
 313                                    tiIORequest,
 314                                    tiDeviceHandle,
 315                                    tiScsiRequest,
 316                                    satIOContext);
 317          break;
 318
 319        case SCSIOPC_MODE_SENSE_6:
 320          retVal = satModeSense6( tiRoot,
 321                                  tiIORequest,
 322                                  tiDeviceHandle,
 323                                  tiScsiRequest,
 324                                  satIOContext);
 325          break;
 326
 327        case SCSIOPC_MODE_SENSE_10:
 328          retVal = satModeSense10( tiRoot,
 329                                  tiIORequest,
 330                                  tiDeviceHandle,
 331                                  tiScsiRequest,
 332                                  satIOContext);
 333          break;
 334
 335
 336        case SCSIOPC_READ_CAPACITY_10:
 337          retVal = satReadCapacity10( tiRoot,
 338                                      tiIORequest,
 339                                      tiDeviceHandle,
 340                                      tiScsiRequest,
 341                                      satIOContext);
 342          break;
 343
 344        case SCSIOPC_READ_CAPACITY_16:
 345          retVal = satReadCapacity16( tiRoot,
 346                                      tiIORequest,
 347                                      tiDeviceHandle,
 348                                      tiScsiRequest,
 349                                      satIOContext);
 350          break;
 351
 352        case SCSIOPC_REPORT_LUN:
 353          retVal = satReportLun( tiRoot,
 354                                 tiIORequest,
 355                                 tiDeviceHandle,
 356                                 tiScsiRequest,
 357                                 satIOContext);
 358          break;
 359
 360        case SCSIOPC_FORMAT_UNIT:
 361          TI_DBG5(("satIOStart: SCSIOPC_FORMAT_UNIT\n"));
 362          retVal = satFormatUnit( tiRoot,
 363                                  tiIORequest,
 364                                  tiDeviceHandle,
 365                                  tiScsiRequest,
 366                                  satIOContext);
 367          break;
 368        case SCSIOPC_SEND_DIAGNOSTIC: /* Table 28, p40 */
 369          TI_DBG5(("satIOStart: SCSIOPC_SEND_DIAGNOSTIC\n"));
 370          retVal = satSendDiagnostic( tiRoot,
 371                                      tiIORequest,
 372                                      tiDeviceHandle,
 373                                      tiScsiRequest,
 374                                      satIOContext);
 375          break;
 376
 377        case SCSIOPC_START_STOP_UNIT:
 378          TI_DBG5(("satIOStart: SCSIOPC_START_STOP_UNIT\n"));
 379          retVal = satStartStopUnit( tiRoot,
 380                                     tiIORequest,
 381                                     tiDeviceHandle,
 382                                     tiScsiRequest,
 383                                     satIOContext);
 384          break;
 385
 386        case SCSIOPC_WRITE_SAME_10: /*  sector and LBA; SAT p64 case 3 accessing payload and very
 387                                       inefficient now */
 388          TI_DBG5(("satIOStart: SCSIOPC_WRITE_SAME_10\n"));
 389          retVal = satWriteSame10( tiRoot,
 390                                   tiIORequest,
 391                                   tiDeviceHandle,
 392                                   tiScsiRequest,
 393                                   satIOContext);
 394          break;
 395
 396        case SCSIOPC_WRITE_SAME_16: /* no support due to transfer length(sector count) */
 397          TI_DBG5(("satIOStart: SCSIOPC_WRITE_SAME_16\n"));
 398          retVal = satWriteSame16( tiRoot,
 399                                   tiIORequest,
 400                                   tiDeviceHandle,
 401                                   tiScsiRequest,
 402                                   satIOContext);
 403          break;
 404
 405        case SCSIOPC_LOG_SENSE: /* SCT and log parameter(informational exceptions) */
 406          TI_DBG5(("satIOStart: SCSIOPC_LOG_SENSE\n"));
 407          retVal = satLogSense( tiRoot,
 408                                tiIORequest,
 409                                tiDeviceHandle,
 410                                tiScsiRequest,
 411                                satIOContext);
 412          break;
 413
 414        case SCSIOPC_MODE_SELECT_6: /*mode layout and AlloLen check */
 415          TI_DBG5(("satIOStart: SCSIOPC_MODE_SELECT_6\n"));
 416          retVal = satModeSelect6( tiRoot,
 417                                   tiIORequest,
 418                                   tiDeviceHandle,
 419                                   tiScsiRequest,
 420                                   satIOContext);
 421          break;
 422
 423        case SCSIOPC_MODE_SELECT_10: /* mode layout and AlloLen check and sharing CB with  satModeSelect6*/
 424          TI_DBG5(("satIOStart: SCSIOPC_MODE_SELECT_10\n"));
 425          retVal = satModeSelect10( tiRoot,
 426                                    tiIORequest,
 427                                    tiDeviceHandle,
 428                                    tiScsiRequest,
 429                                    satIOContext);
 430          break;
 431
 432        case SCSIOPC_SYNCHRONIZE_CACHE_10: /* on error what to return, sharing CB with
 433                                            satSynchronizeCache16 */
 434          TI_DBG5(("satIOStart: SCSIOPC_SYNCHRONIZE_CACHE_10\n"));
 435          retVal = satSynchronizeCache10( tiRoot,
 436                                          tiIORequest,
 437                                          tiDeviceHandle,
 438                                          tiScsiRequest,
 439                                          satIOContext);
 440          break;
 441
 442        case SCSIOPC_SYNCHRONIZE_CACHE_16:/* on error what to return, sharing CB with
 443                                             satSynchronizeCache16 */
 444
 445          TI_DBG5(("satIOStart: SCSIOPC_SYNCHRONIZE_CACHE_16\n"));
 446          retVal = satSynchronizeCache16( tiRoot,
 447                                          tiIORequest,
 448                                          tiDeviceHandle,
 449                                          tiScsiRequest,
 450                                          satIOContext);
 451          break;
 452
 453        case SCSIOPC_WRITE_AND_VERIFY_10: /* single write and multiple writes */
 454          TI_DBG5(("satIOStart: SCSIOPC_WRITE_AND_VERIFY_10\n"));
 455          retVal = satWriteAndVerify10( tiRoot,
 456                                        tiIORequest,
 457                                        tiDeviceHandle,
 458                                        tiScsiRequest,
 459                                        satIOContext);
 460          break;
 461
 462        case SCSIOPC_WRITE_AND_VERIFY_12:
 463          TI_DBG5(("satIOStart: SCSIOPC_WRITE_AND_VERIFY_12\n"));
 464          retVal = satWriteAndVerify12( tiRoot,
 465                                        tiIORequest,
 466                                        tiDeviceHandle,
 467                                        tiScsiRequest,
 468                                        satIOContext);
 469          break;
 470
 471        case SCSIOPC_WRITE_AND_VERIFY_16:
 472          TI_DBG5(("satIOStart: SCSIOPC_WRITE_AND_VERIFY_16\n"));
 473          retVal = satWriteAndVerify16( tiRoot,
 474                                        tiIORequest,
 475                                        tiDeviceHandle,
 476                                        tiScsiRequest,
 477                                        satIOContext);
 478
 479          break;
 480
 481        case SCSIOPC_READ_MEDIA_SERIAL_NUMBER:
 482          TI_DBG5(("satIOStart: SCSIOPC_READ_MEDIA_SERIAL_NUMBER\n"));
 483          retVal = satReadMediaSerialNumber( tiRoot,
 484                                             tiIORequest,
 485                                             tiDeviceHandle,
 486                                             tiScsiRequest,
 487                                             satIOContext);
 488
 489          break;
 490
 491        case SCSIOPC_READ_BUFFER:
 492          TI_DBG5(("satIOStart: SCSIOPC_READ_BUFFER\n"));
 493          retVal = satReadBuffer( tiRoot,
 494                                  tiIORequest,
 495                                  tiDeviceHandle,
 496                                  tiScsiRequest,
 497                                  satIOContext);
 498
 499          break;
 500
 501        case SCSIOPC_WRITE_BUFFER:
 502          TI_DBG5(("satIOStart: SCSIOPC_WRITE_BUFFER\n"));
 503          retVal = satWriteBuffer( tiRoot,
 504                                  tiIORequest,
 505                                  tiDeviceHandle,
 506                                  tiScsiRequest,
 507                                  satIOContext);
 508
 509          break;
 510
 511        case SCSIOPC_REASSIGN_BLOCKS:
 512          TI_DBG5(("satIOStart: SCSIOPC_REASSIGN_BLOCKS\n"));
 513          retVal = satReassignBlocks( tiRoot,
 514                                  tiIORequest,
 515                                  tiDeviceHandle,
 516                                  tiScsiRequest,
 517                                  satIOContext);
 518
 519          break;
 520
 521        default:
 522          /* Not implemented SCSI cmd, set up error response */
 523          TI_DBG1(("satIOStart: unsupported SCSI cdb[0]=0x%x tiIORequest=%p tiDeviceHandle=%p\n",
 524                     scsiCmnd->cdb[0], tiIORequest, tiDeviceHandle));
 525
 526          satSetSensePayload( pSense,
 527                              SCSI_SNSKEY_ILLEGAL_REQUEST,
 528                              0,
 529                              SCSI_SNSCODE_INVALID_COMMAND,
 530                              satIOContext);
 531
 532          ostiInitiatorIOCompleted( tiRoot,
 533                                    tiIORequest,
 534                                    tiIOSuccess,
 535                                    SCSI_STAT_CHECK_CONDITION,
 536                                    satIOContext->pTiSenseData,
 537                                    satIOContext->interruptContext );
 538          retVal = tiSuccess;
 539
 540          break;
 541
 542      }  /* end switch  */
 543   }
 544   if (retVal == tiBusy)
 545   {
 546 #ifdef  TD_DEBUG_ENABLE
 547     oneDeviceData = (tdsaDeviceData_t *)tiDeviceHandle->tdData;
 548 #endif
 549     TI_DBG1(("satIOStart: BUSY did %d\n", oneDeviceData->id));
 550     TI_DBG3(("satIOStart: LL is busy or target queue is full\n"));
 551     TI_DBG3(("satIOStart: device %p satPendingIO %d satNCQMaxIO %d\n",pSatDevData, pSatDevData->satPendingIO, pSatDevData->satNCQMaxIO ));
 552     TI_DBG3(("satIOStart: device %p satPendingNCQIO %d satPendingNONNCQIO %d\n",pSatDevData, pSatDevData->satPendingNCQIO, pSatDevData->satPendingNONNCQIO));
 553     pSatIntIo               = satIOContext->satIntIoContext;
 554
 555     /* interal structure free */
 556     satFreeIntIoResource( tiRoot,
 557                           pSatDevData,
 558                           pSatIntIo);
 559   }
 560
 561 ext:
 562   return retVal;
 563 }
 564
 565
 566 /*****************************************************************************/
 567 /*! \brief Setup up the SCSI Sense response.
 568  *
 569  *  This function is used to setup up the Sense Data payload for
 570  *     CHECK CONDITION status.
 571  *
 572  *  \param pSense:      Pointer to the scsiRspSense_t sense data structure.
 573  *  \param SnsKey:      SCSI Sense Key.
 574  *  \param SnsInfo:     SCSI Sense Info.
 575  *  \param SnsCode:     SCSI Sense Code.
 576  *
 577  *  \return: None
 578  */
 579 /*****************************************************************************/
 580 void satSetSensePayload( scsiRspSense_t   *pSense,
 581                          bit8             SnsKey,
 582                          bit32            SnsInfo,
 583                          bit16            SnsCode,
 584                          satIOContext_t   *satIOContext
 585                          )
 586 {
 587   /* for fixed format sense data, SPC-4, p37 */
 588   bit32      i;
 589   bit32      senseLength;
 590
 591   TI_DBG5(("satSetSensePayload: start\n"));
 592
 593   senseLength  = sizeof(scsiRspSense_t);
 594
 595   /* zero out the data area */
 596   for (i=0;i< senseLength;i++)
 597   {
 598     ((bit8*)pSense)[i] = 0;
 599   }
 600
 601   /*
 602    * SCSI Sense Data part of response data
 603    */
 604   pSense->snsRespCode  = 0x70;    /*  0xC0 == vendor specific */
 605                                       /*  0x70 == standard current error */
 606   pSense->senseKey     = SnsKey;
 607   /*
 608    * Put sense info in scsi order format
 609    */
 610   pSense->info[0]      = (bit8)((SnsInfo >> 24) & 0xff);
 611   pSense->info[1]      = (bit8)((SnsInfo >> 16) & 0xff);
 612   pSense->info[2]      = (bit8)((SnsInfo >> 8) & 0xff);
 613   pSense->info[3]      = (bit8)((SnsInfo) & 0xff);
 614   pSense->addSenseLen  = 11;          /* fixed size of sense data = 18 */
 615   pSense->addSenseCode = (bit8)((SnsCode >> 8) & 0xFF);
 616   pSense->senseQual    = (bit8)(SnsCode & 0xFF);
 617   /*
 618    * Set pointer in scsi status
 619    */
 620   switch(SnsKey)
 621   {
 622     /*
 623      * set illegal request sense key specific error in cdb, no bit pointer
 624      */
 625     case SCSI_SNSKEY_ILLEGAL_REQUEST:
 626       pSense->skeySpecific[0] = 0xC8;
 627       break;
 628
 629     default:
 630       break;
 631   }
 632   /* setting sense data length */
 633   if (satIOContext != agNULL)
 634   {
 635     satIOContext->pTiSenseData->senseLen = 18;
 636   }
 637   else
 638   {
 639     TI_DBG1(("satSetSensePayload: satIOContext is NULL\n"));
 640   }
 641 }
 642
 643 /*****************************************************************************/
 644 /*! \brief Setup up the SCSI Sense response.
 645  *
 646  *  This function is used to setup up the Sense Data payload for
 647  *     CHECK CONDITION status.
 648  *
 649  *  \param pSense:      Pointer to the scsiRspSense_t sense data structure.
 650  *  \param SnsKey:      SCSI Sense Key.
 651  *  \param SnsInfo:     SCSI Sense Info.
 652  *  \param SnsCode:     SCSI Sense Code.
 653  *
 654  *  \return: None
 655  */
 656 /*****************************************************************************/
 657
 658 void satSetDeferredSensePayload( scsiRspSense_t  *pSense,
 659                                  bit8             SnsKey,
 660                                  bit32            SnsInfo,
 661                                  bit16            SnsCode,
 662                                  satIOContext_t   *satIOContext
 663                                  )
 664 {
 665   /* for fixed format sense data, SPC-4, p37 */
 666   bit32      i;
 667   bit32      senseLength;
 668
 669   senseLength  = sizeof(scsiRspSense_t);
 670
 671   /* zero out the data area */
 672   for (i=0;i< senseLength;i++)
 673   {
 674     ((bit8*)pSense)[i] = 0;
 675   }
 676
 677   /*
 678    * SCSI Sense Data part of response data
 679    */
 680   pSense->snsRespCode  = 0x71;        /*  0xC0 == vendor specific */
 681                                       /*  0x70 == standard current error */
 682   pSense->senseKey     = SnsKey;
 683   /*
 684    * Put sense info in scsi order format
 685    */
 686   pSense->info[0]      = (bit8)((SnsInfo >> 24) & 0xff);
 687   pSense->info[1]      = (bit8)((SnsInfo >> 16) & 0xff);
 688   pSense->info[2]      = (bit8)((SnsInfo >> 8) & 0xff);
 689   pSense->info[3]      = (bit8)((SnsInfo) & 0xff);
 690   pSense->addSenseLen  = 11;          /* fixed size of sense data = 18 */
 691   pSense->addSenseCode = (bit8)((SnsCode >> 8) & 0xFF);
 692   pSense->senseQual    = (bit8)(SnsCode & 0xFF);
 693   /*
 694    * Set pointer in scsi status
 695    */
 696   switch(SnsKey)
 697   {
 698     /*
 699      * set illegal request sense key specific error in cdb, no bit pointer
 700      */
 701     case SCSI_SNSKEY_ILLEGAL_REQUEST:
 702       pSense->skeySpecific[0] = 0xC8;
 703       break;
 704
 705     default:
 706       break;
 707   }
 708
 709   /* setting sense data length */
 710   if (satIOContext != agNULL)
 711   {
 712     satIOContext->pTiSenseData->senseLen = 18;
 713   }
 714   else
 715   {
 716     TI_DBG1(("satSetDeferredSensePayload: satIOContext is NULL\n"));
 717   }
 718
 719 }
 720 /*****************************************************************************/
 721 /*! \brief SAT implementation for ATAPI Packet Command.
 722  *
 723  *  SAT implementation for ATAPI Packet and send FIS request to LL layer.
 724  *
 725  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
 726  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
 727  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
 728  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
 729  *  \param   satIOContext_t:   Pointer to the SAT IO Context
 730  *
 731  *  \return If command is started successfully
 732  *    - \e tiSuccess:     I/O request successfully initiated.
 733  *    - \e tiBusy:        No resources available, try again later.
 734  *    - \e tiIONoDevice:  Invalid device handle.
 735  *    - \e tiError:       Other errors.
 736  */
 737 /*****************************************************************************/
 738 GLOBAL bit32  satPacket(
 739                    tiRoot_t                  *tiRoot,
 740                    tiIORequest_t             *tiIORequest,
 741                    tiDeviceHandle_t          *tiDeviceHandle,
 742                    tiScsiInitiatorRequest_t  *tiScsiRequest,
 743                    satIOContext_t            *satIOContext)
 744 {
 745   bit32                     status;
 746   bit32                     agRequestType = AGSA_SATA_PROTOCOL_D2H_PKT;
 747   satDeviceData_t           *pSatDevData;
 748   tiIniScsiCmnd_t           *scsiCmnd;
 749   agsaFisRegHostToDevice_t  *fis;
 750
 751   pSatDevData   = satIOContext->pSatDevData;
 752   scsiCmnd      = &tiScsiRequest->scsiCmnd;
 753   fis           = satIOContext->pFis;
 754
 755   TI_DBG3(("satPacket: start, SCSI CDB is 0x%X %X %X %X %X %X %X %X %X %X %X %X\n",
 756            scsiCmnd->cdb[0],scsiCmnd->cdb[1],scsiCmnd->cdb[2],scsiCmnd->cdb[3],
 757            scsiCmnd->cdb[4],scsiCmnd->cdb[5],scsiCmnd->cdb[6],scsiCmnd->cdb[7],
 758            scsiCmnd->cdb[8],scsiCmnd->cdb[9],scsiCmnd->cdb[10],scsiCmnd->cdb[11]));
 759
 760   fis->h.fisType        = 0x27;                   /* Reg host to device */
 761   fis->h.c_pmPort       = 0x80;                   /* C Bit is set 1*/
 762   fis->h.command        = SAT_PACKET;             /* 0xA0 */
 763   if (pSatDevData->satDMADIRSupport)              /* DMADIR enabled*/
 764   {
 765      fis->h.features    = (tiScsiRequest->dataDirection == tiDirectionIn)? 0x04 : 0; /* 1 for D2H, 0 for H2D */
 766   }
 767   else
 768   {
 769      fis->h.features    = 0;                      /* FIS reserve */
 770   }
 771   /* Byte count low and byte count high */
 772   if ( scsiCmnd->expDataLength > 0xFFFF )
 773   {
 774      fis->d.lbaMid = 0xFF;                               /* FIS LBA (7 :0 ) */
 775      fis->d.lbaHigh = 0xFF;                              /* FIS LBA (15:8 ) */
 776   }
 777   else
 778   {
 779      fis->d.lbaMid = (bit8)scsiCmnd->expDataLength;       /* FIS LBA (7 :0 ) */
 780      fis->d.lbaHigh = (bit8)(scsiCmnd->expDataLength>>8); /* FIS LBA (15:8 ) */
 781   }
 782
 783   fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
 784   fis->d.device         = 0;                      /* FIS LBA (27:24) and FIS LBA mode  */
 785   fis->d.lbaLowExp      = 0;
 786   fis->d.lbaMidExp      = 0;
 787   fis->d.lbaHighExp     = 0;
 788   fis->d.featuresExp    = 0;
 789   fis->d.sectorCount    = 0;                       /* FIS sector count (7:0) */
 790   fis->d.sectorCountExp = 0;
 791   fis->d.reserved4      = 0;
 792   fis->d.control        = 0;                      /* FIS HOB bit clear */
 793   fis->d.reserved5      = 0;
 794
 795   satIOContext->ATACmd = SAT_PACKET;
 796
 797   if (tiScsiRequest->dataDirection == tiDirectionIn)
 798   {
 799       agRequestType = AGSA_SATA_PROTOCOL_D2H_PKT;
 800   }
 801   else
 802   {
 803       agRequestType = AGSA_SATA_PROTOCOL_H2D_PKT;
 804   }
 805
 806   if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
 807   {
 808      /*DMA transfer mode*/
 809      fis->h.features |= 0x01;
 810   }
 811   else
 812   {
 813      /*PIO transfer mode*/
 814      fis->h.features |= 0x0;
 815   }
 816
 817   satIOContext->satCompleteCB = &satPacketCB;
 818
 819   /*
 820    * Prepare SGL and send FIS to LL layer.
 821    */
 822   satIOContext->reqType = agRequestType;       /* Save it */
 823
 824   status = sataLLIOStart( tiRoot,
 825                           tiIORequest,
 826                           tiDeviceHandle,
 827                           tiScsiRequest,
 828                           satIOContext);
 829
 830   TI_DBG5(("satPacket: return\n"));
 831   return (status);
 832 }
 833
 834 /*****************************************************************************/
 835 /*! \brief SAT implementation for satSetFeatures.
 836  *
 837  *  This function creates SetFeatures fis and sends the request to LL layer
 838  *
 839  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
 840  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
 841  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
 842  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
 843  *  \param   satIOContext_t:   Pointer to the SAT IO Context
 844  *
 845  *  \return If command is started successfully
 846  *    - \e tiSuccess:     I/O request successfully initiated.
 847  *    - \e tiBusy:        No resources available, try again later.
 848  *    - \e tiIONoDevice:  Invalid device handle.
 849  *    - \e tiError:       Other errors.
 850  */
 851 /*****************************************************************************/
 852 GLOBAL bit32  satSetFeatures(
 853                             tiRoot_t                  *tiRoot,
 854                             tiIORequest_t             *tiIORequest,
 855                             tiDeviceHandle_t          *tiDeviceHandle,
 856                             tiScsiInitiatorRequest_t  *tiScsiRequest,
 857                             satIOContext_t            *satIOContext,
 858                             bit8                      bIsDMAMode
 859                             )
 860 {
 861   bit32                     status;
 862   bit32                     agRequestType;
 863   agsaFisRegHostToDevice_t  *fis;
 864
 865   fis           = satIOContext->pFis;
 866   TI_DBG3(("satSetFeatures: start\n"));
 867
 868   /*
 869    * Send the Set Features command.
 870    */
 871   fis->h.fisType        = 0x27;                   /* Reg host to device */
 872   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
 873   fis->h.command        = SAT_SET_FEATURES;       /* 0xEF */
 874   fis->h.features       = 0x03;                   /* set transfer mode */
 875   fis->d.lbaLow         = 0;
 876   fis->d.lbaMid         = 0;
 877   fis->d.lbaHigh        = 0;
 878   fis->d.device         = 0;
 879   fis->d.lbaLowExp      = 0;
 880   fis->d.lbaMidExp      = 0;
 881   fis->d.lbaHighExp     = 0;
 882   fis->d.featuresExp    = 0;
 883   fis->d.sectorCountExp = 0;
 884   fis->d.reserved4      = 0;
 885   fis->d.control        = 0;                      /* FIS HOB bit clear */
 886   fis->d.reserved5      = 0;
 887
 888   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
 889
 890   /* Initialize CB for SATA completion.
 891    */
 892   if (bIsDMAMode)
 893   {
 894       fis->d.sectorCount = 0x45;
 895       /*satIOContext->satCompleteCB = &satSetFeaturesDMACB;*/
 896   }
 897   else
 898   {
 899       fis->d.sectorCount = 0x0C;
 900       /*satIOContext->satCompleteCB = &satSetFeaturesPIOCB;*/
 901   }
 902   satIOContext->satCompleteCB = &satSetFeaturesCB;
 903
 904   /*
 905    * Prepare SGL and send FIS to LL layer.
 906    */
 907   satIOContext->reqType = agRequestType;       /* Save it */
 908
 909   status = sataLLIOStart( tiRoot,
 910                           tiIORequest,
 911                           tiDeviceHandle,
 912                           tiScsiRequest,
 913                           satIOContext);
 914
 915   TI_DBG5(("satSetFeatures: return\n"));
 916
 917   return status;
 918 }
 919 /*****************************************************************************/
 920 /*! \brief SAT implementation for SCSI REQUEST SENSE to ATAPI device.
 921  *
 922  *  SAT implementation for SCSI REQUEST SENSE.
 923  *
 924  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
 925  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
 926  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
 927  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
 928  *  \param   satIOContext_t:   Pointer to the SAT IO Context
 929  *
 930  *  \return If command is started successfully
 931  *    - \e tiSuccess:     I/O request successfully initiated.
 932  *    - \e tiBusy:        No resources available, try again later.
 933  *    - \e tiIONoDevice:  Invalid device handle.
 934  *    - \e tiError:       Other errors.
 935  */
 936 /*****************************************************************************/
 937 GLOBAL bit32  satRequestSenseForATAPI(
 938                    tiRoot_t                  *tiRoot,
 939                    tiIORequest_t             *tiIORequest,
 940                    tiDeviceHandle_t          *tiDeviceHandle,
 941                    tiScsiInitiatorRequest_t  *tiScsiRequest,
 942                    satIOContext_t            *satIOContext)
 943 {
 944   bit32                     status;
 945   bit32                     agRequestType = AGSA_SATA_PROTOCOL_D2H_PKT;
 946   satDeviceData_t           *pSatDevData;
 947   tiIniScsiCmnd_t           *scsiCmnd;
 948   agsaFisRegHostToDevice_t  *fis;
 949
 950   pSatDevData   = satIOContext->pSatDevData;
 951   scsiCmnd      = &tiScsiRequest->scsiCmnd;
 952   fis           = satIOContext->pFis;
 953
 954   scsiCmnd->cdb[0]   = SCSIOPC_REQUEST_SENSE;
 955   scsiCmnd->cdb[1]   = 0;
 956   scsiCmnd->cdb[2]   = 0;
 957   scsiCmnd->cdb[3]   = 0;
 958   scsiCmnd->cdb[4]   = SENSE_DATA_LENGTH;
 959   scsiCmnd->cdb[5]   = 0;
 960   TI_DBG3(("satRequestSenseForATAPI: start, SCSI CDB is 0x%X %X %X %X %X %X %X %X %X %X %X %X\n",
 961            scsiCmnd->cdb[0],scsiCmnd->cdb[1],scsiCmnd->cdb[2],scsiCmnd->cdb[3],
 962            scsiCmnd->cdb[4],scsiCmnd->cdb[5],scsiCmnd->cdb[6],scsiCmnd->cdb[7],
 963            scsiCmnd->cdb[8],scsiCmnd->cdb[9],scsiCmnd->cdb[10],scsiCmnd->cdb[11]));
 964
 965   fis->h.fisType        = 0x27;                   /* Reg host to device */
 966   fis->h.c_pmPort       = 0x80;                   /* C Bit is set 1*/
 967   fis->h.command        = SAT_PACKET;             /* 0xA0 */
 968   if (pSatDevData->satDMADIRSupport)              /* DMADIR enabled*/
 969   {
 970      fis->h.features    = (tiScsiRequest->dataDirection == tiDirectionIn)? 0x04 : 0; /* 1 for D2H, 0 for H2D */
 971   }
 972   else
 973   {
 974      fis->h.features    = 0;                         /* FIS reserve */
 975   }
 976
 977   fis->d.lbaLow         = 0;                         /* FIS LBA (7 :0 ) */
 978   fis->d.lbaMid         = 0;                         /* FIS LBA (15:8 ) */
 979   fis->d.lbaHigh        = 0x20;                      /* FIS LBA (23:16) */
 980   fis->d.device         = 0;                         /* FIS LBA (27:24) and FIS LBA mode  */
 981   fis->d.lbaLowExp      = 0;
 982   fis->d.lbaMidExp      = 0;
 983   fis->d.lbaHighExp     = 0;
 984   fis->d.featuresExp    = 0;
 985   fis->d.sectorCount    = 0;                          /* FIS sector count (7:0) */
 986   fis->d.sectorCountExp = 0;
 987   fis->d.reserved4      = 0;
 988   fis->d.control        = 0;                         /* FIS HOB bit clear */
 989   fis->d.reserved5      = (bit32)(scsiCmnd->cdb[0]|(scsiCmnd->cdb[1]<<8)|(scsiCmnd->cdb[2]<<16)|(scsiCmnd->cdb[3]<<24));
 990
 991   satIOContext->ATACmd = SAT_PACKET;
 992
 993   agRequestType = AGSA_SATA_PROTOCOL_D2H_PKT;
 994
 995   //if (pSatDevData->sat48BitSupport == agTRUE)
 996   {
 997     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
 998     {
 999        fis->h.features |= 0x01;
1000     }
1001     else
1002     {
1003        fis->h.features |= 0x0;
1004     }
1005   }
1006
1007   satIOContext->satCompleteCB = &satRequestSenseForATAPICB;
1008
1009   /*
1010    * Prepare SGL and send FIS to LL layer.
1011    */
1012   satIOContext->reqType = agRequestType;       /* Save it */
1013
1014   status = sataLLIOStart( tiRoot,
1015                           tiIORequest,
1016                           tiDeviceHandle,
1017                           tiScsiRequest,
1018                           satIOContext);
1019
1020   TI_DBG5(("satRequestSenseForATAPI: return\n"));
1021   return (status);
1022 }
1023 /*****************************************************************************/
1024 /*! \brief SAT implementation for satDeviceReset.
1025  *
1026  *  This function creates DEVICE RESET fis and sends the request to LL layer
1027  *
1028  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
1029  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
1030  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
1031  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
1032  *  \param   satIOContext_t:   Pointer to the SAT IO Context
1033  *
1034  *  \return If command is started successfully
1035  *    - \e tiSuccess:     I/O request successfully initiated.
1036  *    - \e tiBusy:        No resources available, try again later.
1037  *    - \e tiIONoDevice:  Invalid device handle.
1038  *    - \e tiError:       Other errors.
1039  */
1040 /*****************************************************************************/
1041 GLOBAL bit32 satDeviceReset(
1042                             tiRoot_t                  *tiRoot,
1043                             tiIORequest_t             *tiIORequest,
1044                             tiDeviceHandle_t          *tiDeviceHandle,
1045                             tiScsiInitiatorRequest_t  *tiScsiRequest,
1046                             satIOContext_t            *satIOContext
1047                             )
1048 {
1049   bit32                     status;
1050   bit32                     agRequestType;
1051   agsaFisRegHostToDevice_t  *fis;
1052
1053   fis           = satIOContext->pFis;
1054
1055   TI_DBG3(("satDeviceReset: start\n"));
1056
1057   /*
1058    * Send the  Execute Device Diagnostic command.
1059    */
1060   fis->h.fisType        = 0x27;                   /* Reg host to device */
1061   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1062   fis->h.command        = SAT_DEVICE_RESET;   /* 0x90 */
1063   fis->h.features       = 0;
1064   fis->d.lbaLow         = 0;
1065   fis->d.lbaMid         = 0;
1066   fis->d.lbaHigh        = 0;
1067   fis->d.device         = 0;
1068   fis->d.lbaLowExp      = 0;
1069   fis->d.lbaMidExp      = 0;
1070   fis->d.lbaHighExp     = 0;
1071   fis->d.featuresExp    = 0;
1072   fis->d.sectorCount    = 0;
1073   fis->d.sectorCountExp = 0;
1074   fis->d.reserved4      = 0;
1075   fis->d.control        = 0;                      /* FIS HOB bit clear */
1076   fis->d.reserved5      = 0;
1077
1078   agRequestType = AGSA_SATA_PROTOCOL_DEV_RESET;
1079
1080   /* Initialize CB for SATA completion.
1081    */
1082   satIOContext->satCompleteCB = &satDeviceResetCB;
1083
1084   /*
1085    * Prepare SGL and send FIS to LL layer.
1086    */
1087   satIOContext->reqType = agRequestType;       /* Save it */
1088
1089   status = sataLLIOStart( tiRoot,
1090                           tiIORequest,
1091                           tiDeviceHandle,
1092                           tiScsiRequest,
1093                           satIOContext);
1094
1095   TI_DBG3(("satDeviceReset: return\n"));
1096
1097   return status;
1098 }
1099
1100 /*****************************************************************************/
1101 /*! \brief SAT implementation for saExecuteDeviceDiagnostic.
1102  *
1103  *  This function creates Execute Device Diagnostic fis and sends the request to LL layer
1104  *
1105  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
1106  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
1107  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
1108  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
1109  *  \param   satIOContext_t:   Pointer to the SAT IO Context
1110  *
1111  *  \return If command is started successfully
1112  *    - \e tiSuccess:     I/O request successfully initiated.
1113  *    - \e tiBusy:        No resources available, try again later.
1114  *    - \e tiIONoDevice:  Invalid device handle.
1115  *    - \e tiError:       Other errors.
1116  */
1117 /*****************************************************************************/
1118 GLOBAL bit32  satExecuteDeviceDiagnostic(
1119                             tiRoot_t                  *tiRoot,
1120                             tiIORequest_t             *tiIORequest,
1121                             tiDeviceHandle_t          *tiDeviceHandle,
1122                             tiScsiInitiatorRequest_t  *tiScsiRequest,
1123                             satIOContext_t            *satIOContext
1124                             )
1125 {
1126   bit32                     status;
1127   bit32                     agRequestType;
1128   agsaFisRegHostToDevice_t  *fis;
1129
1130   fis           = satIOContext->pFis;
1131
1132   TI_DBG3(("satExecuteDeviceDiagnostic: start\n"));
1133
1134   /*
1135    * Send the  Execute Device Diagnostic command.
1136    */
1137   fis->h.fisType        = 0x27;                   /* Reg host to device */
1138   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1139   fis->h.command        = SAT_EXECUTE_DEVICE_DIAGNOSTIC;   /* 0x90 */
1140   fis->h.features       = 0;
1141   fis->d.lbaLow         = 0;
1142   fis->d.lbaMid         = 0;
1143   fis->d.lbaHigh        = 0;
1144   fis->d.device         = 0;
1145   fis->d.lbaLowExp      = 0;
1146   fis->d.lbaMidExp      = 0;
1147   fis->d.lbaHighExp     = 0;
1148   fis->d.featuresExp    = 0;
1149   fis->d.sectorCount    = 0;
1150   fis->d.sectorCountExp = 0;
1151   fis->d.reserved4      = 0;
1152   fis->d.control        = 0;                      /* FIS HOB bit clear */
1153   fis->d.reserved5      = 0;
1154
1155   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
1156
1157   /* Initialize CB for SATA completion.
1158    */
1159   satIOContext->satCompleteCB = &satExecuteDeviceDiagnosticCB;
1160
1161   /*
1162    * Prepare SGL and send FIS to LL layer.
1163    */
1164   satIOContext->reqType = agRequestType;       /* Save it */
1165
1166   status = sataLLIOStart( tiRoot,
1167                           tiIORequest,
1168                           tiDeviceHandle,
1169                           tiScsiRequest,
1170                           satIOContext);
1171
1172   TI_DBG5(("satExecuteDeviceDiagnostic: return\n"));
1173
1174   return status;
1175 }
1176
1177
1178 /*****************************************************************************/
1179 /*! \brief SAT implementation for SCSI READ10.
1180  *
1181  *  SAT implementation for SCSI READ10 and send FIS request to LL layer.
1182  *
1183  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
1184  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
1185  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
1186  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
1187  *  \param   satIOContext_t:   Pointer to the SAT IO Context
1188  *
1189  *  \return If command is started successfully
1190  *    - \e tiSuccess:     I/O request successfully initiated.
1191  *    - \e tiBusy:        No resources available, try again later.
1192  *    - \e tiIONoDevice:  Invalid device handle.
1193  *    - \e tiError:       Other errors.
1194  */
1195 /*****************************************************************************/
1196 GLOBAL bit32  satRead10(
1197                    tiRoot_t                  *tiRoot,
1198                    tiIORequest_t             *tiIORequest,
1199                    tiDeviceHandle_t          *tiDeviceHandle,
1200                    tiScsiInitiatorRequest_t *tiScsiRequest,
1201                    satIOContext_t            *satIOContext)
1202 {
1203
1204   bit32                     status;
1205   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
1206   satDeviceData_t           *pSatDevData;
1207   scsiRspSense_t            *pSense;
1208   tiIniScsiCmnd_t           *scsiCmnd;
1209   agsaFisRegHostToDevice_t  *fis;
1210   bit32                     lba = 0;
1211   bit32                     tl = 0;
1212   bit32                     LoopNum = 1;
1213   bit8                      LBA[4];
1214   bit8                      TL[4];
1215   bit32                     rangeChk = agFALSE; /* lba and tl range check */
1216
1217   pSense        = satIOContext->pSense;
1218   pSatDevData   = satIOContext->pSatDevData;
1219   scsiCmnd      = &tiScsiRequest->scsiCmnd;
1220   fis           = satIOContext->pFis;
1221
1222   TI_DBG5(("satRead10: start\n"));
1223   TI_DBG5(("satRead10: pSatDevData=%p\n", pSatDevData));
1224   //  tdhexdump("satRead10", (bit8 *)scsiCmnd->cdb, 10);
1225
1226   /* checking FUA_NV */
1227   if (scsiCmnd->cdb[1] & SCSI_FUA_NV_MASK)
1228   {
1229     satSetSensePayload( pSense,
1230                         SCSI_SNSKEY_ILLEGAL_REQUEST,
1231                         0,
1232                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
1233                         satIOContext);
1234
1235     ostiInitiatorIOCompleted( tiRoot,
1236                               tiIORequest,
1237                               tiIOSuccess,
1238                               SCSI_STAT_CHECK_CONDITION,
1239                               satIOContext->pTiSenseData,
1240                               satIOContext->interruptContext );
1241
1242     TI_DBG1(("satRead10: return FUA_NV\n"));
1243     return tiSuccess;
1244
1245   }
1246
1247   /* checking CONTROL */
1248   /* NACA == 1 or LINK == 1*/
1249   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
1250   {
1251     satSetSensePayload( pSense,
1252                         SCSI_SNSKEY_ILLEGAL_REQUEST,
1253                         0,
1254                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
1255                         satIOContext);
1256
1257     ostiInitiatorIOCompleted( tiRoot,
1258                               tiIORequest,
1259                               tiIOSuccess,
1260                               SCSI_STAT_CHECK_CONDITION,
1261                               satIOContext->pTiSenseData,
1262                               satIOContext->interruptContext );
1263
1264     TI_DBG1(("satRead10: return control\n"));
1265     return tiSuccess;
1266   }
1267
1268   osti_memset(LBA, 0, sizeof(LBA));
1269   osti_memset(TL, 0, sizeof(TL));
1270
1271   /* do not use memcpy due to indexing in LBA and TL */
1272   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
1273   LBA[1] = scsiCmnd->cdb[3];
1274   LBA[2] = scsiCmnd->cdb[4];
1275   LBA[3] = scsiCmnd->cdb[5];  /* LSB */
1276
1277   TL[0] = 0;
1278   TL[1] = 0;
1279   TL[2] = scsiCmnd->cdb[7];   /* MSB */
1280   TL[3] = scsiCmnd->cdb[8];   /* LSB */
1281
1282   rangeChk = satAddNComparebit32(LBA, TL);
1283
1284   /* cbd10; computing LBA and transfer length */
1285   lba = (scsiCmnd->cdb[2] << (8*3)) + (scsiCmnd->cdb[3] << (8*2))
1286     + (scsiCmnd->cdb[4] << 8) + scsiCmnd->cdb[5];
1287   tl = (scsiCmnd->cdb[7] << 8) + scsiCmnd->cdb[8];
1288
1289
1290   TI_DBG5(("satRead10: lba %d functioned lba %d\n", lba, satComputeCDB10LBA(satIOContext)));
1291   TI_DBG5(("satRead10: lba 0x%x functioned lba 0x%x\n", lba, satComputeCDB10LBA(satIOContext)));
1292   TI_DBG5(("satRead10: tl %d functioned tl %d\n", tl, satComputeCDB10TL(satIOContext)));
1293
1294   /* Table 34, 9.1, p 46 */
1295   /*
1296     note: As of 2/10/2006, no support for DMA QUEUED
1297    */
1298
1299   /*
1300     Table 34, 9.1, p 46, b
1301     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
1302     return check condition
1303   */
1304
1305   if (pSatDevData->satNCQ != agTRUE &&
1306       pSatDevData->sat48BitSupport != agTRUE
1307       )
1308   {
1309     if (lba > SAT_TR_LBA_LIMIT - 1)
1310     {
1311       TI_DBG1(("satRead10: return LBA out of range, not EXT\n"));
1312       satSetSensePayload( pSense,
1313                           SCSI_SNSKEY_ILLEGAL_REQUEST,
1314                           0,
1315                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
1316                           satIOContext);
1317
1318       ostiInitiatorIOCompleted( tiRoot,
1319                                 tiIORequest,
1320                                 tiIOSuccess,
1321                                 SCSI_STAT_CHECK_CONDITION,
1322                                 satIOContext->pTiSenseData,
1323                                 satIOContext->interruptContext );
1324
1325     return tiSuccess;
1326     }
1327
1328
1329     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
1330     {
1331       TI_DBG1(("satRead10: return LBA+TL out of range, not EXT\n"));
1332       satSetSensePayload( pSense,
1333                           SCSI_SNSKEY_ILLEGAL_REQUEST,
1334                           0,
1335                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
1336                           satIOContext);
1337
1338       ostiInitiatorIOCompleted( tiRoot,
1339                                 tiIORequest,
1340                                 tiIOSuccess,
1341                                 SCSI_STAT_CHECK_CONDITION,
1342                                 satIOContext->pTiSenseData,
1343                                 satIOContext->interruptContext );
1344
1345     return tiSuccess;
1346     }
1347   }
1348
1349   /* case 1 and 2 */
1350   if (!rangeChk) //  if (lba + tl <= SAT_TR_LBA_LIMIT)
1351   {
1352     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
1353     {
1354       /* case 2 */
1355       /* READ DMA*/
1356       /* in case that we can't fit the transfer length,
1357          we need to make it fit by sending multiple ATA cmnds */
1358       TI_DBG5(("satRead10: case 2\n"));
1359
1360
1361       fis->h.fisType        = 0x27;                   /* Reg host to device */
1362       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1363       fis->h.command        = SAT_READ_DMA;           /* 0xC8 */
1364       fis->h.features       = 0;                      /* FIS reserve */
1365       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
1366       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
1367       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
1368       fis->d.device         =
1369         (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));        /* FIS LBA (27:24) and FIS LBA mode  */
1370       fis->d.lbaLowExp      = 0;
1371       fis->d.lbaMidExp      = 0;
1372       fis->d.lbaHighExp     = 0;
1373       fis->d.featuresExp    = 0;
1374       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
1375       fis->d.sectorCountExp = 0;
1376       fis->d.reserved4      = 0;
1377       fis->d.control        = 0;                      /* FIS HOB bit clear */
1378       fis->d.reserved5      = 0;
1379
1380
1381       agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
1382       satIOContext->ATACmd = SAT_READ_DMA;
1383     }
1384     else
1385     {
1386       /* case 1 */
1387       /* READ MULTIPLE or READ SECTOR(S) */
1388       /* READ SECTORS for easier implemetation */
1389       /* in case that we can't fit the transfer length,
1390          we need to make it fit by sending multiple ATA cmnds */
1391       TI_DBG5(("satRead10: case 1\n"));
1392
1393       fis->h.fisType        = 0x27;                   /* Reg host to device */
1394       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1395       fis->h.command        = SAT_READ_SECTORS;       /* 0x20 */
1396       fis->h.features       = 0;                      /* FIS reserve */
1397       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
1398       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
1399       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
1400       fis->d.device         =
1401         (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));        /* FIS LBA (27:24) and FIS LBA mode  */
1402       fis->d.lbaLowExp      = 0;
1403       fis->d.lbaMidExp      = 0;
1404       fis->d.lbaHighExp     = 0;
1405       fis->d.featuresExp    = 0;
1406       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
1407       fis->d.sectorCountExp = 0;
1408       fis->d.reserved4      = 0;
1409       fis->d.control        = 0;                      /* FIS HOB bit clear */
1410       fis->d.reserved5      = 0;
1411
1412
1413       agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
1414       satIOContext->ATACmd = SAT_READ_SECTORS;
1415     }
1416   }
1417
1418    /* case 3 and 4 */
1419   if (pSatDevData->sat48BitSupport == agTRUE)
1420   {
1421     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
1422     {
1423       /* case 3 */
1424       /* READ DMA EXT */
1425       TI_DBG5(("satRead10: case 3\n"));
1426       fis->h.fisType        = 0x27;                   /* Reg host to device */
1427
1428       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1429       fis->h.command        = SAT_READ_DMA_EXT;       /* 0x25 */
1430       fis->h.features       = 0;                      /* FIS reserve */
1431       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
1432       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
1433       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
1434       fis->d.device         = 0x40;                   /* FIS LBA mode set */
1435       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
1436       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
1437       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
1438       fis->d.featuresExp    = 0;                      /* FIS reserve */
1439       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
1440       fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
1441       fis->d.reserved4      = 0;
1442       fis->d.control        = 0;                      /* FIS HOB bit clear */
1443       fis->d.reserved5      = 0;
1444
1445       agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
1446       satIOContext->ATACmd = SAT_READ_DMA_EXT;
1447
1448     }
1449     else
1450     {
1451       /* case 4 */
1452       /* READ MULTIPLE EXT or READ SECTOR(S) EXT or READ VERIFY SECTOR(S) EXT*/
1453       /* READ SECTORS EXT for easier implemetation */
1454       TI_DBG5(("satRead10: case 4\n"));
1455       fis->h.fisType        = 0x27;                   /* Reg host to device */
1456       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1457
1458       /* Check FUA bit */
1459       if (scsiCmnd->cdb[1] & SCSI_READ10_FUA_MASK)
1460       {
1461
1462         /* for now, no support for FUA */
1463         satSetSensePayload( pSense,
1464                             SCSI_SNSKEY_ILLEGAL_REQUEST,
1465                             0,
1466                             SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
1467                             satIOContext);
1468
1469         ostiInitiatorIOCompleted( tiRoot,
1470                                   tiIORequest,
1471                                   tiIOSuccess,
1472                                   SCSI_STAT_CHECK_CONDITION,
1473                                   satIOContext->pTiSenseData,
1474                                   satIOContext->interruptContext );
1475         return tiSuccess;
1476       }
1477
1478       fis->h.command        = SAT_READ_SECTORS_EXT;      /* 0x24 */
1479
1480       fis->h.features       = 0;                      /* FIS reserve */
1481       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
1482       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
1483       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
1484       fis->d.device         = 0x40;                   /* FIS LBA mode set */
1485       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
1486       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
1487       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
1488       fis->d.featuresExp    = 0;                      /* FIS reserve */
1489       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
1490       fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
1491       fis->d.reserved4      = 0;
1492       fis->d.control        = 0;                      /* FIS HOB bit clear */
1493       fis->d.reserved5      = 0;
1494
1495       agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
1496       satIOContext->ATACmd = SAT_READ_SECTORS_EXT;
1497     }
1498   }
1499
1500   /* case 5 */
1501   if (pSatDevData->satNCQ == agTRUE)
1502   {
1503     /* READ FPDMA QUEUED */
1504     if (pSatDevData->sat48BitSupport != agTRUE)
1505     {
1506       TI_DBG5(("satRead10: case 5 !!! error NCQ but 28 bit address support \n"));
1507       satSetSensePayload( pSense,
1508                           SCSI_SNSKEY_ILLEGAL_REQUEST,
1509                           0,
1510                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
1511                           satIOContext);
1512
1513       ostiInitiatorIOCompleted( tiRoot,
1514                                 tiIORequest,
1515                                 tiIOSuccess,
1516                                 SCSI_STAT_CHECK_CONDITION,
1517                                 satIOContext->pTiSenseData,
1518                                 satIOContext->interruptContext );
1519       return tiSuccess;
1520     }
1521
1522     TI_DBG6(("satRead10: case 5\n"));
1523
1524     /* Support 48-bit FPDMA addressing, use READ FPDMA QUEUE command */
1525
1526     fis->h.fisType        = 0x27;                   /* Reg host to device */
1527     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1528     fis->h.command        = SAT_READ_FPDMA_QUEUED;  /* 0x60 */
1529     fis->h.features       = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
1530     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
1531     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
1532     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
1533
1534     /* Check FUA bit */
1535     if (scsiCmnd->cdb[1] & SCSI_READ10_FUA_MASK)
1536       fis->d.device       = 0xC0;                   /* FIS FUA set */
1537     else
1538       fis->d.device       = 0x40;                   /* FIS FUA clear */
1539
1540     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
1541     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
1542     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
1543     fis->d.featuresExp    = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
1544     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
1545     fis->d.sectorCountExp = 0;
1546     fis->d.reserved4      = 0;
1547     fis->d.control        = 0;                      /* FIS HOB bit clear */
1548     fis->d.reserved5      = 0;
1549
1550     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_READ;
1551     satIOContext->ATACmd = SAT_READ_FPDMA_QUEUED;
1552   }
1553
1554
1555   //  tdhexdump("satRead10 final fis", (bit8 *)fis, sizeof(agsaFisRegHostToDevice_t));
1556
1557   /* saves the current LBA and orginal TL */
1558   satIOContext->currentLBA = lba;
1559   satIOContext->OrgTL = tl;
1560
1561  /*
1562     computing number of loop and remainder for tl
1563     0xFF in case not ext
1564     0xFFFF in case EXT
1565   */
1566   if (fis->h.command == SAT_READ_SECTORS || fis->h.command == SAT_READ_DMA)
1567   {
1568     LoopNum = satComputeLoopNum(tl, 0xFF);
1569   }
1570   else if (fis->h.command == SAT_READ_SECTORS_EXT || fis->h.command == SAT_READ_DMA_EXT)
1571   {
1572     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
1573     LoopNum = satComputeLoopNum(tl, 0xFFFF);
1574   }
1575   else
1576   {
1577     /* SAT_READ_FPDMA_QUEUED */
1578     LoopNum = satComputeLoopNum(tl, 0xFFFF);
1579   }
1580
1581   satIOContext->LoopNum = LoopNum;
1582
1583   /* Initialize CB for SATA completion.
1584    */
1585   if (LoopNum == 1)
1586   {
1587     TI_DBG5(("satRead10: NON CHAINED data\n"));
1588     satIOContext->satCompleteCB = &satNonChainedDataIOCB;
1589   }
1590   else
1591   {
1592     TI_DBG1(("satRead10: CHAINED data\n"));
1593     /* re-setting tl */
1594     if (fis->h.command == SAT_READ_SECTORS || fis->h.command == SAT_READ_DMA)
1595     {
1596        fis->d.sectorCount    = 0xFF;
1597     }
1598     else if (fis->h.command == SAT_READ_SECTORS_EXT || fis->h.command == SAT_READ_DMA_EXT)
1599     {
1600       /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
1601       fis->d.sectorCount    = 0xFF;
1602       fis->d.sectorCountExp = 0xFF;
1603     }
1604     else
1605     {
1606       /* SAT_READ_FPDMA_QUEUED */
1607       fis->h.features       = 0xFF;
1608       fis->d.featuresExp    = 0xFF;
1609     }
1610
1611     /* chained data */
1612     satIOContext->satCompleteCB = &satChainedDataIOCB;
1613
1614   }
1615
1616   /*
1617    * Prepare SGL and send FIS to LL layer.
1618    */
1619   satIOContext->reqType = agRequestType;       /* Save it */
1620
1621   status = sataLLIOStart( tiRoot,
1622                           tiIORequest,
1623                           tiDeviceHandle,
1624                           tiScsiRequest,
1625                           satIOContext);
1626
1627   TI_DBG5(("satRead10: return\n"));
1628   return (status);
1629
1630 }
1631
1632
1633 /*****************************************************************************/
1634 /*! \brief SAT implementation for SCSI satRead_1.
1635  *
1636  *  SAT implementation for SCSI satRead_1
1637  *  Sub function of satRead10
1638  *
1639  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
1640  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
1641  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
1642  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
1643  *  \param   satIOContext_t:   Pointer to the SAT IO Context
1644  *
1645  *  \return If command is started successfully
1646  *    - \e tiSuccess:     I/O request successfully initiated.
1647  *    - \e tiBusy:        No resources available, try again later.
1648  *    - \e tiIONoDevice:  Invalid device handle.
1649  *    - \e tiError:       Other errors.
1650  */
1651 /*****************************************************************************/
1652 /*
1653  * as a part of loop for read10
1654  */
1655 GLOBAL bit32  satRead_1(
1656                           tiRoot_t                  *tiRoot,
1657                           tiIORequest_t             *tiIORequest,
1658                           tiDeviceHandle_t          *tiDeviceHandle,
1659                           tiScsiInitiatorRequest_t *tiScsiRequest,
1660                           satIOContext_t            *satIOContext)
1661 {
1662   /*
1663     Assumption: error check on lba and tl has been done in satRead*()
1664     lba = lba + tl;
1665   */
1666   bit32                     status;
1667   satIOContext_t            *satOrgIOContext = agNULL;
1668   tiIniScsiCmnd_t           *scsiCmnd;
1669   agsaFisRegHostToDevice_t  *fis;
1670   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
1671   bit32                     lba = 0;
1672   bit32                     DenomTL = 0xFF;
1673   bit32                     Remainder = 0;
1674   bit8                      LBA[4]; /* 0 MSB, 3 LSB */
1675
1676   TI_DBG2(("satRead_1: start\n"));
1677
1678   fis             = satIOContext->pFis;
1679   satOrgIOContext = satIOContext->satOrgIOContext;
1680   scsiCmnd        = satOrgIOContext->pScsiCmnd;
1681
1682   osti_memset(LBA,0, sizeof(LBA));
1683
1684   switch (satOrgIOContext->ATACmd)
1685   {
1686   case SAT_READ_DMA:
1687     DenomTL = 0xFF;
1688     break;
1689   case SAT_READ_SECTORS:
1690     DenomTL = 0xFF;
1691     break;
1692   case SAT_READ_DMA_EXT:
1693     DenomTL = 0xFFFF;
1694     break;
1695   case SAT_READ_SECTORS_EXT:
1696     DenomTL = 0xFFFF;
1697     break;
1698   case SAT_READ_FPDMA_QUEUED:
1699     DenomTL = 0xFFFF;
1700     break;
1701   default:
1702     TI_DBG1(("satRead_1: error incorrect ata command 0x%x\n", satIOContext->ATACmd));
1703     return tiError;
1704     break;
1705   }
1706
1707   Remainder = satOrgIOContext->OrgTL % DenomTL;
1708   satOrgIOContext->currentLBA = satOrgIOContext->currentLBA + DenomTL;
1709   lba = satOrgIOContext->currentLBA;
1710
1711   LBA[0] = (bit8)((lba & 0xF000) >> (8 * 3));
1712   LBA[1] = (bit8)((lba & 0xF00) >> (8 * 2));
1713   LBA[2] = (bit8)((lba & 0xF0) >> 8);
1714   LBA[3] = (bit8)(lba & 0xF);
1715
1716
1717   switch (satOrgIOContext->ATACmd)
1718   {
1719   case SAT_READ_DMA:
1720     fis->h.fisType        = 0x27;                   /* Reg host to device */
1721     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1722     fis->h.command        = SAT_READ_DMA;           /* 0xC8 */
1723     fis->h.features       = 0;                      /* FIS reserve */
1724     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
1725     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
1726     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
1727     fis->d.device         =
1728       (bit8)((0x4 << 4) | (LBA[0] & 0xF));                  /* FIS LBA (27:24) and FIS LBA mode  */
1729     fis->d.lbaLowExp      = 0;
1730     fis->d.lbaMidExp      = 0;
1731     fis->d.lbaHighExp     = 0;
1732     fis->d.featuresExp    = 0;
1733
1734     if (satOrgIOContext->LoopNum == 1)
1735     {
1736       /* last loop */
1737       fis->d.sectorCount    = (bit8)Remainder;            /* FIS sector count (7:0) */
1738     }
1739     else
1740     {
1741       fis->d.sectorCount    = 0xFF;                  /* FIS sector count (7:0) */
1742     }
1743
1744     fis->d.sectorCountExp = 0;
1745     fis->d.reserved4      = 0;
1746     fis->d.control        = 0;                      /* FIS HOB bit clear */
1747     fis->d.reserved5      = 0;
1748
1749     agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
1750
1751     break;
1752   case SAT_READ_SECTORS:
1753     fis->h.fisType        = 0x27;                   /* Reg host to device */
1754     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1755     fis->h.command        = SAT_READ_SECTORS;       /* 0x20 */
1756     fis->h.features       = 0;                      /* FIS reserve */
1757     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
1758     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
1759     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
1760     fis->d.device         =
1761       (bit8)((0x4 << 4) | (LBA[0] & 0xF));                  /* FIS LBA (27:24) and FIS LBA mode  */
1762     fis->d.lbaLowExp      = 0;
1763     fis->d.lbaMidExp      = 0;
1764     fis->d.lbaHighExp     = 0;
1765     fis->d.featuresExp    = 0;
1766     if (satOrgIOContext->LoopNum == 1)
1767     {
1768       /* last loop */
1769       fis->d.sectorCount    = (bit8)Remainder;            /* FIS sector count (7:0) */
1770     }
1771     else
1772     {
1773       fis->d.sectorCount    = 0xFF;                   /* FIS sector count (7:0) */
1774     }
1775     fis->d.sectorCountExp = 0;
1776     fis->d.reserved4      = 0;
1777     fis->d.control        = 0;                      /* FIS HOB bit clear */
1778     fis->d.reserved5      = 0;
1779
1780     agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
1781
1782     break;
1783   case SAT_READ_DMA_EXT:
1784     fis->h.fisType        = 0x27;                   /* Reg host to device */
1785     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1786     fis->h.command        = SAT_READ_DMA_EXT;       /* 0x25 */
1787     fis->h.features       = 0;                      /* FIS reserve */
1788     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
1789     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
1790     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
1791     fis->d.device         = 0x40;                   /* FIS LBA mode set */
1792     fis->d.lbaLowExp      = LBA[0];                 /* FIS LBA (31:24) */
1793     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
1794     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
1795     fis->d.featuresExp    = 0;                      /* FIS reserve */
1796     if (satOrgIOContext->LoopNum == 1)
1797     {
1798       /* last loop */
1799       fis->d.sectorCount    = (bit8)(Remainder & 0xFF);     /* FIS sector count (7:0) */
1800       fis->d.sectorCountExp = (bit8)((Remainder & 0xFF00) >> 8);       /* FIS sector count (15:8) */
1801
1802     }
1803     else
1804     {
1805       fis->d.sectorCount    = 0xFF;       /* FIS sector count (7:0) */
1806       fis->d.sectorCountExp = 0xFF;       /* FIS sector count (15:8) */
1807     }
1808     fis->d.reserved4      = 0;
1809     fis->d.control        = 0;                      /* FIS HOB bit clear */
1810     fis->d.reserved5      = 0;
1811
1812     agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
1813
1814     break;
1815   case SAT_READ_SECTORS_EXT:
1816     fis->h.fisType        = 0x27;                   /* Reg host to device */
1817     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1818     fis->h.command        = SAT_READ_SECTORS_EXT;   /* 0x24 */
1819     fis->h.features       = 0;                      /* FIS reserve */
1820     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
1821     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
1822     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
1823     fis->d.device         = 0x40;                   /* FIS LBA mode set */
1824     fis->d.lbaLowExp      = LBA[0];                 /* FIS LBA (31:24) */
1825     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
1826     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
1827     fis->d.featuresExp    = 0;                      /* FIS reserve */
1828     if (satOrgIOContext->LoopNum == 1)
1829     {
1830       /* last loop */
1831       fis->d.sectorCount    = (bit8)(Remainder & 0xFF);     /* FIS sector count (7:0) */
1832       fis->d.sectorCountExp = (bit8)((Remainder & 0xFF00) >> 8);  /* FIS sector count (15:8) */
1833     }
1834     else
1835     {
1836       fis->d.sectorCount    = 0xFF;       /* FIS sector count (7:0) */
1837       fis->d.sectorCountExp = 0xFF;       /* FIS sector count (15:8) */
1838     }
1839     fis->d.reserved4      = 0;
1840     fis->d.control        = 0;                      /* FIS HOB bit clear */
1841     fis->d.reserved5      = 0;
1842
1843     agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
1844     break;
1845   case SAT_READ_FPDMA_QUEUED:
1846     fis->h.fisType        = 0x27;                   /* Reg host to device */
1847     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
1848     fis->h.command        = SAT_READ_FPDMA_QUEUED;  /* 0x60 */
1849     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
1850     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
1851     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
1852
1853     /* Check FUA bit */
1854     if (scsiCmnd->cdb[1] & SCSI_READ10_FUA_MASK)
1855       fis->d.device       = 0xC0;                   /* FIS FUA set */
1856     else
1857       fis->d.device       = 0x40;                   /* FIS FUA clear */
1858
1859     fis->d.lbaLowExp      = LBA[0];                 /* FIS LBA (31:24) */
1860     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
1861     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
1862     if (satOrgIOContext->LoopNum == 1)
1863     {
1864       /* last loop */
1865       fis->h.features       = (bit8)(Remainder & 0xFF);       /* FIS sector count (7:0) */
1866       fis->d.featuresExp    = (bit8)((Remainder & 0xFF00) >> 8);       /* FIS sector count (15:8) */
1867     }
1868     else
1869     {
1870       fis->h.features       = 0xFF;       /* FIS sector count (7:0) */
1871       fis->d.featuresExp    = 0xFF;       /* FIS sector count (15:8) */
1872     }
1873     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
1874     fis->d.sectorCountExp = 0;
1875     fis->d.reserved4      = 0;
1876     fis->d.control        = 0;                      /* FIS HOB bit clear */
1877     fis->d.reserved5      = 0;
1878
1879     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_READ;
1880     break;
1881   default:
1882     TI_DBG1(("satRead_1: error incorrect ata command 0x%x\n", satIOContext->ATACmd));
1883     return tiError;
1884     break;
1885   }
1886
1887   /* Initialize CB for SATA completion.
1888    */
1889   /* chained data */
1890   satIOContext->satCompleteCB = &satChainedDataIOCB;
1891
1892
1893   /*
1894    * Prepare SGL and send FIS to LL layer.
1895    */
1896   satIOContext->reqType = agRequestType;       /* Save it */
1897
1898   status = sataLLIOStart( tiRoot,
1899                           tiIORequest,
1900                           tiDeviceHandle,
1901                           tiScsiRequest,
1902                           satIOContext);
1903
1904   TI_DBG5(("satRead_1: return\n"));
1905   return (status);
1906 }
1907 /*****************************************************************************/
1908 /*! \brief SAT implementation for SCSI READ12.
1909  *
1910  *  SAT implementation for SCSI READ12 and send FIS request to LL layer.
1911  *
1912  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
1913  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
1914  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
1915  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
1916  *  \param   satIOContext_t:   Pointer to the SAT IO Context
1917  *
1918  *  \return If command is started successfully
1919  *    - \e tiSuccess:     I/O request successfully initiated.
1920  *    - \e tiBusy:        No resources available, try again later.
1921  *    - \e tiIONoDevice:  Invalid device handle.
1922  *    - \e tiError:       Other errors.
1923  */
1924 /*****************************************************************************/
1925 GLOBAL bit32  satRead12(
1926                    tiRoot_t                  *tiRoot,
1927                    tiIORequest_t             *tiIORequest,
1928                    tiDeviceHandle_t          *tiDeviceHandle,
1929                    tiScsiInitiatorRequest_t *tiScsiRequest,
1930                    satIOContext_t            *satIOContext)
1931 {
1932   bit32                     status;
1933   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
1934   satDeviceData_t           *pSatDevData;
1935   scsiRspSense_t            *pSense;
1936   tiIniScsiCmnd_t           *scsiCmnd;
1937   agsaFisRegHostToDevice_t  *fis;
1938   bit32                     lba = 0;
1939   bit32                     tl = 0;
1940   bit32                     LoopNum = 1;
1941   bit8                      LBA[4];
1942   bit8                      TL[4];
1943   bit32                     rangeChk = agFALSE; /* lba and tl range check */
1944
1945   pSense        = satIOContext->pSense;
1946   pSatDevData   = satIOContext->pSatDevData;
1947   scsiCmnd      = &tiScsiRequest->scsiCmnd;
1948   fis           = satIOContext->pFis;
1949
1950   TI_DBG5(("satRead12: start\n"));
1951
1952   /* checking FUA_NV */
1953   if (scsiCmnd->cdb[1] & SCSI_FUA_NV_MASK)
1954   {
1955     satSetSensePayload( pSense,
1956                         SCSI_SNSKEY_ILLEGAL_REQUEST,
1957                         0,
1958                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
1959                         satIOContext);
1960
1961     ostiInitiatorIOCompleted( tiRoot,
1962                               tiIORequest,
1963                               tiIOSuccess,
1964                               SCSI_STAT_CHECK_CONDITION,
1965                               satIOContext->pTiSenseData,
1966                               satIOContext->interruptContext );
1967
1968     TI_DBG1(("satRead12: return FUA_NV\n"));
1969     return tiSuccess;
1970
1971   }
1972
1973   /* checking CONTROL */
1974   /* NACA == 1 or LINK == 1*/
1975   if ( (scsiCmnd->cdb[11] & SCSI_NACA_MASK) || (scsiCmnd->cdb[11] & SCSI_LINK_MASK) )
1976   {
1977     satSetSensePayload( pSense,
1978                         SCSI_SNSKEY_ILLEGAL_REQUEST,
1979                         0,
1980                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
1981                         satIOContext);
1982
1983     ostiInitiatorIOCompleted( tiRoot,
1984                               tiIORequest,
1985                               tiIOSuccess,
1986                               SCSI_STAT_CHECK_CONDITION,
1987                               satIOContext->pTiSenseData,
1988                               satIOContext->interruptContext );
1989
1990     TI_DBG2(("satRead12: return control\n"));
1991     return tiSuccess;
1992   }
1993
1994   osti_memset(LBA, 0, sizeof(LBA));
1995   osti_memset(TL, 0, sizeof(TL));
1996
1997   /* do not use memcpy due to indexing in LBA and TL */
1998   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
1999   LBA[1] = scsiCmnd->cdb[3];
2000   LBA[2] = scsiCmnd->cdb[4];
2001   LBA[3] = scsiCmnd->cdb[5];  /* LSB */
2002
2003   TL[0] = scsiCmnd->cdb[6];   /* MSB */
2004   TL[1] = scsiCmnd->cdb[7];
2005   TL[2] = scsiCmnd->cdb[8];
2006   TL[3] = scsiCmnd->cdb[9];   /* LSB */
2007
2008   rangeChk = satAddNComparebit32(LBA, TL);
2009
2010   lba = satComputeCDB12LBA(satIOContext);
2011   tl = satComputeCDB12TL(satIOContext);
2012
2013   /* Table 34, 9.1, p 46 */
2014   /*
2015     note: As of 2/10/2006, no support for DMA QUEUED
2016    */
2017
2018   /*
2019     Table 34, 9.1, p 46, b
2020     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
2021     return check condition
2022   */
2023   if (pSatDevData->satNCQ != agTRUE &&
2024       pSatDevData->sat48BitSupport != agTRUE
2025       )
2026   {
2027     if (lba > SAT_TR_LBA_LIMIT - 1)
2028     {
2029       TI_DBG1(("satRead12: return LBA out of range, not EXT\n"));
2030       satSetSensePayload( pSense,
2031                           SCSI_SNSKEY_ILLEGAL_REQUEST,
2032                           0,
2033                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
2034                           satIOContext);
2035
2036       ostiInitiatorIOCompleted( tiRoot,
2037                                 tiIORequest,
2038                                 tiIOSuccess,
2039                                 SCSI_STAT_CHECK_CONDITION,
2040                                 satIOContext->pTiSenseData,
2041                                 satIOContext->interruptContext );
2042
2043     return tiSuccess;
2044     }
2045     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
2046     {
2047       TI_DBG1(("satRead12: return LBA+TL out of range, not EXT\n"));
2048       satSetSensePayload( pSense,
2049                           SCSI_SNSKEY_ILLEGAL_REQUEST,
2050                           0,
2051                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
2052                           satIOContext);
2053
2054       ostiInitiatorIOCompleted( tiRoot,
2055                                 tiIORequest,
2056                                 tiIOSuccess,
2057                                 SCSI_STAT_CHECK_CONDITION,
2058                                 satIOContext->pTiSenseData,
2059                                 satIOContext->interruptContext );
2060
2061     return tiSuccess;
2062     }
2063   }
2064
2065   /* case 1 and 2 */
2066   if (!rangeChk) //  if (lba + tl <= SAT_TR_LBA_LIMIT)
2067   {
2068     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
2069     {
2070       /* case 2 */
2071       /* READ DMA*/
2072       /* in case that we can't fit the transfer length,
2073          we need to make it fit by sending multiple ATA cmnds */
2074       TI_DBG5(("satRead12: case 2\n"));
2075
2076
2077       fis->h.fisType        = 0x27;                   /* Reg host to device */
2078       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2079       fis->h.command        = SAT_READ_DMA;           /* 0xC8 */
2080       fis->h.features       = 0;                      /* FIS reserve */
2081       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
2082       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
2083       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
2084       fis->d.device         =
2085         (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));        /* FIS LBA (27:24) and FIS LBA mode  */
2086       fis->d.lbaLowExp      = 0;
2087       fis->d.lbaMidExp      = 0;
2088       fis->d.lbaHighExp     = 0;
2089       fis->d.featuresExp    = 0;
2090       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
2091       fis->d.sectorCountExp = 0;
2092       fis->d.reserved4      = 0;
2093       fis->d.control        = 0;                      /* FIS HOB bit clear */
2094       fis->d.reserved5      = 0;
2095
2096
2097       agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
2098       satIOContext->ATACmd = SAT_READ_DMA;
2099     }
2100     else
2101     {
2102       /* case 1 */
2103       /* READ MULTIPLE or READ SECTOR(S) */
2104       /* READ SECTORS for easier implemetation */
2105       /* can't fit the transfer length but need to make it fit by sending multiple*/
2106       TI_DBG5(("satRead12: case 1\n"));
2107
2108       fis->h.fisType        = 0x27;                   /* Reg host to device */
2109       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2110       fis->h.command        = SAT_READ_SECTORS;       /* 0x20 */
2111       fis->h.features       = 0;                      /* FIS reserve */
2112       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
2113       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
2114       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
2115       fis->d.device         =
2116         (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));        /* FIS LBA (27:24) and FIS LBA mode  */
2117       fis->d.lbaLowExp      = 0;
2118       fis->d.lbaMidExp      = 0;
2119       fis->d.lbaHighExp     = 0;
2120       fis->d.featuresExp    = 0;
2121       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
2122       fis->d.sectorCountExp = 0;
2123       fis->d.reserved4      = 0;
2124       fis->d.control        = 0;                      /* FIS HOB bit clear */
2125       fis->d.reserved5      = 0;
2126
2127
2128       agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
2129       satIOContext->ATACmd = SAT_READ_SECTORS;
2130     }
2131   }
2132
2133   /* case 3 and 4 */
2134   if (pSatDevData->sat48BitSupport == agTRUE)
2135   {
2136     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
2137     {
2138       /* case 3 */
2139       /* READ DMA EXT */
2140       TI_DBG5(("satRead12: case 3\n"));
2141       fis->h.fisType        = 0x27;                   /* Reg host to device */
2142
2143       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2144       fis->h.command        = SAT_READ_DMA_EXT;       /* 0x25 */
2145       fis->h.features       = 0;                      /* FIS reserve */
2146       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
2147       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
2148       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
2149       fis->d.device         = 0x40;                   /* FIS LBA mode set */
2150       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
2151       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
2152       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
2153       fis->d.featuresExp    = 0;                      /* FIS reserve */
2154       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
2155       fis->d.sectorCountExp = scsiCmnd->cdb[8];       /* FIS sector count (15:8) */
2156       fis->d.reserved4      = 0;
2157       fis->d.control        = 0;                      /* FIS HOB bit clear */
2158       fis->d.reserved5      = 0;
2159
2160       agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
2161       satIOContext->ATACmd = SAT_READ_DMA_EXT;
2162
2163     }
2164     else
2165     {
2166       /* case 4 */
2167       /* READ MULTIPLE EXT or READ SECTOR(S) EXT or READ VERIFY SECTOR(S) EXT*/
2168       /* READ SECTORS EXT for easier implemetation */
2169       TI_DBG5(("satRead12: case 4\n"));
2170       fis->h.fisType        = 0x27;                   /* Reg host to device */
2171       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2172
2173       /* Check FUA bit */
2174       if (scsiCmnd->cdb[1] & SCSI_READ12_FUA_MASK)
2175       {
2176         /* for now, no support for FUA */
2177         satSetSensePayload( pSense,
2178                             SCSI_SNSKEY_ILLEGAL_REQUEST,
2179                             0,
2180                             SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
2181                             satIOContext);
2182
2183         ostiInitiatorIOCompleted( tiRoot,
2184                                   tiIORequest,
2185                                   tiIOSuccess,
2186                                   SCSI_STAT_CHECK_CONDITION,
2187                                   satIOContext->pTiSenseData,
2188                                   satIOContext->interruptContext );
2189         return tiSuccess;
2190       }
2191
2192       fis->h.command        = SAT_READ_SECTORS_EXT;      /* 0x24 */
2193
2194       fis->h.features       = 0;                      /* FIS reserve */
2195       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
2196       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
2197       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
2198       fis->d.device         = 0x40;                   /* FIS LBA mode set */
2199       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
2200       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
2201       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
2202       fis->d.featuresExp    = 0;                      /* FIS reserve */
2203       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
2204       fis->d.sectorCountExp = scsiCmnd->cdb[8];       /* FIS sector count (15:8) */
2205       fis->d.reserved4      = 0;
2206       fis->d.control        = 0;                      /* FIS HOB bit clear */
2207       fis->d.reserved5      = 0;
2208
2209       agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
2210       satIOContext->ATACmd = SAT_READ_SECTORS_EXT;
2211     }
2212   }
2213
2214   /* case 5 */
2215   if (pSatDevData->satNCQ == agTRUE)
2216   {
2217     /* READ FPDMA QUEUED */
2218     if (pSatDevData->sat48BitSupport != agTRUE)
2219     {
2220       TI_DBG5(("satRead12: case 5 !!! error NCQ but 28 bit address support \n"));
2221       satSetSensePayload( pSense,
2222                           SCSI_SNSKEY_ILLEGAL_REQUEST,
2223                           0,
2224                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
2225                           satIOContext);
2226
2227       ostiInitiatorIOCompleted( tiRoot,
2228                                 tiIORequest,
2229                                 tiIOSuccess,
2230                                 SCSI_STAT_CHECK_CONDITION,
2231                                 satIOContext->pTiSenseData,
2232                                 satIOContext->interruptContext );
2233       return tiSuccess;
2234     }
2235
2236     TI_DBG6(("satRead12: case 5\n"));
2237
2238     /* Support 48-bit FPDMA addressing, use READ FPDMA QUEUE command */
2239
2240     fis->h.fisType        = 0x27;                   /* Reg host to device */
2241     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2242     fis->h.command        = SAT_READ_FPDMA_QUEUED;  /* 0x60 */
2243     fis->h.features       = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
2244     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
2245     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
2246     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
2247
2248     /* Check FUA bit */
2249     if (scsiCmnd->cdb[1] & SCSI_READ12_FUA_MASK)
2250       fis->d.device       = 0xC0;                   /* FIS FUA set */
2251     else
2252       fis->d.device       = 0x40;                   /* FIS FUA clear */
2253
2254     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
2255     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
2256     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
2257     fis->d.featuresExp    = scsiCmnd->cdb[8];       /* FIS sector count (15:8) */
2258     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
2259     fis->d.sectorCountExp = 0;
2260     fis->d.reserved4      = 0;
2261     fis->d.control        = 0;                      /* FIS HOB bit clear */
2262     fis->d.reserved5      = 0;
2263
2264     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_READ;
2265     satIOContext->ATACmd = SAT_READ_FPDMA_QUEUED;
2266   }
2267
2268   /* saves the current LBA and orginal TL */
2269   satIOContext->currentLBA = lba;
2270   satIOContext->OrgTL = tl;
2271
2272   /*
2273     computing number of loop and remainder for tl
2274     0xFF in case not ext
2275     0xFFFF in case EXT
2276   */
2277   if (fis->h.command == SAT_READ_SECTORS || fis->h.command == SAT_READ_DMA)
2278   {
2279     LoopNum = satComputeLoopNum(tl, 0xFF);
2280   }
2281   else if (fis->h.command == SAT_READ_SECTORS_EXT || fis->h.command == SAT_READ_DMA_EXT)
2282   {
2283     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
2284     LoopNum = satComputeLoopNum(tl, 0xFFFF);
2285   }
2286   else
2287   {
2288     /* SAT_READ_FPDMA_QUEUEDK */
2289     LoopNum = satComputeLoopNum(tl, 0xFFFF);
2290   }
2291
2292   satIOContext->LoopNum = LoopNum;
2293
2294   if (LoopNum == 1)
2295   {
2296     TI_DBG5(("satRead12: NON CHAINED data\n"));
2297     satIOContext->satCompleteCB = &satNonChainedDataIOCB;
2298   }
2299   else
2300   {
2301     TI_DBG1(("satRead12: CHAINED data\n"));
2302     /* re-setting tl */
2303     if (fis->h.command == SAT_READ_SECTORS || fis->h.command == SAT_READ_DMA)
2304     {
2305        fis->d.sectorCount    = 0xFF;
2306     }
2307     else if (fis->h.command == SAT_READ_SECTORS_EXT || fis->h.command == SAT_READ_DMA_EXT)
2308     {
2309       /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
2310       fis->d.sectorCount    = 0xFF;
2311       fis->d.sectorCountExp = 0xFF;
2312     }
2313     else
2314     {
2315       /* SAT_READ_FPDMA_QUEUED */
2316       fis->h.features       = 0xFF;
2317       fis->d.featuresExp    = 0xFF;
2318     }
2319
2320     /* chained data */
2321     satIOContext->satCompleteCB = &satChainedDataIOCB;
2322   }
2323
2324   /*
2325    * Prepare SGL and send FIS to LL layer.
2326    */
2327   satIOContext->reqType = agRequestType;       /* Save it */
2328
2329   status = sataLLIOStart( tiRoot,
2330                           tiIORequest,
2331                           tiDeviceHandle,
2332                           tiScsiRequest,
2333                           satIOContext);
2334
2335   TI_DBG5(("satRead12: return\n"));
2336   return (status);
2337 }
2338 /*****************************************************************************/
2339 /*! \brief SAT implementation for SCSI READ16.
2340  *
2341  *  SAT implementation for SCSI READ16 and send FIS request to LL layer.
2342  *
2343  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
2344  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
2345  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
2346  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
2347  *  \param   satIOContext_t:   Pointer to the SAT IO Context
2348  *
2349  *  \return If command is started successfully
2350  *    - \e tiSuccess:     I/O request successfully initiated.
2351  *    - \e tiBusy:        No resources available, try again later.
2352  *    - \e tiIONoDevice:  Invalid device handle.
2353  *    - \e tiError:       Other errors.
2354  */
2355 /*****************************************************************************/
2356 GLOBAL bit32  satRead16(
2357                    tiRoot_t                  *tiRoot,
2358                    tiIORequest_t             *tiIORequest,
2359                    tiDeviceHandle_t          *tiDeviceHandle,
2360                    tiScsiInitiatorRequest_t *tiScsiRequest,
2361                    satIOContext_t            *satIOContext)
2362 {
2363   bit32                     status;
2364   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
2365   satDeviceData_t           *pSatDevData;
2366   scsiRspSense_t            *pSense;
2367   tiIniScsiCmnd_t           *scsiCmnd;
2368   agsaFisRegHostToDevice_t  *fis;
2369   bit32                     lba = 0;
2370   bit32                     tl = 0;
2371   bit32                     LoopNum = 1;
2372   bit8                      LBA[8];
2373   bit8                      TL[8];
2374   bit32                     rangeChk = agFALSE; /* lba and tl range check */
2375   bit32                     limitChk = agFALSE; /* lba and tl range check */
2376
2377   pSense        = satIOContext->pSense;
2378   pSatDevData   = satIOContext->pSatDevData;
2379   scsiCmnd      = &tiScsiRequest->scsiCmnd;
2380   fis           = satIOContext->pFis;
2381
2382   TI_DBG5(("satRead16: start\n"));
2383
2384   /* checking FUA_NV */
2385   if (scsiCmnd->cdb[1] & SCSI_FUA_NV_MASK)
2386   {
2387     satSetSensePayload( pSense,
2388                         SCSI_SNSKEY_ILLEGAL_REQUEST,
2389                         0,
2390                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
2391                         satIOContext);
2392
2393     ostiInitiatorIOCompleted( tiRoot,
2394                               tiIORequest,
2395                               tiIOSuccess,
2396                               SCSI_STAT_CHECK_CONDITION,
2397                               satIOContext->pTiSenseData,
2398                               satIOContext->interruptContext );
2399
2400     TI_DBG1(("satRead16: return FUA_NV\n"));
2401     return tiSuccess;
2402
2403   }
2404
2405   /* checking CONTROL */
2406   /* NACA == 1 or LINK == 1*/
2407   if ( (scsiCmnd->cdb[15] & SCSI_NACA_MASK) || (scsiCmnd->cdb[15] & SCSI_LINK_MASK) )
2408   {
2409     satSetSensePayload( pSense,
2410                         SCSI_SNSKEY_ILLEGAL_REQUEST,
2411                         0,
2412                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
2413                         satIOContext);
2414
2415     ostiInitiatorIOCompleted( tiRoot,
2416                               tiIORequest,
2417                               tiIOSuccess,
2418                               SCSI_STAT_CHECK_CONDITION,
2419                               satIOContext->pTiSenseData,
2420                               satIOContext->interruptContext );
2421
2422     TI_DBG1(("satRead16: return control\n"));
2423     return tiSuccess;
2424   }
2425
2426
2427   osti_memset(LBA, 0, sizeof(LBA));
2428   osti_memset(TL, 0, sizeof(TL));
2429
2430
2431   /* do not use memcpy due to indexing in LBA and TL */
2432   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
2433   LBA[1] = scsiCmnd->cdb[3];
2434   LBA[2] = scsiCmnd->cdb[4];
2435   LBA[3] = scsiCmnd->cdb[5];
2436   LBA[4] = scsiCmnd->cdb[6];
2437   LBA[5] = scsiCmnd->cdb[7];
2438   LBA[6] = scsiCmnd->cdb[8];
2439   LBA[7] = scsiCmnd->cdb[9];  /* LSB */
2440
2441   TL[0] = 0;
2442   TL[1] = 0;
2443   TL[2] = 0;
2444   TL[3] = 0;
2445   TL[4] = scsiCmnd->cdb[10];   /* MSB */
2446   TL[5] = scsiCmnd->cdb[11];
2447   TL[6] = scsiCmnd->cdb[12];
2448   TL[7] = scsiCmnd->cdb[13];   /* LSB */
2449
2450  rangeChk = satAddNComparebit64(LBA, TL);
2451
2452  limitChk = satCompareLBALimitbit(LBA);
2453
2454  lba = satComputeCDB16LBA(satIOContext);
2455  tl = satComputeCDB16TL(satIOContext);
2456
2457
2458   /* Table 34, 9.1, p 46 */
2459   /*
2460     note: As of 2/10/2006, no support for DMA QUEUED
2461    */
2462
2463   /*
2464     Table 34, 9.1, p 46, b
2465     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
2466     return check condition
2467   */
2468   if (pSatDevData->satNCQ != agTRUE &&
2469       pSatDevData->sat48BitSupport != agTRUE
2470       )
2471   {
2472     if (limitChk)
2473     {
2474       TI_DBG1(("satRead16: return LBA out of range, not EXT\n"));
2475       satSetSensePayload( pSense,
2476                           SCSI_SNSKEY_ILLEGAL_REQUEST,
2477                           0,
2478                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
2479                           satIOContext);
2480
2481       ostiInitiatorIOCompleted( tiRoot,
2482                                 tiIORequest,
2483                                 tiIOSuccess,
2484                                 SCSI_STAT_CHECK_CONDITION,
2485                                 satIOContext->pTiSenseData,
2486                                 satIOContext->interruptContext );
2487
2488     return tiSuccess;
2489     }
2490     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
2491     {
2492       TI_DBG1(("satRead16: return LBA+TL out of range, not EXT\n"));
2493       satSetSensePayload( pSense,
2494                           SCSI_SNSKEY_ILLEGAL_REQUEST,
2495                           0,
2496                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
2497                           satIOContext);
2498
2499       ostiInitiatorIOCompleted( tiRoot,
2500                                 tiIORequest,
2501                                 tiIOSuccess,
2502                                 SCSI_STAT_CHECK_CONDITION,
2503                                 satIOContext->pTiSenseData,
2504                                 satIOContext->interruptContext );
2505
2506     return tiSuccess;
2507     }
2508   }
2509
2510   /* case 1 and 2 */
2511   if (!rangeChk) //  if (lba + tl <= SAT_TR_LBA_LIMIT)
2512   {
2513     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
2514     {
2515       /* case 2 */
2516       /* READ DMA*/
2517       /* in case that we can't fit the transfer length,
2518          we need to make it fit by sending multiple ATA cmnds */
2519       TI_DBG5(("satRead16: case 2\n"));
2520
2521
2522       fis->h.fisType        = 0x27;                   /* Reg host to device */
2523       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2524       fis->h.command        = SAT_READ_DMA;           /* 0xC8 */
2525       fis->h.features       = 0;                      /* FIS reserve */
2526       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
2527       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
2528       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
2529       fis->d.device         =
2530         (bit8)((0x4 << 4) | (scsiCmnd->cdb[6] & 0xF));        /* FIS LBA (27:24) and FIS LBA mode  */
2531       fis->d.lbaLowExp      = 0;
2532       fis->d.lbaMidExp      = 0;
2533       fis->d.lbaHighExp     = 0;
2534       fis->d.featuresExp    = 0;
2535       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
2536       fis->d.sectorCountExp = 0;
2537       fis->d.reserved4      = 0;
2538       fis->d.control        = 0;                      /* FIS HOB bit clear */
2539       fis->d.reserved5      = 0;
2540
2541
2542       agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
2543       satIOContext->ATACmd = SAT_READ_DMA;
2544     }
2545     else
2546     {
2547       /* case 1 */
2548       /* READ MULTIPLE or READ SECTOR(S) */
2549       /* READ SECTORS for easier implemetation */
2550       /* can't fit the transfer length but need to make it fit by sending multiple*/
2551       TI_DBG5(("satRead16: case 1\n"));
2552
2553       fis->h.fisType        = 0x27;                   /* Reg host to device */
2554       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2555       fis->h.command        = SAT_READ_SECTORS;       /* 0x20 */
2556       fis->h.features       = 0;                      /* FIS reserve */
2557       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
2558       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
2559       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
2560       fis->d.device         =
2561         (bit8)((0x4 << 4) | (scsiCmnd->cdb[6] & 0xF));        /* FIS LBA (27:24) and FIS LBA mode  */
2562       fis->d.lbaLowExp      = 0;
2563       fis->d.lbaMidExp      = 0;
2564       fis->d.lbaHighExp     = 0;
2565       fis->d.featuresExp    = 0;
2566       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
2567       fis->d.sectorCountExp = 0;
2568       fis->d.reserved4      = 0;
2569       fis->d.control        = 0;                      /* FIS HOB bit clear */
2570       fis->d.reserved5      = 0;
2571
2572
2573       agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
2574       satIOContext->ATACmd = SAT_READ_SECTORS;
2575     }
2576   }
2577
2578   /* case 3 and 4 */
2579   if (pSatDevData->sat48BitSupport == agTRUE)
2580   {
2581     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
2582     {
2583       /* case 3 */
2584       /* READ DMA EXT */
2585       TI_DBG5(("satRead16: case 3\n"));
2586       fis->h.fisType        = 0x27;                   /* Reg host to device */
2587
2588       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2589       fis->h.command        = SAT_READ_DMA_EXT;       /* 0x25 */
2590       fis->h.features       = 0;                      /* FIS reserve */
2591       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
2592       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
2593       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
2594       fis->d.device         = 0x40;                   /* FIS LBA mode set */
2595       fis->d.lbaLowExp      = scsiCmnd->cdb[6];       /* FIS LBA (31:24) */
2596       fis->d.lbaMidExp      = scsiCmnd->cdb[5];       /* FIS LBA (39:32) */
2597       fis->d.lbaHighExp     = scsiCmnd->cdb[4];       /* FIS LBA (47:40) */
2598       fis->d.featuresExp    = 0;                      /* FIS reserve */
2599       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
2600       fis->d.sectorCountExp = scsiCmnd->cdb[12];       /* FIS sector count (15:8) */
2601       fis->d.reserved4      = 0;
2602       fis->d.control        = 0;                      /* FIS HOB bit clear */
2603       fis->d.reserved5      = 0;
2604
2605       agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
2606       satIOContext->ATACmd = SAT_READ_DMA_EXT;
2607
2608     }
2609     else
2610     {
2611       /* case 4 */
2612       /* READ MULTIPLE EXT or READ SECTOR(S) EXT or READ VERIFY SECTOR(S) EXT*/
2613       /* READ SECTORS EXT for easier implemetation */
2614       TI_DBG5(("satRead16: case 4\n"));
2615       fis->h.fisType        = 0x27;                   /* Reg host to device */
2616       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2617
2618       /* Check FUA bit */
2619       if (scsiCmnd->cdb[1] & SCSI_READ16_FUA_MASK)
2620       {
2621
2622         /* for now, no support for FUA */
2623         satSetSensePayload( pSense,
2624                             SCSI_SNSKEY_ILLEGAL_REQUEST,
2625                             0,
2626                             SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
2627                             satIOContext);
2628
2629         ostiInitiatorIOCompleted( tiRoot,
2630                                   tiIORequest,
2631                                   tiIOSuccess,
2632                                   SCSI_STAT_CHECK_CONDITION,
2633                                   satIOContext->pTiSenseData,
2634                                   satIOContext->interruptContext );
2635         return tiSuccess;
2636       }
2637
2638       fis->h.command        = SAT_READ_SECTORS_EXT;      /* 0x24 */
2639
2640       fis->h.features       = 0;                      /* FIS reserve */
2641       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
2642       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
2643       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
2644       fis->d.device         = 0x40;                   /* FIS LBA mode set */
2645       fis->d.lbaLowExp      = scsiCmnd->cdb[6];       /* FIS LBA (31:24) */
2646       fis->d.lbaMidExp      = scsiCmnd->cdb[5];       /* FIS LBA (39:32) */
2647       fis->d.lbaHighExp     = scsiCmnd->cdb[4];       /* FIS LBA (47:40) */
2648       fis->d.featuresExp    = 0;                      /* FIS reserve */
2649       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
2650       fis->d.sectorCountExp = scsiCmnd->cdb[12];       /* FIS sector count (15:8) */
2651       fis->d.reserved4      = 0;
2652       fis->d.control        = 0;                      /* FIS HOB bit clear */
2653       fis->d.reserved5      = 0;
2654
2655       agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
2656       satIOContext->ATACmd = SAT_READ_SECTORS_EXT;
2657     }
2658   }
2659
2660
2661   /* case 5 */
2662   if (pSatDevData->satNCQ == agTRUE)
2663   {
2664     /* READ FPDMA QUEUED */
2665     if (pSatDevData->sat48BitSupport != agTRUE)
2666     {
2667       TI_DBG5(("satRead16: case 5 !!! error NCQ but 28 bit address support \n"));
2668       satSetSensePayload( pSense,
2669                           SCSI_SNSKEY_ILLEGAL_REQUEST,
2670                           0,
2671                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
2672                           satIOContext);
2673
2674       ostiInitiatorIOCompleted( tiRoot,
2675                                 tiIORequest,
2676                                 tiIOSuccess,
2677                                 SCSI_STAT_CHECK_CONDITION,
2678                                 satIOContext->pTiSenseData,
2679                                 satIOContext->interruptContext );
2680       return tiSuccess;
2681     }
2682
2683     TI_DBG6(("satRead16: case 5\n"));
2684
2685     /* Support 48-bit FPDMA addressing, use READ FPDMA QUEUE command */
2686
2687     fis->h.fisType        = 0x27;                   /* Reg host to device */
2688     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2689     fis->h.command        = SAT_READ_FPDMA_QUEUED;  /* 0x60 */
2690     fis->h.features       = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
2691     fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
2692     fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
2693     fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
2694
2695     /* Check FUA bit */
2696     if (scsiCmnd->cdb[1] & SCSI_READ16_FUA_MASK)
2697       fis->d.device       = 0xC0;                   /* FIS FUA set */
2698     else
2699       fis->d.device       = 0x40;                   /* FIS FUA clear */
2700
2701     fis->d.lbaLowExp      = scsiCmnd->cdb[6];       /* FIS LBA (31:24) */
2702     fis->d.lbaMidExp      = scsiCmnd->cdb[5];       /* FIS LBA (39:32) */
2703     fis->d.lbaHighExp     = scsiCmnd->cdb[4];       /* FIS LBA (47:40) */
2704     fis->d.featuresExp    = scsiCmnd->cdb[12];      /* FIS sector count (15:8) */
2705     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
2706     fis->d.sectorCountExp = 0;
2707     fis->d.reserved4      = 0;
2708     fis->d.control        = 0;                      /* FIS HOB bit clear */
2709     fis->d.reserved5      = 0;
2710
2711     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_READ;
2712     satIOContext->ATACmd = SAT_READ_FPDMA_QUEUED;
2713   }
2714
2715   /* saves the current LBA and orginal TL */
2716   satIOContext->currentLBA = lba;
2717   satIOContext->OrgTL = tl;
2718
2719   /*
2720     computing number of loop and remainder for tl
2721     0xFF in case not ext
2722     0xFFFF in case EXT
2723   */
2724   if (fis->h.command == SAT_READ_SECTORS || fis->h.command == SAT_READ_DMA)
2725   {
2726     LoopNum = satComputeLoopNum(tl, 0xFF);
2727   }
2728   else if (fis->h.command == SAT_READ_SECTORS_EXT || fis->h.command == SAT_READ_DMA_EXT)
2729   {
2730     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
2731     LoopNum = satComputeLoopNum(tl, 0xFFFF);
2732   }
2733   else
2734   {
2735     /* SAT_READ_FPDMA_QUEUEDK */
2736     LoopNum = satComputeLoopNum(tl, 0xFFFF);
2737   }
2738   satIOContext->LoopNum = LoopNum;
2739
2740   if (LoopNum == 1)
2741   {
2742     TI_DBG5(("satRead16: NON CHAINED data\n"));
2743     satIOContext->satCompleteCB = &satNonChainedDataIOCB;
2744   }
2745   else
2746   {
2747     TI_DBG1(("satRead16: CHAINED data\n"));
2748     /* re-setting tl */
2749     if (fis->h.command == SAT_READ_SECTORS || fis->h.command == SAT_READ_DMA)
2750     {
2751        fis->d.sectorCount    = 0xFF;
2752     }
2753     else if (fis->h.command == SAT_READ_SECTORS_EXT || fis->h.command == SAT_READ_DMA_EXT)
2754     {
2755       /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
2756       fis->d.sectorCount    = 0xFF;
2757       fis->d.sectorCountExp = 0xFF;
2758     }
2759     else
2760     {
2761       /* SAT_READ_FPDMA_QUEUED */
2762       fis->h.features       = 0xFF;
2763       fis->d.featuresExp    = 0xFF;
2764     }
2765
2766     /* chained data */
2767     satIOContext->satCompleteCB = &satChainedDataIOCB;
2768   }
2769
2770   /*
2771    * Prepare SGL and send FIS to LL layer.
2772    */
2773   satIOContext->reqType = agRequestType;       /* Save it */
2774
2775   status = sataLLIOStart( tiRoot,
2776                           tiIORequest,
2777                           tiDeviceHandle,
2778                           tiScsiRequest,
2779                           satIOContext);
2780
2781   TI_DBG5(("satRead16: return\n"));
2782   return (status);
2783
2784 }
2785
2786 /*****************************************************************************/
2787 /*! \brief SAT implementation for SCSI READ6.
2788  *
2789  *  SAT implementation for SCSI READ6 and send FIS request to LL layer.
2790  *
2791  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
2792  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
2793  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
2794  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
2795  *  \param   satIOContext_t:   Pointer to the SAT IO Context
2796  *
2797  *  \return If command is started successfully
2798  *    - \e tiSuccess:     I/O request successfully initiated.
2799  *    - \e tiBusy:        No resources available, try again later.
2800  *    - \e tiIONoDevice:  Invalid device handle.
2801  *    - \e tiError:       Other errors.
2802  */
2803 /*****************************************************************************/
2804 GLOBAL bit32  satRead6(
2805                    tiRoot_t                  *tiRoot,
2806                    tiIORequest_t             *tiIORequest,
2807                    tiDeviceHandle_t          *tiDeviceHandle,
2808                    tiScsiInitiatorRequest_t *tiScsiRequest,
2809                    satIOContext_t            *satIOContext)
2810 {
2811
2812   bit32                     status;
2813   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
2814   satDeviceData_t           *pSatDevData;
2815   scsiRspSense_t            *pSense;
2816   tiIniScsiCmnd_t           *scsiCmnd;
2817   agsaFisRegHostToDevice_t  *fis;
2818   bit32                     lba = 0;
2819   bit16                     tl = 0;
2820
2821   pSense        = satIOContext->pSense;
2822   pSatDevData   = satIOContext->pSatDevData;
2823   scsiCmnd      = &tiScsiRequest->scsiCmnd;
2824   fis           = satIOContext->pFis;
2825
2826
2827    TI_DBG5(("satRead6: start\n"));
2828
2829   /* no FUA checking since read6 */
2830
2831
2832   /* checking CONTROL */
2833   /* NACA == 1 or LINK == 1*/
2834   if ( (scsiCmnd->cdb[5] & SCSI_NACA_MASK) || (scsiCmnd->cdb[5] & SCSI_LINK_MASK) )
2835   {
2836     satSetSensePayload( pSense,
2837                         SCSI_SNSKEY_ILLEGAL_REQUEST,
2838                         0,
2839                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
2840                         satIOContext);
2841
2842     ostiInitiatorIOCompleted( tiRoot,
2843                               tiIORequest,
2844                               tiIOSuccess,
2845                               SCSI_STAT_CHECK_CONDITION,
2846                               satIOContext->pTiSenseData,
2847                               satIOContext->interruptContext );
2848
2849     TI_DBG2(("satRead6: return control\n"));
2850     return tiSuccess;
2851   }
2852
2853   /* cbd6; computing LBA and transfer length */
2854   lba = (((scsiCmnd->cdb[1]) & 0x1f) << (8*2))
2855     + (scsiCmnd->cdb[2] << 8) + scsiCmnd->cdb[3];
2856   tl = scsiCmnd->cdb[4];
2857
2858
2859   /* Table 34, 9.1, p 46 */
2860   /*
2861     note: As of 2/10/2006, no support for DMA QUEUED
2862    */
2863
2864   /*
2865     Table 34, 9.1, p 46, b
2866     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
2867     return check condition
2868   */
2869   if (pSatDevData->satNCQ != agTRUE &&
2870       pSatDevData->sat48BitSupport != agTRUE
2871       )
2872   {
2873     if (lba > SAT_TR_LBA_LIMIT - 1)
2874     {
2875       satSetSensePayload( pSense,
2876                           SCSI_SNSKEY_ILLEGAL_REQUEST,
2877                           0,
2878                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
2879                           satIOContext);
2880
2881       ostiInitiatorIOCompleted( tiRoot,
2882                                 tiIORequest,
2883                                 tiIOSuccess,
2884                                 SCSI_STAT_CHECK_CONDITION,
2885                                 satIOContext->pTiSenseData,
2886                                 satIOContext->interruptContext );
2887
2888     TI_DBG1(("satRead6: return LBA out of range\n"));
2889     return tiSuccess;
2890     }
2891   }
2892
2893   /* case 1 and 2 */
2894   if (lba + tl <= SAT_TR_LBA_LIMIT)
2895   {
2896     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
2897     {
2898       /* case 2 */
2899       /* READ DMA*/
2900       TI_DBG5(("satRead6: case 2\n"));
2901
2902
2903       fis->h.fisType        = 0x27;                   /* Reg host to device */
2904       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2905       fis->h.command        = SAT_READ_DMA;           /* 0xC8 */
2906       fis->h.features       = 0;                      /* FIS reserve */
2907       fis->d.lbaLow         = scsiCmnd->cdb[3];       /* FIS LBA (7 :0 ) */
2908       fis->d.lbaMid         = scsiCmnd->cdb[2];       /* FIS LBA (15:8 ) */
2909       fis->d.lbaHigh        = (bit8)((scsiCmnd->cdb[1]) & 0x1f);       /* FIS LBA (23:16) */
2910       fis->d.device         = 0x40;                   /* FIS LBA mode  */
2911       fis->d.lbaLowExp      = 0;
2912       fis->d.lbaMidExp      = 0;
2913       fis->d.lbaHighExp     = 0;
2914       fis->d.featuresExp    = 0;
2915       if (tl == 0)
2916       {
2917         /* temporary fix */
2918         fis->d.sectorCount    = 0xff;                   /* FIS sector count (7:0) */
2919       }
2920       else
2921       {
2922         fis->d.sectorCount    = scsiCmnd->cdb[4];       /* FIS sector count (7:0) */
2923       }
2924       fis->d.sectorCountExp = 0;
2925       fis->d.reserved4      = 0;
2926       fis->d.control        = 0;                      /* FIS HOB bit clear */
2927       fis->d.reserved5      = 0;
2928
2929       agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
2930     }
2931     else
2932     {
2933       /* case 1 */
2934       /* READ SECTORS for easier implemetation */
2935       TI_DBG5(("satRead6: case 1\n"));
2936
2937       fis->h.fisType        = 0x27;                   /* Reg host to device */
2938       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2939       fis->h.command        = SAT_READ_SECTORS;       /* 0x20 */
2940       fis->h.features       = 0;                      /* FIS reserve */
2941       fis->d.lbaLow         = scsiCmnd->cdb[3];       /* FIS LBA (7 :0 ) */
2942       fis->d.lbaMid         = scsiCmnd->cdb[2];       /* FIS LBA (15:8 ) */
2943       fis->d.lbaHigh        = (bit8)((scsiCmnd->cdb[1]) & 0x1f);       /* FIS LBA (23:16) */
2944       fis->d.device         = 0x40;                   /* FIS LBA mode  */
2945       fis->d.lbaLowExp      = 0;
2946       fis->d.lbaMidExp      = 0;
2947       fis->d.lbaHighExp     = 0;
2948       fis->d.featuresExp    = 0;
2949       if (tl == 0)
2950       {
2951         /* temporary fix */
2952         fis->d.sectorCount    = 0xff;                   /* FIS sector count (7:0) */
2953       }
2954       else
2955       {
2956         fis->d.sectorCount    = scsiCmnd->cdb[4];       /* FIS sector count (7:0) */
2957       }
2958       fis->d.sectorCountExp = 0;
2959       fis->d.reserved4      = 0;
2960       fis->d.control        = 0;                      /* FIS HOB bit clear */
2961       fis->d.reserved5      = 0;
2962
2963       agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
2964
2965     }
2966   }
2967
2968   /* case 3 and 4 */
2969   if (pSatDevData->sat48BitSupport == agTRUE)
2970   {
2971     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
2972     {
2973       /* case 3 */
2974       /* READ DMA EXT only */
2975       TI_DBG5(("satRead6: case 3\n"));
2976       fis->h.fisType        = 0x27;                   /* Reg host to device */
2977       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
2978       fis->h.command        = SAT_READ_DMA_EXT;       /* 0x25 */
2979       fis->h.features       = 0;                      /* FIS reserve */
2980       fis->d.lbaLow         = scsiCmnd->cdb[3];       /* FIS LBA (7 :0 ) */
2981       fis->d.lbaMid         = scsiCmnd->cdb[2];       /* FIS LBA (15:8 ) */
2982       fis->d.lbaHigh        = (bit8)((scsiCmnd->cdb[1]) & 0x1f);       /* FIS LBA (23:16) */
2983       fis->d.device         = 0x40;                   /* FIS LBA mode set */
2984       fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
2985       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
2986       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
2987       fis->d.featuresExp    = 0;                      /* FIS reserve */
2988       if (tl == 0)
2989       {
2990         /* sector count is 256, 0x100*/
2991         fis->d.sectorCount    = 0;                         /* FIS sector count (7:0) */
2992         fis->d.sectorCountExp = 0x01;                      /* FIS sector count (15:8) */
2993       }
2994       else
2995       {
2996         fis->d.sectorCount    = scsiCmnd->cdb[4];       /* FIS sector count (7:0) */
2997         fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
2998       }
2999       fis->d.reserved4      = 0;
3000       fis->d.control        = 0;                      /* FIS HOB bit clear */
3001       fis->d.reserved5      = 0;
3002
3003       agRequestType = AGSA_SATA_PROTOCOL_DMA_READ;
3004     }
3005     else
3006     {
3007       /* case 4 */
3008       /* READ SECTORS EXT for easier implemetation */
3009       TI_DBG5(("satRead6: case 4\n"));
3010
3011       fis->h.fisType        = 0x27;                   /* Reg host to device */
3012       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
3013       fis->h.command        = SAT_READ_SECTORS_EXT;   /* 0x24 */
3014       fis->h.features       = 0;                      /* FIS reserve */
3015       fis->d.lbaLow         = scsiCmnd->cdb[3];       /* FIS LBA (7 :0 ) */
3016       fis->d.lbaMid         = scsiCmnd->cdb[2];       /* FIS LBA (15:8 ) */
3017       fis->d.lbaHigh        = (bit8)((scsiCmnd->cdb[1]) & 0x1f);       /* FIS LBA (23:16) */
3018       fis->d.device         = 0x40;                   /* FIS LBA mode set */
3019       fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
3020       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
3021       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
3022       fis->d.featuresExp    = 0;                      /* FIS reserve */
3023       if (tl == 0)
3024       {
3025         /* sector count is 256, 0x100*/
3026         fis->d.sectorCount    = 0;                         /* FIS sector count (7:0) */
3027         fis->d.sectorCountExp = 0x01;                      /* FIS sector count (15:8) */
3028       }
3029       else
3030       {
3031         fis->d.sectorCount    = scsiCmnd->cdb[4];       /* FIS sector count (7:0) */
3032         fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
3033       }
3034       fis->d.reserved4      = 0;
3035       fis->d.control        = 0;                      /* FIS HOB bit clear */
3036       fis->d.reserved5      = 0;
3037
3038       agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
3039     }
3040   }
3041
3042   /* case 5 */
3043   if (pSatDevData->satNCQ == agTRUE)
3044   {
3045     /* READ FPDMA QUEUED */
3046     if (pSatDevData->sat48BitSupport != agTRUE)
3047     {
3048       /* sanity check */
3049       TI_DBG5(("satRead6: case 5 !!! error NCQ but 28 bit address support \n"));
3050       satSetSensePayload( pSense,
3051                           SCSI_SNSKEY_ILLEGAL_REQUEST,
3052                           0,
3053                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
3054                           satIOContext);
3055
3056       ostiInitiatorIOCompleted( tiRoot,
3057                                 tiIORequest,
3058                                 tiIOSuccess,
3059                                 SCSI_STAT_CHECK_CONDITION,
3060                                 satIOContext->pTiSenseData,
3061                                 satIOContext->interruptContext );
3062       return tiSuccess;
3063     }
3064     TI_DBG5(("satRead6: case 5\n"));
3065
3066     /* Support 48-bit FPDMA addressing, use READ FPDMA QUEUE command */
3067
3068     fis->h.fisType        = 0x27;                   /* Reg host to device */
3069     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
3070     fis->h.command        = SAT_READ_FPDMA_QUEUED;  /* 0x60 */
3071     fis->d.lbaLow         = scsiCmnd->cdb[3];       /* FIS LBA (7 :0 ) */
3072     fis->d.lbaMid         = scsiCmnd->cdb[2];       /* FIS LBA (15:8 ) */
3073     fis->d.lbaHigh        = (bit8)((scsiCmnd->cdb[1]) & 0x1f);       /* FIS LBA (23:16) */
3074     fis->d.device         = 0x40;                   /* FIS FUA clear */
3075     fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
3076     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
3077     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
3078     if (tl == 0)
3079     {
3080       /* sector count is 256, 0x100*/
3081       fis->h.features       = 0;                         /* FIS sector count (7:0) */
3082       fis->d.featuresExp    = 0x01;                      /* FIS sector count (15:8) */
3083     }
3084     else
3085     {
3086       fis->h.features       = scsiCmnd->cdb[4];       /* FIS sector count (7:0) */
3087       fis->d.featuresExp    = 0;                      /* FIS sector count (15:8) */
3088     }
3089     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
3090     fis->d.sectorCountExp = 0;
3091     fis->d.reserved4      = 0;
3092     fis->d.control        = 0;                      /* FIS HOB bit clear */
3093     fis->d.reserved5      = 0;
3094
3095     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_READ;
3096   }
3097
3098    /* Initialize CB for SATA completion.
3099    */
3100   satIOContext->satCompleteCB = &satNonChainedDataIOCB;
3101
3102   /*
3103    * Prepare SGL and send FIS to LL layer.
3104    */
3105   satIOContext->reqType = agRequestType;       /* Save it */
3106
3107   status = sataLLIOStart( tiRoot,
3108                           tiIORequest,
3109                           tiDeviceHandle,
3110                           tiScsiRequest,
3111                           satIOContext);
3112   return (status);
3113
3114 }
3115
3116 /*****************************************************************************/
3117 /*! \brief SAT implementation for SCSI WRITE16.
3118  *
3119  *  SAT implementation for SCSI WRITE16 and send FIS request to LL layer.
3120  *
3121  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
3122  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
3123  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
3124  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
3125  *  \param   satIOContext_t:   Pointer to the SAT IO Context
3126  *
3127  *  \return If command is started successfully
3128  *    - \e tiSuccess:     I/O request successfully initiated.
3129  *    - \e tiBusy:        No resources available, try again later.
3130  *    - \e tiIONoDevice:  Invalid device handle.
3131  *    - \e tiError:       Other errors.
3132  */
3133 /*****************************************************************************/
3134 GLOBAL bit32  satWrite16(
3135                    tiRoot_t                  *tiRoot,
3136                    tiIORequest_t             *tiIORequest,
3137                    tiDeviceHandle_t          *tiDeviceHandle,
3138                    tiScsiInitiatorRequest_t *tiScsiRequest,
3139                    satIOContext_t            *satIOContext)
3140 {
3141   bit32                     status;
3142   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
3143   satDeviceData_t           *pSatDevData;
3144   scsiRspSense_t            *pSense;
3145   tiIniScsiCmnd_t           *scsiCmnd;
3146   agsaFisRegHostToDevice_t  *fis;
3147   bit32                     lba = 0;
3148   bit32                     tl = 0;
3149   bit32                     LoopNum = 1;
3150   bit8                      LBA[8];
3151   bit8                      TL[8];
3152   bit32                     rangeChk = agFALSE; /* lba and tl range check */
3153   bit32                     limitChk = agFALSE; /* lba and tl range check */
3154
3155   pSense        = satIOContext->pSense;
3156   pSatDevData   = satIOContext->pSatDevData;
3157   scsiCmnd      = &tiScsiRequest->scsiCmnd;
3158   fis           = satIOContext->pFis;
3159
3160   TI_DBG5(("satWrite16: start\n"));
3161
3162   /* checking FUA_NV */
3163   if (scsiCmnd->cdb[1] & SCSI_FUA_NV_MASK)
3164   {
3165     satSetSensePayload( pSense,
3166                         SCSI_SNSKEY_ILLEGAL_REQUEST,
3167                         0,
3168                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
3169                         satIOContext);
3170
3171     ostiInitiatorIOCompleted( tiRoot,
3172                               tiIORequest,
3173                               tiIOSuccess,
3174                               SCSI_STAT_CHECK_CONDITION,
3175                               satIOContext->pTiSenseData,
3176                               satIOContext->interruptContext );
3177
3178     TI_DBG1(("satWrite16: return FUA_NV\n"));
3179     return tiSuccess;
3180
3181   }
3182
3183   /* checking CONTROL */
3184   /* NACA == 1 or LINK == 1*/
3185   if ( (scsiCmnd->cdb[15] & SCSI_NACA_MASK) || (scsiCmnd->cdb[15] & SCSI_LINK_MASK) )
3186   {
3187     satSetSensePayload( pSense,
3188                         SCSI_SNSKEY_ILLEGAL_REQUEST,
3189                         0,
3190                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
3191                         satIOContext);
3192
3193     ostiInitiatorIOCompleted( tiRoot,
3194                               tiIORequest,
3195                               tiIOSuccess,
3196                               SCSI_STAT_CHECK_CONDITION,
3197                               satIOContext->pTiSenseData,
3198                               satIOContext->interruptContext );
3199
3200     TI_DBG1(("satWrite16: return control\n"));
3201     return tiSuccess;
3202   }
3203
3204
3205   osti_memset(LBA, 0, sizeof(LBA));
3206   osti_memset(TL, 0, sizeof(TL));
3207
3208
3209   /* do not use memcpy due to indexing in LBA and TL */
3210   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
3211   LBA[1] = scsiCmnd->cdb[3];
3212   LBA[2] = scsiCmnd->cdb[4];
3213   LBA[3] = scsiCmnd->cdb[5];
3214   LBA[4] = scsiCmnd->cdb[6];
3215   LBA[5] = scsiCmnd->cdb[7];
3216   LBA[6] = scsiCmnd->cdb[8];
3217   LBA[7] = scsiCmnd->cdb[9];  /* LSB */
3218
3219   TL[0] = 0;
3220   TL[1] = 0;
3221   TL[2] = 0;
3222   TL[3] = 0;
3223   TL[4] = scsiCmnd->cdb[10];   /* MSB */
3224   TL[5] = scsiCmnd->cdb[11];
3225   TL[6] = scsiCmnd->cdb[12];
3226   TL[7] = scsiCmnd->cdb[13];   /* LSB */
3227
3228   rangeChk = satAddNComparebit64(LBA, TL);
3229
3230   limitChk = satCompareLBALimitbit(LBA);
3231
3232   lba = satComputeCDB16LBA(satIOContext);
3233   tl = satComputeCDB16TL(satIOContext);
3234
3235
3236
3237   /* Table 34, 9.1, p 46 */
3238   /*
3239     note: As of 2/10/2006, no support for DMA QUEUED
3240   */
3241
3242   /*
3243     Table 34, 9.1, p 46, b
3244     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
3245     return check condition
3246   */
3247   if (pSatDevData->satNCQ != agTRUE &&
3248      pSatDevData->sat48BitSupport != agTRUE
3249      )
3250   {
3251     if (limitChk)
3252     {
3253       TI_DBG1(("satWrite16: return LBA out of range, not EXT\n"));
3254       satSetSensePayload( pSense,
3255                           SCSI_SNSKEY_ILLEGAL_REQUEST,
3256                           0,
3257                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
3258                           satIOContext);
3259
3260       ostiInitiatorIOCompleted( tiRoot,
3261                                 tiIORequest,
3262                                 tiIOSuccess,
3263                                 SCSI_STAT_CHECK_CONDITION,
3264                                 satIOContext->pTiSenseData,
3265                                 satIOContext->interruptContext );
3266
3267     return tiSuccess;
3268     }
3269     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
3270     {
3271       TI_DBG1(("satWrite16: return LBA+TL out of range, not EXT\n"));
3272       satSetSensePayload( pSense,
3273                           SCSI_SNSKEY_ILLEGAL_REQUEST,
3274                           0,
3275                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
3276                           satIOContext);
3277
3278       ostiInitiatorIOCompleted( tiRoot,
3279                                 tiIORequest,
3280                                 tiIOSuccess,
3281                                 SCSI_STAT_CHECK_CONDITION,
3282                                 satIOContext->pTiSenseData,
3283                                 satIOContext->interruptContext );
3284
3285     return tiSuccess;
3286     }
3287   }
3288
3289   /* case 1 and 2 */
3290   if (!rangeChk) //  if (lba + tl <= SAT_TR_LBA_LIMIT)
3291   {
3292     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
3293     {
3294       /* case 2 */
3295       /* WRITE DMA*/
3296       /* In case that we can't fit the transfer length, we loop */
3297       TI_DBG5(("satWrite16: case 2\n"));
3298       fis->h.fisType        = 0x27;                   /* Reg host to device */
3299       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
3300       fis->h.command        = SAT_WRITE_DMA;          /* 0xCA */
3301       fis->h.features       = 0;                      /* FIS reserve */
3302       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
3303       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
3304       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
3305
3306       /* FIS LBA mode set LBA (27:24) */
3307       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[6] & 0xF));
3308
3309       fis->d.lbaLowExp      = 0;
3310       fis->d.lbaMidExp      = 0;
3311       fis->d.lbaHighExp     = 0;
3312       fis->d.featuresExp    = 0;
3313       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
3314       fis->d.sectorCountExp = 0;
3315       fis->d.reserved4      = 0;
3316       fis->d.control        = 0;                      /* FIS HOB bit clear */
3317       fis->d.reserved5      = 0;
3318
3319       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
3320       satIOContext->ATACmd = SAT_WRITE_DMA;
3321     }
3322     else
3323     {
3324       /* case 1 */
3325       /* WRITE MULTIPLE or WRITE SECTOR(S) */
3326       /* WRITE SECTORS for easier implemetation */
3327       /* In case that we can't fit the transfer length, we loop */
3328       TI_DBG5(("satWrite16: case 1\n"));
3329       fis->h.fisType        = 0x27;                   /* Reg host to device */
3330       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
3331       fis->h.command        = SAT_WRITE_SECTORS;      /* 0x30 */
3332       fis->h.features       = 0;                      /* FIS reserve */
3333       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
3334       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
3335       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
3336
3337       /* FIS LBA mode set LBA (27:24) */
3338       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[6] & 0xF));
3339
3340       fis->d.lbaLowExp      = 0;
3341       fis->d.lbaMidExp      = 0;
3342       fis->d.lbaHighExp     = 0;
3343       fis->d.featuresExp    = 0;
3344       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
3345       fis->d.sectorCountExp = 0;
3346       fis->d.reserved4      = 0;
3347       fis->d.control        = 0;                      /* FIS HOB bit clear */
3348       fis->d.reserved5      = 0;
3349
3350       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
3351       satIOContext->ATACmd = SAT_WRITE_SECTORS;
3352     }
3353   }
3354
3355   /* case 3 and 4 */
3356   if (pSatDevData->sat48BitSupport == agTRUE)
3357   {
3358     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
3359     {
3360       /* case 3 */
3361       /* WRITE DMA EXT or WRITE DMA FUA EXT */
3362       TI_DBG5(("satWrite16: case 3\n"));
3363       fis->h.fisType        = 0x27;                   /* Reg host to device */
3364       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
3365
3366       /* SAT_WRITE_DMA_FUA_EXT is optional and we don't support it */
3367       fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x35 */
3368
3369       fis->h.features       = 0;                      /* FIS reserve */
3370       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
3371       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
3372       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
3373       fis->d.device         = 0x40;                   /* FIS LBA mode set */
3374       fis->d.lbaLowExp      = scsiCmnd->cdb[6];       /* FIS LBA (31:24) */
3375       fis->d.lbaMidExp      = scsiCmnd->cdb[5];       /* FIS LBA (39:32) */
3376       fis->d.lbaHighExp     = scsiCmnd->cdb[4];       /* FIS LBA (47:40) */
3377       fis->d.featuresExp    = 0;                      /* FIS reserve */
3378       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
3379       fis->d.sectorCountExp = scsiCmnd->cdb[12];       /* FIS sector count (15:8) */
3380       fis->d.reserved4      = 0;
3381       fis->d.control        = 0;                      /* FIS HOB bit clear */
3382       fis->d.reserved5      = 0;
3383
3384       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
3385       satIOContext->ATACmd = SAT_WRITE_DMA_EXT;
3386     }
3387     else
3388     {
3389       /* case 4 */
3390       /* WRITE MULTIPLE EXT or WRITE MULTIPLE FUA EXT or WRITE SECTOR(S) EXT */
3391       /* WRITE SECTORS EXT for easier implemetation */
3392       TI_DBG5(("satWrite16: case 4\n"));
3393       fis->h.fisType        = 0x27;                   /* Reg host to device */
3394       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
3395       fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
3396
3397       fis->h.features       = 0;                      /* FIS reserve */
3398       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
3399       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
3400       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
3401       fis->d.device         = 0x40;                   /* FIS LBA mode set */
3402       fis->d.lbaLowExp      = scsiCmnd->cdb[6];       /* FIS LBA (31:24) */
3403       fis->d.lbaMidExp      = scsiCmnd->cdb[5];       /* FIS LBA (39:32) */
3404       fis->d.lbaHighExp     = scsiCmnd->cdb[4];       /* FIS LBA (47:40) */
3405       fis->d.featuresExp    = 0;                      /* FIS reserve */
3406       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
3407       fis->d.sectorCountExp = scsiCmnd->cdb[12];       /* FIS sector count (15:8) */
3408       fis->d.reserved4      = 0;
3409       fis->d.control        = 0;                      /* FIS HOB bit clear */
3410       fis->d.reserved5      = 0;
3411
3412       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
3413       satIOContext->ATACmd = SAT_WRITE_SECTORS_EXT;
3414     }
3415   }
3416
3417   /* case 5 */
3418   if (pSatDevData->satNCQ == agTRUE)
3419   {
3420     /* WRITE FPDMA QUEUED */
3421     if (pSatDevData->sat48BitSupport != agTRUE)
3422     {
3423       TI_DBG5(("satWrite16: case 5 !!! error NCQ but 28 bit address support \n"));
3424       satSetSensePayload( pSense,
3425                           SCSI_SNSKEY_ILLEGAL_REQUEST,
3426                           0,
3427                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
3428                           satIOContext);
3429
3430       ostiInitiatorIOCompleted( tiRoot,
3431                                 tiIORequest,
3432                                 tiIOSuccess,
3433                                 SCSI_STAT_CHECK_CONDITION,
3434                                 satIOContext->pTiSenseData,
3435                                 satIOContext->interruptContext );
3436       return tiSuccess;
3437     }
3438     TI_DBG6(("satWrite16: case 5\n"));
3439
3440     /* Support 48-bit FPDMA addressing, use WRITE FPDMA QUEUE command */
3441
3442     fis->h.fisType        = 0x27;                   /* Reg host to device */
3443     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
3444     fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
3445     fis->h.features       = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
3446     fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
3447     fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
3448     fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
3449
3450     /* Check FUA bit */
3451     if (scsiCmnd->cdb[1] & SCSI_WRITE16_FUA_MASK)
3452       fis->d.device       = 0xC0;                   /* FIS FUA set */
3453     else
3454       fis->d.device       = 0x40;                   /* FIS FUA clear */
3455
3456     fis->d.lbaLowExp      = scsiCmnd->cdb[6];       /* FIS LBA (31:24) */
3457     fis->d.lbaMidExp      = scsiCmnd->cdb[5];       /* FIS LBA (39:32) */
3458     fis->d.lbaHighExp     = scsiCmnd->cdb[4];       /* FIS LBA (47:40) */
3459     fis->d.featuresExp    = scsiCmnd->cdb[12];       /* FIS sector count (15:8) */
3460     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
3461     fis->d.sectorCountExp = 0;
3462     fis->d.reserved4      = 0;
3463     fis->d.control        = 0;                      /* FIS HOB bit clear */
3464     fis->d.reserved5      = 0;
3465
3466     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
3467     satIOContext->ATACmd = SAT_WRITE_FPDMA_QUEUED;
3468   }
3469
3470   satIOContext->currentLBA = lba;
3471   satIOContext->OrgTL = tl;
3472
3473   /*
3474     computing number of loop and remainder for tl
3475     0xFF in case not ext
3476     0xFFFF in case EXT
3477   */
3478   if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
3479   {
3480     LoopNum = satComputeLoopNum(tl, 0xFF);
3481   }
3482   else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
3483            fis->h.command == SAT_WRITE_DMA_EXT     ||
3484            fis->h.command == SAT_WRITE_DMA_FUA_EXT
3485            )
3486   {
3487     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
3488     LoopNum = satComputeLoopNum(tl, 0xFFFF);
3489   }
3490   else
3491   {
3492     /* SAT_WRITE_FPDMA_QUEUEDK */
3493     LoopNum = satComputeLoopNum(tl, 0xFFFF);
3494   }
3495
3496   satIOContext->LoopNum = LoopNum;
3497
3498
3499   if (LoopNum == 1)
3500   {
3501     TI_DBG5(("satWrite16: NON CHAINED data\n"));
3502     /* Initialize CB for SATA completion.
3503      */
3504     satIOContext->satCompleteCB = &satNonChainedDataIOCB;
3505   }
3506   else
3507   {
3508     TI_DBG1(("satWrite16: CHAINED data\n"));
3509     /* re-setting tl */
3510     if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
3511     {
3512        fis->d.sectorCount    = 0xFF;
3513     }
3514     else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
3515              fis->h.command == SAT_WRITE_DMA_EXT ||
3516              fis->h.command == SAT_WRITE_DMA_FUA_EXT
3517              )
3518     {
3519       fis->d.sectorCount    = 0xFF;
3520       fis->d.sectorCountExp = 0xFF;
3521     }
3522     else
3523     {
3524       /* SAT_WRITE_FPDMA_QUEUED */
3525       fis->h.features       = 0xFF;
3526       fis->d.featuresExp    = 0xFF;
3527     }
3528
3529     /* Initialize CB for SATA completion.
3530      */
3531     satIOContext->satCompleteCB = &satChainedDataIOCB;
3532   }
3533
3534
3535   /*
3536    * Prepare SGL and send FIS to LL layer.
3537    */
3538   satIOContext->reqType = agRequestType;       /* Save it */
3539
3540   status = sataLLIOStart( tiRoot,
3541                           tiIORequest,
3542                           tiDeviceHandle,
3543                           tiScsiRequest,
3544                           satIOContext);
3545   return (status);
3546 }
3547
3548 /*****************************************************************************/
3549 /*! \brief SAT implementation for SCSI WRITE12.
3550  *
3551  *  SAT implementation for SCSI WRITE12 and send FIS request to LL layer.
3552  *
3553  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
3554  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
3555  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
3556  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
3557  *  \param   satIOContext_t:   Pointer to the SAT IO Context
3558  *
3559  *  \return If command is started successfully
3560  *    - \e tiSuccess:     I/O request successfully initiated.
3561  *    - \e tiBusy:        No resources available, try again later.
3562  *    - \e tiIONoDevice:  Invalid device handle.
3563  *    - \e tiError:       Other errors.
3564  */
3565 /*****************************************************************************/
3566 GLOBAL bit32  satWrite12(
3567                    tiRoot_t                  *tiRoot,
3568                    tiIORequest_t             *tiIORequest,
3569                    tiDeviceHandle_t          *tiDeviceHandle,
3570                    tiScsiInitiatorRequest_t *tiScsiRequest,
3571                    satIOContext_t            *satIOContext)
3572 {
3573   bit32                     status;
3574   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
3575   satDeviceData_t           *pSatDevData;
3576   scsiRspSense_t            *pSense;
3577   tiIniScsiCmnd_t           *scsiCmnd;
3578   agsaFisRegHostToDevice_t  *fis;
3579   bit32                     lba = 0;
3580   bit32                     tl = 0;
3581   bit32                     LoopNum = 1;
3582   bit8                      LBA[4];
3583   bit8                      TL[4];
3584   bit32                     rangeChk = agFALSE; /* lba and tl range check */
3585
3586   pSense        = satIOContext->pSense;
3587   pSatDevData   = satIOContext->pSatDevData;
3588   scsiCmnd      = &tiScsiRequest->scsiCmnd;
3589   fis           = satIOContext->pFis;
3590
3591   TI_DBG5(("satWrite12: start\n"));
3592
3593   /* checking FUA_NV */
3594   if (scsiCmnd->cdb[1] & SCSI_FUA_NV_MASK)
3595   {
3596     satSetSensePayload( pSense,
3597                         SCSI_SNSKEY_ILLEGAL_REQUEST,
3598                         0,
3599                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
3600                         satIOContext);
3601
3602     ostiInitiatorIOCompleted( tiRoot,
3603                               tiIORequest,
3604                               tiIOSuccess,
3605                               SCSI_STAT_CHECK_CONDITION,
3606                               satIOContext->pTiSenseData,
3607                               satIOContext->interruptContext );
3608
3609     TI_DBG1(("satWrite12: return FUA_NV\n"));
3610     return tiSuccess;
3611
3612   }
3613
3614
3615   /* checking CONTROL */
3616   /* NACA == 1 or LINK == 1*/
3617   if ( (scsiCmnd->cdb[11] & SCSI_NACA_MASK) || (scsiCmnd->cdb[11] & SCSI_LINK_MASK) )
3618   {
3619     satSetSensePayload( pSense,
3620                         SCSI_SNSKEY_ILLEGAL_REQUEST,
3621                         0,
3622                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
3623                         satIOContext);
3624
3625     ostiInitiatorIOCompleted( tiRoot,
3626                               tiIORequest,
3627                               tiIOSuccess,
3628                               SCSI_STAT_CHECK_CONDITION,
3629                               satIOContext->pTiSenseData,
3630                               satIOContext->interruptContext );
3631
3632     TI_DBG1(("satWrite12: return control\n"));
3633     return tiSuccess;
3634   }
3635
3636
3637   osti_memset(LBA, 0, sizeof(LBA));
3638   osti_memset(TL, 0, sizeof(TL));
3639
3640   /* do not use memcpy due to indexing in LBA and TL */
3641   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
3642   LBA[1] = scsiCmnd->cdb[3];
3643   LBA[2] = scsiCmnd->cdb[4];
3644   LBA[3] = scsiCmnd->cdb[5];  /* LSB */
3645
3646   TL[0] = scsiCmnd->cdb[6];   /* MSB */
3647   TL[1] = scsiCmnd->cdb[7];
3648   TL[2] = scsiCmnd->cdb[8];
3649   TL[3] = scsiCmnd->cdb[9];   /* LSB */
3650
3651   rangeChk = satAddNComparebit32(LBA, TL);
3652
3653   lba = satComputeCDB12LBA(satIOContext);
3654   tl = satComputeCDB12TL(satIOContext);
3655
3656
3657   /* Table 34, 9.1, p 46 */
3658   /*
3659     note: As of 2/10/2006, no support for DMA QUEUED
3660    */
3661
3662   /*
3663     Table 34, 9.1, p 46, b
3664     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
3665     return check condition
3666   */
3667   if (pSatDevData->satNCQ != agTRUE &&
3668       pSatDevData->sat48BitSupport != agTRUE
3669       )
3670   {
3671     if (lba > SAT_TR_LBA_LIMIT - 1)
3672     {
3673       satSetSensePayload( pSense,
3674                           SCSI_SNSKEY_ILLEGAL_REQUEST,
3675                           0,
3676                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
3677                           satIOContext);
3678
3679       ostiInitiatorIOCompleted( tiRoot,
3680                                 tiIORequest,
3681                                 tiIOSuccess,
3682                                 SCSI_STAT_CHECK_CONDITION,
3683                                 satIOContext->pTiSenseData,
3684                                 satIOContext->interruptContext );
3685
3686     TI_DBG1(("satWrite12: return LBA out of range, not EXT\n"));
3687     return tiSuccess;
3688     }
3689
3690     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
3691     {
3692       TI_DBG1(("satWrite12: return LBA+TL out of range, not EXT\n"));
3693       satSetSensePayload( pSense,
3694                           SCSI_SNSKEY_ILLEGAL_REQUEST,
3695                           0,
3696                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
3697                           satIOContext);
3698
3699       ostiInitiatorIOCompleted( tiRoot,
3700                                 tiIORequest,
3701                                 tiIOSuccess,
3702                                 SCSI_STAT_CHECK_CONDITION,
3703                                 satIOContext->pTiSenseData,
3704                                 satIOContext->interruptContext );
3705
3706     return tiSuccess;
3707     }
3708   }
3709
3710
3711   /* case 1 and 2 */
3712   if (!rangeChk) //  if (lba + tl <= SAT_TR_LBA_LIMIT)
3713   {
3714     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
3715     {
3716       /* case 2 */
3717       /* WRITE DMA*/
3718       /* In case that we can't fit the transfer length, we loop */
3719       TI_DBG5(("satWrite12: case 2\n"));
3720       fis->h.fisType        = 0x27;                   /* Reg host to device */
3721       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
3722       fis->h.command        = SAT_WRITE_DMA;          /* 0xCA */
3723       fis->h.features       = 0;                      /* FIS reserve */
3724       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
3725       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
3726       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
3727
3728       /* FIS LBA mode set LBA (27:24) */
3729       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));
3730
3731       fis->d.lbaLowExp      = 0;
3732       fis->d.lbaMidExp      = 0;
3733       fis->d.lbaHighExp     = 0;
3734       fis->d.featuresExp    = 0;
3735       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
3736       fis->d.sectorCountExp = 0;
3737       fis->d.reserved4      = 0;
3738       fis->d.control        = 0;                      /* FIS HOB bit clear */
3739       fis->d.reserved5      = 0;
3740
3741       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
3742       satIOContext->ATACmd = SAT_WRITE_DMA;
3743     }
3744     else
3745     {
3746       /* case 1 */
3747       /* WRITE MULTIPLE or WRITE SECTOR(S) */
3748       /* WRITE SECTORS for easier implemetation */
3749       /* In case that we can't fit the transfer length, we loop */
3750       TI_DBG5(("satWrite12: case 1\n"));
3751       fis->h.fisType        = 0x27;                   /* Reg host to device */
3752       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
3753       fis->h.command        = SAT_WRITE_SECTORS;      /* 0x30 */
3754       fis->h.features       = 0;                      /* FIS reserve */
3755       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
3756       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
3757       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
3758
3759       /* FIS LBA mode set LBA (27:24) */
3760       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));
3761
3762       fis->d.lbaLowExp      = 0;
3763       fis->d.lbaMidExp      = 0;
3764       fis->d.lbaHighExp     = 0;
3765       fis->d.featuresExp    = 0;
3766       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
3767       fis->d.sectorCountExp = 0;
3768       fis->d.reserved4      = 0;
3769       fis->d.control        = 0;                      /* FIS HOB bit clear */
3770       fis->d.reserved5      = 0;
3771
3772       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
3773       satIOContext->ATACmd = SAT_WRITE_SECTORS;
3774     }
3775   }
3776
3777   /* case 3 and 4 */
3778   if (pSatDevData->sat48BitSupport == agTRUE)
3779   {
3780     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
3781     {
3782       /* case 3 */
3783       /* WRITE DMA EXT or WRITE DMA FUA EXT */
3784       TI_DBG5(("satWrite12: case 3\n"));
3785       fis->h.fisType        = 0x27;                   /* Reg host to device */
3786       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
3787
3788       /* SAT_WRITE_DMA_FUA_EXT is optional and we don't support it */
3789       fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x35 */
3790
3791       fis->h.features       = 0;                      /* FIS reserve */
3792       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
3793       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
3794       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
3795       fis->d.device         = 0x40;                   /* FIS LBA mode set */
3796       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
3797       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
3798       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
3799       fis->d.featuresExp    = 0;                      /* FIS reserve */
3800       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
3801       fis->d.sectorCountExp = scsiCmnd->cdb[8];       /* FIS sector count (15:8) */
3802       fis->d.reserved4      = 0;
3803       fis->d.control        = 0;                      /* FIS HOB bit clear */
3804       fis->d.reserved5      = 0;
3805
3806       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
3807       satIOContext->ATACmd = SAT_WRITE_DMA_EXT;
3808     }
3809     else
3810     {
3811       /* case 4 */
3812       /* WRITE MULTIPLE EXT or WRITE MULTIPLE FUA EXT or WRITE SECTOR(S) EXT */
3813       /* WRITE SECTORS EXT for easier implemetation */
3814       TI_DBG5(("satWrite12: case 4\n"));
3815       fis->h.fisType        = 0x27;                   /* Reg host to device */
3816       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
3817       fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
3818
3819       fis->h.features       = 0;                      /* FIS reserve */
3820       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
3821       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
3822       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
3823       fis->d.device         = 0x40;                   /* FIS LBA mode set */
3824       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
3825       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
3826       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
3827       fis->d.featuresExp    = 0;                      /* FIS reserve */
3828       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
3829       fis->d.sectorCountExp = scsiCmnd->cdb[8];       /* FIS sector count (15:8) */
3830       fis->d.reserved4      = 0;
3831       fis->d.control        = 0;                      /* FIS HOB bit clear */
3832       fis->d.reserved5      = 0;
3833
3834       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
3835       satIOContext->ATACmd = SAT_WRITE_SECTORS_EXT;
3836     }
3837   }
3838
3839   /* case 5 */
3840   if (pSatDevData->satNCQ == agTRUE)
3841   {
3842     /* WRITE FPDMA QUEUED */
3843     if (pSatDevData->sat48BitSupport != agTRUE)
3844     {
3845       TI_DBG5(("satWrite12: case 5 !!! error NCQ but 28 bit address support \n"));
3846        satSetSensePayload( pSense,
3847                           SCSI_SNSKEY_ILLEGAL_REQUEST,
3848                           0,
3849                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
3850                           satIOContext);
3851
3852       ostiInitiatorIOCompleted( tiRoot,
3853                                 tiIORequest,
3854                                 tiIOSuccess,
3855                                 SCSI_STAT_CHECK_CONDITION,
3856                                 satIOContext->pTiSenseData,
3857                                 satIOContext->interruptContext );
3858       return tiSuccess;
3859     }
3860     TI_DBG6(("satWrite12: case 5\n"));
3861
3862     /* Support 48-bit FPDMA addressing, use WRITE FPDMA QUEUE command */
3863
3864     fis->h.fisType        = 0x27;                   /* Reg host to device */
3865     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
3866     fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
3867     fis->h.features       = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
3868     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
3869     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
3870     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
3871
3872     /* Check FUA bit */
3873     if (scsiCmnd->cdb[1] & SCSI_WRITE12_FUA_MASK)
3874       fis->d.device       = 0xC0;                   /* FIS FUA set */
3875     else
3876       fis->d.device       = 0x40;                   /* FIS FUA clear */
3877
3878     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
3879     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
3880     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
3881     fis->d.featuresExp    = scsiCmnd->cdb[8];       /* FIS sector count (15:8) */
3882     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
3883     fis->d.sectorCountExp = 0;
3884     fis->d.reserved4      = 0;
3885     fis->d.control        = 0;                      /* FIS HOB bit clear */
3886     fis->d.reserved5      = 0;
3887
3888     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
3889     satIOContext->ATACmd = SAT_WRITE_FPDMA_QUEUED;
3890   }
3891
3892   satIOContext->currentLBA = lba;
3893   satIOContext->OrgTL = tl;
3894
3895   /*
3896     computing number of loop and remainder for tl
3897     0xFF in case not ext
3898     0xFFFF in case EXT
3899   */
3900   if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
3901   {
3902     LoopNum = satComputeLoopNum(tl, 0xFF);
3903   }
3904   else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
3905            fis->h.command == SAT_WRITE_DMA_EXT     ||
3906            fis->h.command == SAT_WRITE_DMA_FUA_EXT
3907            )
3908   {
3909     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
3910     LoopNum = satComputeLoopNum(tl, 0xFFFF);
3911   }
3912   else
3913   {
3914     /* SAT_WRITE_FPDMA_QUEUEDK */
3915     LoopNum = satComputeLoopNum(tl, 0xFFFF);
3916   }
3917
3918   satIOContext->LoopNum = LoopNum;
3919
3920
3921   if (LoopNum == 1)
3922   {
3923     TI_DBG5(("satWrite12: NON CHAINED data\n"));
3924     /* Initialize CB for SATA completion.
3925      */
3926     satIOContext->satCompleteCB = &satNonChainedDataIOCB;
3927   }
3928   else
3929   {
3930     TI_DBG1(("satWrite12: CHAINED data\n"));
3931     /* re-setting tl */
3932     if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
3933     {
3934        fis->d.sectorCount    = 0xFF;
3935     }
3936     else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
3937              fis->h.command == SAT_WRITE_DMA_EXT ||
3938              fis->h.command == SAT_WRITE_DMA_FUA_EXT
3939              )
3940     {
3941       fis->d.sectorCount    = 0xFF;
3942       fis->d.sectorCountExp = 0xFF;
3943     }
3944     else
3945     {
3946       /* SAT_WRITE_FPDMA_QUEUED */
3947       fis->h.features       = 0xFF;
3948       fis->d.featuresExp    = 0xFF;
3949     }
3950
3951     /* Initialize CB for SATA completion.
3952      */
3953     satIOContext->satCompleteCB = &satChainedDataIOCB;
3954   }
3955
3956
3957   /*
3958    * Prepare SGL and send FIS to LL layer.
3959    */
3960   satIOContext->reqType = agRequestType;       /* Save it */
3961
3962   status = sataLLIOStart( tiRoot,
3963                           tiIORequest,
3964                           tiDeviceHandle,
3965                           tiScsiRequest,
3966                           satIOContext);
3967   return (status);
3968 }
3969
3970 /*****************************************************************************/
3971 /*! \brief SAT implementation for SCSI WRITE10.
3972  *
3973  *  SAT implementation for SCSI WRITE10 and send FIS request to LL layer.
3974  *
3975  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
3976  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
3977  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
3978  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
3979  *  \param   satIOContext_t:   Pointer to the SAT IO Context
3980  *
3981  *  \return If command is started successfully
3982  *    - \e tiSuccess:     I/O request successfully initiated.
3983  *    - \e tiBusy:        No resources available, try again later.
3984  *    - \e tiIONoDevice:  Invalid device handle.
3985  *    - \e tiError:       Other errors.
3986  */
3987 /*****************************************************************************/
3988 GLOBAL bit32  satWrite10(
3989                    tiRoot_t                  *tiRoot,
3990                    tiIORequest_t             *tiIORequest,
3991                    tiDeviceHandle_t          *tiDeviceHandle,
3992                    tiScsiInitiatorRequest_t *tiScsiRequest,
3993                    satIOContext_t            *satIOContext)
3994 {
3995
3996   bit32                     status;
3997   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
3998   satDeviceData_t           *pSatDevData;
3999   scsiRspSense_t            *pSense;
4000   tiIniScsiCmnd_t           *scsiCmnd;
4001   agsaFisRegHostToDevice_t  *fis;
4002   bit32                     lba = 0;
4003   bit32                     tl = 0;
4004   bit32                     LoopNum = 1;
4005   bit8                      LBA[4];
4006   bit8                      TL[4];
4007   bit32                     rangeChk = agFALSE; /* lba and tl range check */
4008
4009   pSense        = satIOContext->pSense;
4010   pSatDevData   = satIOContext->pSatDevData;
4011   scsiCmnd      = &tiScsiRequest->scsiCmnd;
4012   fis           = satIOContext->pFis;
4013
4014   TI_DBG5(("satWrite10: start\n"));
4015
4016   /* checking FUA_NV */
4017   if (scsiCmnd->cdb[1] & SCSI_FUA_NV_MASK)
4018   {
4019     satSetSensePayload( pSense,
4020                         SCSI_SNSKEY_ILLEGAL_REQUEST,
4021                         0,
4022                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
4023                         satIOContext);
4024
4025     ostiInitiatorIOCompleted( tiRoot,
4026                               tiIORequest,
4027                               tiIOSuccess,
4028                               SCSI_STAT_CHECK_CONDITION,
4029                               satIOContext->pTiSenseData,
4030                               satIOContext->interruptContext );
4031
4032     TI_DBG1(("satWrite10: return FUA_NV\n"));
4033     return tiSuccess;
4034
4035   }
4036
4037   /* checking CONTROL */
4038   /* NACA == 1 or LINK == 1*/
4039   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
4040   {
4041     satSetSensePayload( pSense,
4042                         SCSI_SNSKEY_ILLEGAL_REQUEST,
4043                         0,
4044                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
4045                         satIOContext);
4046
4047     ostiInitiatorIOCompleted( tiRoot,
4048                               tiIORequest,
4049                               tiIOSuccess,
4050                               SCSI_STAT_CHECK_CONDITION,
4051                               satIOContext->pTiSenseData,
4052                               satIOContext->interruptContext );
4053
4054     TI_DBG1(("satWrite10: return control\n"));
4055     return tiSuccess;
4056   }
4057
4058   osti_memset(LBA, 0, sizeof(LBA));
4059   osti_memset(TL, 0, sizeof(TL));
4060
4061   /* do not use memcpy due to indexing in LBA and TL */
4062   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
4063   LBA[1] = scsiCmnd->cdb[3];
4064   LBA[2] = scsiCmnd->cdb[4];
4065   LBA[3] = scsiCmnd->cdb[5];  /* LSB */
4066
4067   TL[0] = 0;
4068   TL[1] = 0;
4069   TL[2] = scsiCmnd->cdb[7];  /* MSB */
4070   TL[3] = scsiCmnd->cdb[8];  /* LSB */
4071
4072   rangeChk = satAddNComparebit32(LBA, TL);
4073
4074
4075   /* cbd10; computing LBA and transfer length */
4076   lba = (scsiCmnd->cdb[2] << (8*3)) + (scsiCmnd->cdb[3] << (8*2))
4077     + (scsiCmnd->cdb[4] << 8) + scsiCmnd->cdb[5];
4078   tl = (scsiCmnd->cdb[7] << 8) + scsiCmnd->cdb[8];
4079
4080   TI_DBG5(("satWrite10: lba %d functioned lba %d\n", lba, satComputeCDB10LBA(satIOContext)));
4081   TI_DBG5(("satWrite10: tl %d functioned tl %d\n", tl, satComputeCDB10TL(satIOContext)));
4082
4083   /* Table 34, 9.1, p 46 */
4084   /*
4085     note: As of 2/10/2006, no support for DMA QUEUED
4086    */
4087
4088   /*
4089     Table 34, 9.1, p 46, b
4090     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
4091     return check condition
4092   */
4093   if (pSatDevData->satNCQ != agTRUE &&
4094       pSatDevData->sat48BitSupport != agTRUE
4095       )
4096   {
4097     if (lba > SAT_TR_LBA_LIMIT - 1)
4098     {
4099       satSetSensePayload( pSense,
4100                           SCSI_SNSKEY_ILLEGAL_REQUEST,
4101                           0,
4102                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
4103                           satIOContext);
4104
4105       ostiInitiatorIOCompleted( tiRoot,
4106                                 tiIORequest,
4107                                 tiIOSuccess,
4108                                 SCSI_STAT_CHECK_CONDITION,
4109                                 satIOContext->pTiSenseData,
4110                                 satIOContext->interruptContext );
4111
4112       TI_DBG1(("satWrite10: return LBA out of range, not EXT\n"));
4113       TI_DBG1(("satWrite10: cdb 0x%x 0x%x 0x%x 0x%x\n",scsiCmnd->cdb[2], scsiCmnd->cdb[3],
4114              scsiCmnd->cdb[4], scsiCmnd->cdb[5]));
4115       TI_DBG1(("satWrite10: lba 0x%x SAT_TR_LBA_LIMIT 0x%x\n", lba, SAT_TR_LBA_LIMIT));
4116       return tiSuccess;
4117     }
4118
4119     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
4120     {
4121       TI_DBG1(("satWrite10: return LBA+TL out of range, not EXT\n"));
4122       satSetSensePayload( pSense,
4123                           SCSI_SNSKEY_ILLEGAL_REQUEST,
4124                           0,
4125                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
4126                           satIOContext);
4127
4128       ostiInitiatorIOCompleted( tiRoot,
4129                                 tiIORequest,
4130                                 tiIOSuccess,
4131                                 SCSI_STAT_CHECK_CONDITION,
4132                                 satIOContext->pTiSenseData,
4133                                 satIOContext->interruptContext );
4134
4135       return tiSuccess;
4136     }
4137
4138   }
4139
4140
4141   /* case 1 and 2 */
4142   if (!rangeChk) //  if (lba + tl <= SAT_TR_LBA_LIMIT)
4143   {
4144     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
4145     {
4146       /* case 2 */
4147       /* WRITE DMA*/
4148       /* can't fit the transfer length */
4149       TI_DBG5(("satWrite10: case 2\n"));
4150       fis->h.fisType        = 0x27;                   /* Reg host to device */
4151       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
4152       fis->h.command        = SAT_WRITE_DMA;          /* 0xCA */
4153       fis->h.features       = 0;                      /* FIS reserve */
4154       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
4155       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
4156       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
4157
4158       /* FIS LBA mode set LBA (27:24) */
4159       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));
4160
4161       fis->d.lbaLowExp      = 0;
4162       fis->d.lbaMidExp      = 0;
4163       fis->d.lbaHighExp     = 0;
4164       fis->d.featuresExp    = 0;
4165       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
4166       fis->d.sectorCountExp = 0;
4167       fis->d.reserved4      = 0;
4168       fis->d.control        = 0;                      /* FIS HOB bit clear */
4169       fis->d.reserved5      = 0;
4170
4171       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
4172       satIOContext->ATACmd = SAT_WRITE_DMA;
4173     }
4174     else
4175     {
4176       /* case 1 */
4177       /* WRITE MULTIPLE or WRITE SECTOR(S) */
4178       /* WRITE SECTORS for easier implemetation */
4179       /* can't fit the transfer length */
4180       TI_DBG5(("satWrite10: case 1\n"));
4181       fis->h.fisType        = 0x27;                   /* Reg host to device */
4182       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
4183       fis->h.command        = SAT_WRITE_SECTORS;      /* 0x30 */
4184       fis->h.features       = 0;                      /* FIS reserve */
4185       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
4186       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
4187       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
4188
4189       /* FIS LBA mode set LBA (27:24) */
4190       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));
4191
4192       fis->d.lbaLowExp      = 0;
4193       fis->d.lbaMidExp      = 0;
4194       fis->d.lbaHighExp     = 0;
4195       fis->d.featuresExp    = 0;
4196       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
4197       fis->d.sectorCountExp = 0;
4198       fis->d.reserved4      = 0;
4199       fis->d.control        = 0;                      /* FIS HOB bit clear */
4200       fis->d.reserved5      = 0;
4201
4202       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
4203       satIOContext->ATACmd = SAT_WRITE_SECTORS;
4204     }
4205   }
4206   /* case 3 and 4 */
4207   if (pSatDevData->sat48BitSupport == agTRUE)
4208   {
4209     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
4210     {
4211       /* case 3 */
4212       /* WRITE DMA EXT or WRITE DMA FUA EXT */
4213       TI_DBG5(("satWrite10: case 3\n"));
4214       fis->h.fisType        = 0x27;                   /* Reg host to device */
4215       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
4216
4217       /* SAT_WRITE_DMA_FUA_EXT is optional and we don't support it */
4218       fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x35 */
4219       satIOContext->ATACmd  = SAT_WRITE_DMA_EXT;
4220
4221       fis->h.features       = 0;                      /* FIS reserve */
4222       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
4223       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
4224       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
4225       fis->d.device         = 0x40;                   /* FIS LBA mode set */
4226       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
4227       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
4228       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
4229       fis->d.featuresExp    = 0;                      /* FIS reserve */
4230       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
4231       fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
4232       fis->d.reserved4      = 0;
4233       fis->d.control        = 0;                      /* FIS HOB bit clear */
4234       fis->d.reserved5      = 0;
4235
4236       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
4237     }
4238     else
4239     {
4240       /* case 4 */
4241       /* WRITE MULTIPLE EXT or WRITE MULTIPLE FUA EXT or WRITE SECTOR(S) EXT */
4242       /* WRITE SECTORS EXT for easier implemetation */
4243       TI_DBG5(("satWrite10: case 4\n"));
4244       fis->h.fisType        = 0x27;                   /* Reg host to device */
4245       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
4246       fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
4247
4248       fis->h.features       = 0;                      /* FIS reserve */
4249       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
4250       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
4251       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
4252       fis->d.device         = 0x40;                   /* FIS LBA mode set */
4253       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
4254       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
4255       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
4256       fis->d.featuresExp    = 0;                      /* FIS reserve */
4257       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
4258       fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
4259       fis->d.reserved4      = 0;
4260       fis->d.control        = 0;                      /* FIS HOB bit clear */
4261       fis->d.reserved5      = 0;
4262
4263       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
4264       satIOContext->ATACmd = SAT_WRITE_SECTORS_EXT;
4265     }
4266   }
4267   /* case 5 */
4268   if (pSatDevData->satNCQ == agTRUE)
4269   {
4270     /* WRITE FPDMA QUEUED */
4271     if (pSatDevData->sat48BitSupport != agTRUE)
4272     {
4273       TI_DBG5(("satWrite10: case 5 !!! error NCQ but 28 bit address support \n"));
4274       satSetSensePayload( pSense,
4275                           SCSI_SNSKEY_ILLEGAL_REQUEST,
4276                           0,
4277                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
4278                           satIOContext);
4279
4280       ostiInitiatorIOCompleted( tiRoot,
4281                                 tiIORequest,
4282                                 tiIOSuccess,
4283                                 SCSI_STAT_CHECK_CONDITION,
4284                                 satIOContext->pTiSenseData,
4285                                 satIOContext->interruptContext );
4286       return tiSuccess;
4287     }
4288     TI_DBG6(("satWrite10: case 5\n"));
4289
4290     /* Support 48-bit FPDMA addressing, use WRITE FPDMA QUEUE command */
4291
4292     fis->h.fisType        = 0x27;                   /* Reg host to device */
4293     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
4294     fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
4295     fis->h.features       = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
4296     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
4297     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
4298     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
4299
4300     /* Check FUA bit */
4301     if (scsiCmnd->cdb[1] & SCSI_WRITE10_FUA_MASK)
4302       fis->d.device       = 0xC0;                   /* FIS FUA set */
4303     else
4304       fis->d.device       = 0x40;                   /* FIS FUA clear */
4305
4306     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
4307     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
4308     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
4309     fis->d.featuresExp    = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
4310     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
4311     fis->d.sectorCountExp = 0;
4312     fis->d.reserved4      = 0;
4313     fis->d.control        = 0;                      /* FIS HOB bit clear */
4314     fis->d.reserved5      = 0;
4315
4316     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
4317     satIOContext->ATACmd = SAT_WRITE_FPDMA_QUEUED;
4318   }
4319
4320   //  tdhexdump("satWrite10 final fis", (bit8 *)fis, sizeof(agsaFisRegHostToDevice_t));
4321
4322   satIOContext->currentLBA = lba;
4323   satIOContext->OrgTL = tl;
4324
4325   /*
4326     computing number of loop and remainder for tl
4327     0xFF in case not ext
4328     0xFFFF in case EXT
4329   */
4330   if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
4331   {
4332     LoopNum = satComputeLoopNum(tl, 0xFF);
4333   }
4334   else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
4335            fis->h.command == SAT_WRITE_DMA_EXT     ||
4336            fis->h.command == SAT_WRITE_DMA_FUA_EXT
4337            )
4338   {
4339     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
4340     LoopNum = satComputeLoopNum(tl, 0xFFFF);
4341   }
4342   else
4343   {
4344     /* SAT_WRITE_FPDMA_QUEUEDK */
4345     LoopNum = satComputeLoopNum(tl, 0xFFFF);
4346   }
4347
4348   satIOContext->LoopNum = LoopNum;
4349
4350
4351   if (LoopNum == 1)
4352   {
4353     TI_DBG5(("satWrite10: NON CHAINED data\n"));
4354     /* Initialize CB for SATA completion.
4355      */
4356     satIOContext->satCompleteCB = &satNonChainedDataIOCB;
4357   }
4358   else
4359   {
4360     TI_DBG1(("satWrite10: CHAINED data\n"));
4361     /* re-setting tl */
4362     if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
4363     {
4364        fis->d.sectorCount    = 0xFF;
4365     }
4366     else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
4367              fis->h.command == SAT_WRITE_DMA_EXT ||
4368              fis->h.command == SAT_WRITE_DMA_FUA_EXT
4369              )
4370     {
4371       fis->d.sectorCount    = 0xFF;
4372       fis->d.sectorCountExp = 0xFF;
4373     }
4374     else
4375     {
4376       /* SAT_WRITE_FPDMA_QUEUED */
4377       fis->h.features       = 0xFF;
4378       fis->d.featuresExp    = 0xFF;
4379     }
4380
4381     /* Initialize CB for SATA completion.
4382      */
4383     satIOContext->satCompleteCB = &satChainedDataIOCB;
4384   }
4385
4386
4387   /*
4388    * Prepare SGL and send FIS to LL layer.
4389    */
4390   satIOContext->reqType = agRequestType;       /* Save it */
4391
4392   status = sataLLIOStart( tiRoot,
4393                           tiIORequest,
4394                           tiDeviceHandle,
4395                           tiScsiRequest,
4396                           satIOContext);
4397   return (status);
4398 }
4399
4400 /*****************************************************************************/
4401 /*! \brief SAT implementation for SCSI satWrite_1.
4402  *
4403  *  SAT implementation for SCSI WRITE10 and send FIS request to LL layer.
4404  *  This is used when WRITE10 is divided into multiple ATA commands
4405  *
4406  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
4407  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
4408  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
4409  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
4410  *  \param   satIOContext_t:   Pointer to the SAT IO Context
4411  *
4412  *  \return If command is started successfully
4413  *    - \e tiSuccess:     I/O request successfully initiated.
4414  *    - \e tiBusy:        No resources available, try again later.
4415  *    - \e tiIONoDevice:  Invalid device handle.
4416  *    - \e tiError:       Other errors.
4417  */
4418 /*****************************************************************************/
4419 GLOBAL bit32  satWrite_1(
4420                    tiRoot_t                  *tiRoot,
4421                    tiIORequest_t             *tiIORequest,
4422                    tiDeviceHandle_t          *tiDeviceHandle,
4423                    tiScsiInitiatorRequest_t *tiScsiRequest,
4424                    satIOContext_t            *satIOContext)
4425 {
4426   /*
4427     Assumption: error check on lba and tl has been done in satWrite*()
4428     lba = lba + tl;
4429   */
4430   bit32                     status;
4431   satIOContext_t            *satOrgIOContext = agNULL;
4432   tiIniScsiCmnd_t           *scsiCmnd;
4433   agsaFisRegHostToDevice_t  *fis;
4434   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
4435   bit32                     lba = 0;
4436   bit32                     DenomTL = 0xFF;
4437   bit32                     Remainder = 0;
4438   bit8                      LBA[4]; /* 0 MSB, 3 LSB */
4439
4440   TI_DBG2(("satWrite_1: start\n"));
4441
4442   fis             = satIOContext->pFis;
4443   satOrgIOContext = satIOContext->satOrgIOContext;
4444   scsiCmnd        = satOrgIOContext->pScsiCmnd;
4445
4446   osti_memset(LBA,0, sizeof(LBA));
4447
4448   switch (satOrgIOContext->ATACmd)
4449   {
4450   case SAT_WRITE_DMA:
4451     DenomTL = 0xFF;
4452     break;
4453   case SAT_WRITE_SECTORS:
4454     DenomTL = 0xFF;
4455     break;
4456   case SAT_WRITE_DMA_EXT:
4457     DenomTL = 0xFFFF;
4458     break;
4459   case SAT_WRITE_DMA_FUA_EXT:
4460     DenomTL = 0xFFFF;
4461     break;
4462   case SAT_WRITE_SECTORS_EXT:
4463     DenomTL = 0xFFFF;
4464     break;
4465   case SAT_WRITE_FPDMA_QUEUED:
4466     DenomTL = 0xFFFF;
4467     break;
4468   default:
4469     TI_DBG1(("satWrite_1: error incorrect ata command 0x%x\n", satIOContext->ATACmd));
4470     return tiError;
4471     break;
4472   }
4473
4474   Remainder = satOrgIOContext->OrgTL % DenomTL;
4475   satOrgIOContext->currentLBA = satOrgIOContext->currentLBA + DenomTL;
4476   lba = satOrgIOContext->currentLBA;
4477
4478   LBA[0] = (bit8)((lba & 0xF000) >> (8 * 3)); /* MSB */
4479   LBA[1] = (bit8)((lba & 0xF00) >> (8 * 2));
4480   LBA[2] = (bit8)((lba & 0xF0) >> 8);
4481   LBA[3] = (bit8)(lba & 0xF);               /* LSB */
4482
4483   switch (satOrgIOContext->ATACmd)
4484   {
4485   case SAT_WRITE_DMA:
4486     fis->h.fisType        = 0x27;                   /* Reg host to device */
4487     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
4488     fis->h.command        = SAT_WRITE_DMA;          /* 0xCA */
4489     fis->h.features       = 0;                      /* FIS reserve */
4490     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
4491     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
4492     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
4493
4494     /* FIS LBA mode set LBA (27:24) */
4495     fis->d.device         = (bit8)((0x4 << 4) | (LBA[0] & 0xF));
4496
4497     fis->d.lbaLowExp      = 0;
4498     fis->d.lbaMidExp      = 0;
4499     fis->d.lbaHighExp     = 0;
4500     fis->d.featuresExp    = 0;
4501     if (satOrgIOContext->LoopNum == 1)
4502     {
4503       /* last loop */
4504       fis->d.sectorCount    = (bit8)Remainder;             /* FIS sector count (7:0) */
4505     }
4506     else
4507     {
4508       fis->d.sectorCount    = 0xFF;                   /* FIS sector count (7:0) */
4509     }
4510     fis->d.sectorCountExp = 0;
4511     fis->d.reserved4      = 0;
4512     fis->d.control        = 0;                      /* FIS HOB bit clear */
4513     fis->d.reserved5      = 0;
4514
4515     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
4516
4517     break;
4518   case SAT_WRITE_SECTORS:
4519     fis->h.fisType        = 0x27;                   /* Reg host to device */
4520     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
4521     fis->h.command        = SAT_WRITE_SECTORS;      /* 0x30 */
4522     fis->h.features       = 0;                      /* FIS reserve */
4523     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
4524     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
4525     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
4526
4527     /* FIS LBA mode set LBA (27:24) */
4528     fis->d.device         = (bit8)((0x4 << 4) | (LBA[0] & 0xF));
4529
4530     fis->d.lbaLowExp      = 0;
4531     fis->d.lbaMidExp      = 0;
4532     fis->d.lbaHighExp     = 0;
4533     fis->d.featuresExp    = 0;
4534     if (satOrgIOContext->LoopNum == 1)
4535     {
4536       /* last loop */
4537       fis->d.sectorCount    = (bit8)Remainder;            /* FIS sector count (7:0) */
4538     }
4539     else
4540     {
4541       fis->d.sectorCount    = 0xFF;                 /* FIS sector count (7:0) */
4542     }
4543     fis->d.sectorCountExp = 0;
4544     fis->d.reserved4      = 0;
4545     fis->d.control        = 0;                      /* FIS HOB bit clear */
4546     fis->d.reserved5      = 0;
4547
4548     agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
4549
4550     break;
4551   case SAT_WRITE_DMA_EXT:
4552     fis->h.fisType        = 0x27;                   /* Reg host to device */
4553     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
4554     fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x3D */
4555     fis->h.features       = 0;                      /* FIS reserve */
4556     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
4557     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
4558     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
4559     fis->d.device         = 0x40;                   /* FIS LBA mode set */
4560     fis->d.lbaLowExp      = LBA[0];                 /* FIS LBA (31:24) */
4561     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
4562     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
4563     fis->d.featuresExp    = 0;                      /* FIS reserve */
4564     if (satOrgIOContext->LoopNum == 1)
4565     {
4566       /* last loop */
4567       fis->d.sectorCount    = (bit8)(Remainder & 0xFF);       /* FIS sector count (7:0) */
4568       fis->d.sectorCountExp = (bit8)((Remainder & 0xFF00) >> 8);       /* FIS sector count (15:8) */
4569     }
4570     else
4571     {
4572       fis->d.sectorCount    = 0xFF;                  /* FIS sector count (7:0) */
4573       fis->d.sectorCountExp = 0xFF;                  /* FIS sector count (15:8) */
4574     }
4575     fis->d.reserved4      = 0;
4576     fis->d.control        = 0;                       /* FIS HOB bit clear */
4577     fis->d.reserved5      = 0;
4578
4579     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
4580
4581     break;
4582   case SAT_WRITE_SECTORS_EXT:
4583     fis->h.fisType        = 0x27;                   /* Reg host to device */
4584     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
4585     fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
4586
4587     fis->h.features       = 0;                      /* FIS reserve */
4588     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
4589     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
4590     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
4591     fis->d.device         = 0x40;                   /* FIS LBA mode set */
4592     fis->d.lbaLowExp      = LBA[0];                 /* FIS LBA (31:24) */
4593     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
4594     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
4595     fis->d.featuresExp    = 0;                      /* FIS reserve */
4596     if (satOrgIOContext->LoopNum == 1)
4597     {
4598       /* last loop */
4599       fis->d.sectorCount    = (bit8)(Remainder & 0xFF);     /* FIS sector count (7:0) */
4600       fis->d.sectorCountExp = (bit8)((Remainder & 0xFF00) >> 8);   /* FIS sector count (15:8) */
4601     }
4602     else
4603     {
4604       fis->d.sectorCount    = 0xFF;                 /* FIS sector count (7:0) */
4605       fis->d.sectorCountExp = 0xFF;                 /* FIS sector count (15:8) */
4606     }
4607     fis->d.reserved4      = 0;
4608     fis->d.control        = 0;                      /* FIS HOB bit clear */
4609     fis->d.reserved5      = 0;
4610
4611     agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
4612
4613     break;
4614   case SAT_WRITE_FPDMA_QUEUED:
4615     fis->h.fisType        = 0x27;                   /* Reg host to device */
4616     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
4617     fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
4618     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
4619     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
4620     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
4621
4622     /* Check FUA bit */
4623     if (scsiCmnd->cdb[1] & SCSI_WRITE10_FUA_MASK)
4624       fis->d.device       = 0xC0;                   /* FIS FUA set */
4625     else
4626       fis->d.device       = 0x40;                   /* FIS FUA clear */
4627
4628     fis->d.lbaLowExp      = LBA[0];;                /* FIS LBA (31:24) */
4629     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
4630     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
4631     if (satOrgIOContext->LoopNum == 1)
4632     {
4633       /* last loop */
4634       fis->h.features       = (bit8)(Remainder & 0xFF);     /* FIS sector count (7:0) */
4635       fis->d.featuresExp    = (bit8)((Remainder & 0xFF00) >> 8);       /* FIS sector count (15:8) */
4636     }
4637     else
4638     {
4639       fis->h.features       = 0xFF;                 /* FIS sector count (7:0) */
4640       fis->d.featuresExp    = 0xFF;                 /* FIS sector count (15:8) */
4641     }
4642     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
4643     fis->d.sectorCountExp = 0;
4644     fis->d.reserved4      = 0;
4645     fis->d.control        = 0;                      /* FIS HOB bit clear */
4646     fis->d.reserved5      = 0;
4647
4648     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
4649     break;
4650
4651   default:
4652     TI_DBG1(("satWrite_1: error incorrect ata command 0x%x\n", satIOContext->ATACmd));
4653     return tiError;
4654     break;
4655   }
4656
4657   /* Initialize CB for SATA completion.
4658    */
4659   /* chained data */
4660   satIOContext->satCompleteCB = &satChainedDataIOCB;
4661
4662
4663   /*
4664    * Prepare SGL and send FIS to LL layer.
4665    */
4666   satIOContext->reqType = agRequestType;       /* Save it */
4667
4668   status = sataLLIOStart( tiRoot,
4669                           tiIORequest,
4670                           tiDeviceHandle,
4671                           tiScsiRequest,
4672                           satIOContext);
4673
4674   TI_DBG5(("satWrite_1: return\n"));
4675   return (status);
4676 }
4677
4678 /*****************************************************************************/
4679 /*! \brief SAT implementation for SCSI WRITE6.
4680  *
4681  *  SAT implementation for SCSI WRITE6 and send FIS request to LL layer.
4682  *
4683  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
4684  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
4685  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
4686  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
4687  *  \param   satIOContext_t:   Pointer to the SAT IO Context
4688  *
4689  *  \return If command is started successfully
4690  *    - \e tiSuccess:     I/O request successfully initiated.
4691  *    - \e tiBusy:        No resources available, try again later.
4692  *    - \e tiIONoDevice:  Invalid device handle.
4693  *    - \e tiError:       Other errors.
4694  */
4695 /*****************************************************************************/
4696 GLOBAL bit32  satWrite6(
4697                    tiRoot_t                  *tiRoot,
4698                    tiIORequest_t             *tiIORequest,
4699                    tiDeviceHandle_t          *tiDeviceHandle,
4700                    tiScsiInitiatorRequest_t *tiScsiRequest,
4701                    satIOContext_t            *satIOContext)
4702 {
4703
4704   bit32                     status;
4705   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
4706   satDeviceData_t           *pSatDevData;
4707   scsiRspSense_t            *pSense;
4708   tiIniScsiCmnd_t           *scsiCmnd;
4709   agsaFisRegHostToDevice_t  *fis;
4710   bit32                     lba = 0;
4711   bit16                     tl = 0;
4712
4713   pSense        = satIOContext->pSense;
4714   pSatDevData   = satIOContext->pSatDevData;
4715   scsiCmnd      = &tiScsiRequest->scsiCmnd;
4716   fis           = satIOContext->pFis;
4717
4718   TI_DBG5(("satWrite6: start\n"));
4719
4720   /* checking CONTROL */
4721   /* NACA == 1 or LINK == 1*/
4722   if ( (scsiCmnd->cdb[5] & SCSI_NACA_MASK) || (scsiCmnd->cdb[5] & SCSI_LINK_MASK) )
4723   {
4724     satSetSensePayload( pSense,
4725                         SCSI_SNSKEY_ILLEGAL_REQUEST,
4726                         0,
4727                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
4728                         satIOContext);
4729
4730     ostiInitiatorIOCompleted( tiRoot,
4731                               tiIORequest,
4732                               tiIOSuccess,
4733                               SCSI_STAT_CHECK_CONDITION,
4734                               satIOContext->pTiSenseData,
4735                               satIOContext->interruptContext );
4736
4737     TI_DBG1(("satWrite6: return control\n"));
4738     return tiSuccess;
4739   }
4740
4741
4742   /* cbd6; computing LBA and transfer length */
4743   lba = (((scsiCmnd->cdb[1]) & 0x1f) << (8*2))
4744     + (scsiCmnd->cdb[2] << 8) + scsiCmnd->cdb[3];
4745   tl = scsiCmnd->cdb[4];
4746
4747
4748   /* Table 34, 9.1, p 46 */
4749   /*
4750     note: As of 2/10/2006, no support for DMA QUEUED
4751    */
4752
4753   /*
4754     Table 34, 9.1, p 46, b
4755     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
4756     return check condition
4757   */
4758   if (pSatDevData->satNCQ != agTRUE &&
4759       pSatDevData->sat48BitSupport != agTRUE
4760       )
4761   {
4762     if (lba > SAT_TR_LBA_LIMIT - 1)
4763     {
4764       satSetSensePayload( pSense,
4765                           SCSI_SNSKEY_ILLEGAL_REQUEST,
4766                           0,
4767                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
4768                           satIOContext);
4769
4770       ostiInitiatorIOCompleted( tiRoot,
4771                                 tiIORequest,
4772                                 tiIOSuccess,
4773                                 SCSI_STAT_CHECK_CONDITION,
4774                                 satIOContext->pTiSenseData,
4775                                 satIOContext->interruptContext );
4776
4777     TI_DBG1(("satWrite6: return LBA out of range\n"));
4778     return tiSuccess;
4779     }
4780   }
4781
4782   /* case 1 and 2 */
4783   if (lba + tl <= SAT_TR_LBA_LIMIT)
4784   {
4785     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
4786     {
4787       /* case 2 */
4788       /* WRITE DMA*/
4789       TI_DBG5(("satWrite6: case 2\n"));
4790
4791
4792       fis->h.fisType        = 0x27;                   /* Reg host to device */
4793       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
4794       fis->h.command        = SAT_WRITE_DMA;          /* 0xCA */
4795       fis->h.features       = 0;                      /* FIS reserve */
4796       fis->d.lbaLow         = scsiCmnd->cdb[3];       /* FIS LBA (7 :0 ) */
4797       fis->d.lbaMid         = scsiCmnd->cdb[2];       /* FIS LBA (15:8 ) */
4798       fis->d.lbaHigh        = (bit8)((scsiCmnd->cdb[1]) & 0x1f);       /* FIS LBA (23:16) */
4799       fis->d.device         = 0x40;                   /* FIS LBA mode  */
4800       fis->d.lbaLowExp      = 0;
4801       fis->d.lbaMidExp      = 0;
4802       fis->d.lbaHighExp     = 0;
4803       fis->d.featuresExp    = 0;
4804       if (tl == 0)
4805       {
4806         /* temporary fix */
4807         fis->d.sectorCount    = 0xff;                   /* FIS sector count (7:0) */
4808       }
4809       else
4810       {
4811         fis->d.sectorCount    = scsiCmnd->cdb[4];       /* FIS sector count (7:0) */
4812       }
4813       fis->d.sectorCountExp = 0;
4814       fis->d.reserved4      = 0;
4815       fis->d.control        = 0;                      /* FIS HOB bit clear */
4816       fis->d.reserved5      = 0;
4817
4818       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
4819     }
4820     else
4821     {
4822       /* case 1 */
4823       /* WRITE SECTORS for easier implemetation */
4824       TI_DBG5(("satWrite6: case 1\n"));
4825
4826       fis->h.fisType        = 0x27;                   /* Reg host to device */
4827       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
4828       fis->h.command        = SAT_WRITE_SECTORS;          /* 0xCA */
4829       fis->h.features       = 0;                      /* FIS reserve */
4830       fis->d.lbaLow         = scsiCmnd->cdb[3];       /* FIS LBA (7 :0 ) */
4831       fis->d.lbaMid         = scsiCmnd->cdb[2];       /* FIS LBA (15:8 ) */
4832       fis->d.lbaHigh        = (bit8)((scsiCmnd->cdb[1]) & 0x1f);       /* FIS LBA (23:16) */
4833       fis->d.device         = 0x40;                   /* FIS LBA mode  */
4834       fis->d.lbaLowExp      = 0;
4835       fis->d.lbaMidExp      = 0;
4836       fis->d.lbaHighExp     = 0;
4837       fis->d.featuresExp    = 0;
4838       if (tl == 0)
4839       {
4840         /* temporary fix */
4841         fis->d.sectorCount    = 0xff;                   /* FIS sector count (7:0) */
4842       }
4843       else
4844       {
4845         fis->d.sectorCount    = scsiCmnd->cdb[4];       /* FIS sector count (7:0) */
4846       }
4847       fis->d.sectorCountExp = 0;
4848       fis->d.reserved4      = 0;
4849       fis->d.control        = 0;                      /* FIS HOB bit clear */
4850       fis->d.reserved5      = 0;
4851
4852       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
4853
4854     }
4855   }
4856
4857   /* case 3 and 4 */
4858   if (pSatDevData->sat48BitSupport == agTRUE)
4859   {
4860     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
4861     {
4862       /* case 3 */
4863       /* WRITE DMA EXT only */
4864       TI_DBG5(("satWrite6: case 3\n"));
4865       fis->h.fisType        = 0x27;                   /* Reg host to device */
4866       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
4867       fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x35 */
4868       fis->h.features       = 0;                      /* FIS reserve */
4869       fis->d.lbaLow         = scsiCmnd->cdb[3];       /* FIS LBA (7 :0 ) */
4870       fis->d.lbaMid         = scsiCmnd->cdb[2];       /* FIS LBA (15:8 ) */
4871       fis->d.lbaHigh        = (bit8)((scsiCmnd->cdb[1]) & 0x1f);       /* FIS LBA (23:16) */
4872       fis->d.device         = 0x40;                   /* FIS LBA mode set */
4873       fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
4874       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
4875       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
4876       fis->d.featuresExp    = 0;                      /* FIS reserve */
4877       if (tl == 0)
4878       {
4879         /* sector count is 256, 0x100*/
4880         fis->d.sectorCount    = 0;                         /* FIS sector count (7:0) */
4881         fis->d.sectorCountExp = 0x01;                      /* FIS sector count (15:8) */
4882       }
4883       else
4884       {
4885         fis->d.sectorCount    = scsiCmnd->cdb[4];       /* FIS sector count (7:0) */
4886         fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
4887       }
4888       fis->d.reserved4      = 0;
4889       fis->d.control        = 0;                      /* FIS HOB bit clear */
4890       fis->d.reserved5      = 0;
4891
4892       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
4893     }
4894     else
4895     {
4896       /* case 4 */
4897       /* WRITE SECTORS EXT for easier implemetation */
4898       TI_DBG5(("satWrite6: case 4\n"));
4899
4900       fis->h.fisType        = 0x27;                   /* Reg host to device */
4901       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
4902       fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
4903       fis->h.features       = 0;                      /* FIS reserve */
4904       fis->d.lbaLow         = scsiCmnd->cdb[3];       /* FIS LBA (7 :0 ) */
4905       fis->d.lbaMid         = scsiCmnd->cdb[2];       /* FIS LBA (15:8 ) */
4906       fis->d.lbaHigh        = (bit8)((scsiCmnd->cdb[1]) & 0x1f);       /* FIS LBA (23:16) */
4907       fis->d.device         = 0x40;                   /* FIS LBA mode set */
4908       fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
4909       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
4910       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
4911       fis->d.featuresExp    = 0;                      /* FIS reserve */
4912       if (tl == 0)
4913       {
4914         /* sector count is 256, 0x100*/
4915         fis->d.sectorCount    = 0;                         /* FIS sector count (7:0) */
4916         fis->d.sectorCountExp = 0x01;                      /* FIS sector count (15:8) */
4917       }
4918       else
4919       {
4920         fis->d.sectorCount    = scsiCmnd->cdb[4];       /* FIS sector count (7:0) */
4921         fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
4922       }
4923       fis->d.reserved4      = 0;
4924       fis->d.control        = 0;                      /* FIS HOB bit clear */
4925       fis->d.reserved5      = 0;
4926
4927       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
4928     }
4929   }
4930
4931    /* case 5 */
4932   if (pSatDevData->satNCQ == agTRUE)
4933   {
4934     /* WRITE FPDMA QUEUED */
4935     if (pSatDevData->sat48BitSupport != agTRUE)
4936     {
4937       /* sanity check */
4938       TI_DBG5(("satWrite6: case 5 !!! error NCQ but 28 bit address support \n"));
4939        satSetSensePayload( pSense,
4940                           SCSI_SNSKEY_ILLEGAL_REQUEST,
4941                           0,
4942                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
4943                           satIOContext);
4944
4945       ostiInitiatorIOCompleted( tiRoot,
4946                                 tiIORequest,
4947                                 tiIOSuccess,
4948                                 SCSI_STAT_CHECK_CONDITION,
4949                                 satIOContext->pTiSenseData,
4950                                 satIOContext->interruptContext );
4951       return tiSuccess;
4952     }
4953     TI_DBG5(("satWrite6: case 5\n"));
4954
4955     /* Support 48-bit FPDMA addressing, use WRITE FPDMA QUEUE command */
4956
4957     fis->h.fisType        = 0x27;                   /* Reg host to device */
4958     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
4959     fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
4960     fis->d.lbaLow         = scsiCmnd->cdb[3];       /* FIS LBA (7 :0 ) */
4961     fis->d.lbaMid         = scsiCmnd->cdb[2];       /* FIS LBA (15:8 ) */
4962     fis->d.lbaHigh        = (bit8)((scsiCmnd->cdb[1]) & 0x1f);       /* FIS LBA (23:16) */
4963     fis->d.device         = 0x40;                   /* FIS FUA clear */
4964     fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
4965     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
4966     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
4967     if (tl == 0)
4968     {
4969       /* sector count is 256, 0x100*/
4970       fis->h.features       = 0;                         /* FIS sector count (7:0) */
4971       fis->d.featuresExp    = 0x01;                      /* FIS sector count (15:8) */
4972     }
4973     else
4974     {
4975       fis->h.features       = scsiCmnd->cdb[4];       /* FIS sector count (7:0) */
4976       fis->d.featuresExp    = 0;                      /* FIS sector count (15:8) */
4977     }
4978     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
4979     fis->d.sectorCountExp = 0;
4980     fis->d.reserved4      = 0;
4981     fis->d.control        = 0;                      /* FIS HOB bit clear */
4982     fis->d.reserved5      = 0;
4983
4984     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
4985   }
4986
4987   /* Initialize CB for SATA completion.
4988    */
4989   satIOContext->satCompleteCB = &satNonChainedDataIOCB;
4990
4991   /*
4992    * Prepare SGL and send FIS to LL layer.
4993    */
4994   satIOContext->reqType = agRequestType;       /* Save it */
4995
4996   status = sataLLIOStart( tiRoot,
4997                           tiIORequest,
4998                           tiDeviceHandle,
4999                           tiScsiRequest,
5000                           satIOContext);
5001   return (status);
5002 }
5003
5004
5005 /*****************************************************************************/
5006 /*! \brief SAT implementation for SCSI TEST UNIT READY.
5007  *
5008  *  SAT implementation for SCSI TUR and send FIS request to LL layer.
5009  *
5010  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
5011  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
5012  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
5013  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
5014  *  \param   satIOContext_t:   Pointer to the SAT IO Context
5015  *
5016  *  \return If command is started successfully
5017  *    - \e tiSuccess:     I/O request successfully initiated.
5018  *    - \e tiBusy:        No resources available, try again later.
5019  *    - \e tiIONoDevice:  Invalid device handle.
5020  *    - \e tiError:       Other errors.
5021  */
5022 /*****************************************************************************/
5023 GLOBAL bit32  satTestUnitReady(
5024                    tiRoot_t                  *tiRoot,
5025                    tiIORequest_t             *tiIORequest,
5026                    tiDeviceHandle_t          *tiDeviceHandle,
5027                    tiScsiInitiatorRequest_t *tiScsiRequest,
5028                    satIOContext_t            *satIOContext)
5029 {
5030
5031   bit32                     status;
5032   bit32                     agRequestType;
5033   satDeviceData_t           *pSatDevData;
5034   scsiRspSense_t            *pSense;
5035   tiIniScsiCmnd_t           *scsiCmnd;
5036   agsaFisRegHostToDevice_t  *fis;
5037
5038   pSense        = satIOContext->pSense;
5039   pSatDevData   = satIOContext->pSatDevData;
5040   scsiCmnd      = &tiScsiRequest->scsiCmnd;
5041   fis           = satIOContext->pFis;
5042
5043   TI_DBG6(("satTestUnitReady: entry tiDeviceHandle=%p tiIORequest=%p\n",
5044       tiDeviceHandle, tiIORequest));
5045
5046   /* checking CONTROL */
5047   /* NACA == 1 or LINK == 1*/
5048   if ( (scsiCmnd->cdb[5] & SCSI_NACA_MASK) || (scsiCmnd->cdb[5] & SCSI_LINK_MASK) )
5049   {
5050     satSetSensePayload( pSense,
5051                         SCSI_SNSKEY_ILLEGAL_REQUEST,
5052                         0,
5053                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
5054                         satIOContext);
5055
5056     ostiInitiatorIOCompleted( tiRoot,
5057                               tiIORequest,
5058                               tiIOSuccess,
5059                               SCSI_STAT_CHECK_CONDITION,
5060                               satIOContext->pTiSenseData,
5061                               satIOContext->interruptContext );
5062
5063     TI_DBG1(("satTestUnitReady: return control\n"));
5064     return tiSuccess;
5065   }
5066
5067   /* SAT revision 8, 8.11.2, p42*/
5068   if (pSatDevData->satStopState == agTRUE)
5069   {
5070     satSetSensePayload( pSense,
5071                         SCSI_SNSKEY_NOT_READY,
5072                         0,
5073                         SCSI_SNSCODE_LOGICAL_UNIT_NOT_READY_INITIALIZING_COMMAND_REQUIRED,
5074                         satIOContext);
5075
5076     ostiInitiatorIOCompleted( tiRoot,
5077                               tiIORequest,
5078                               tiIOSuccess,
5079                               SCSI_STAT_CHECK_CONDITION,
5080                               satIOContext->pTiSenseData,
5081                               satIOContext->interruptContext );
5082     TI_DBG1(("satTestUnitReady: stop state\n"));
5083     return tiSuccess;
5084   }
5085
5086   /*
5087    * Check if format is in progress
5088    */
5089
5090   if (pSatDevData->satDriveState == SAT_DEV_STATE_FORMAT_IN_PROGRESS)
5091   {
5092     TI_DBG1(("satTestUnitReady() FORMAT_IN_PROGRESS  tiDeviceHandle=%p tiIORequest=%p\n",
5093          tiDeviceHandle, tiIORequest));
5094
5095     satSetSensePayload( pSense,
5096                         SCSI_SNSKEY_NOT_READY,
5097                         0,
5098                         SCSI_SNSCODE_LOGICAL_UNIT_NOT_READY_FORMAT_IN_PROGRESS,
5099                         satIOContext);
5100
5101     ostiInitiatorIOCompleted( tiRoot,
5102                               tiIORequest,
5103                               tiIOSuccess,
5104                               SCSI_STAT_CHECK_CONDITION,
5105                               satIOContext->pTiSenseData,
5106                               satIOContext->interruptContext );
5107     TI_DBG1(("satTestUnitReady: format in progress\n"));
5108     return tiSuccess;
5109   }
5110
5111   /*
5112     check previously issued ATA command
5113   */
5114   if (pSatDevData->satPendingIO != 0)
5115   {
5116     if (pSatDevData->satDeviceFaultState == agTRUE)
5117     {
5118       satSetSensePayload( pSense,
5119                           SCSI_SNSKEY_HARDWARE_ERROR,
5120                           0,
5121                           SCSI_SNSCODE_LOGICAL_UNIT_FAILURE,
5122                           satIOContext);
5123
5124       ostiInitiatorIOCompleted( tiRoot,
5125                                 tiIORequest,
5126                                 tiIOSuccess,
5127                                 SCSI_STAT_CHECK_CONDITION,
5128                                 satIOContext->pTiSenseData,
5129                                 satIOContext->interruptContext );
5130       TI_DBG1(("satTestUnitReady: previous command ended in error\n"));
5131       return tiSuccess;
5132     }
5133   }
5134   /*
5135     check removalbe media feature set
5136    */
5137   if(pSatDevData->satRemovableMedia && pSatDevData->satRemovableMediaEnabled)
5138   {
5139     TI_DBG5(("satTestUnitReady: sending get media status cmnd\n"));
5140     /* send GET MEDIA STATUS command */
5141     fis->h.fisType        = 0x27;                   /* Reg host to device */
5142     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
5143     fis->h.command        = SAT_GET_MEDIA_STATUS;   /* 0xDA */
5144     fis->h.features       = 0;                      /* FIS features NA       */
5145     fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
5146     fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
5147     fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
5148     fis->d.device         = 0;                      /* FIS DEV is discared in SATA */
5149     fis->d.lbaLowExp      = 0;
5150     fis->d.lbaMidExp      = 0;
5151     fis->d.lbaHighExp     = 0;
5152     fis->d.featuresExp    = 0;
5153     fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
5154     fis->d.sectorCountExp = 0;
5155     fis->d.reserved4      = 0;
5156     fis->d.control        = 0;                      /* FIS HOB bit clear */
5157     fis->d.reserved5      = 0;
5158     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
5159
5160     /* Initialize CB for SATA completion.
5161      */
5162     satIOContext->satCompleteCB = &satTestUnitReadyCB;
5163
5164     /*
5165      * Prepare SGL and send FIS to LL layer.
5166      */
5167     satIOContext->reqType = agRequestType;       /* Save it */
5168
5169     status = sataLLIOStart( tiRoot,
5170                             tiIORequest,
5171                             tiDeviceHandle,
5172                             tiScsiRequest,
5173                             satIOContext);
5174
5175     return (status);
5176   }
5177   /*
5178     number 6) in SAT p42
5179     send ATA CHECK POWER MODE
5180   */
5181    TI_DBG5(("satTestUnitReady: sending check power mode cmnd\n"));
5182    status = satTestUnitReady_1( tiRoot,
5183                                tiIORequest,
5184                                tiDeviceHandle,
5185                                tiScsiRequest,
5186                                satIOContext);
5187    return (status);
5188 }
5189
5190
5191 /*****************************************************************************/
5192 /*! \brief SAT implementation for SCSI satTestUnitReady_1.
5193  *
5194  *  SAT implementation for SCSI satTestUnitReady_1.
5195  *
5196  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
5197  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
5198  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
5199  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
5200  *  \param   satIOContext_t:   Pointer to the SAT IO Context
5201  *
5202  *  \return If command is started successfully
5203  *    - \e tiSuccess:     I/O request successfully initiated.
5204  *    - \e tiBusy:        No resources available, try again later.
5205  *    - \e tiIONoDevice:  Invalid device handle.
5206  *    - \e tiError:       Other errors.
5207  */
5208 /*****************************************************************************/
5209 GLOBAL bit32  satTestUnitReady_1(
5210                          tiRoot_t                  *tiRoot,
5211                          tiIORequest_t             *tiIORequest,
5212                          tiDeviceHandle_t          *tiDeviceHandle,
5213                          tiScsiInitiatorRequest_t *tiScsiRequest,
5214                          satIOContext_t            *satIOContext)
5215 {
5216   /*
5217     sends SAT_CHECK_POWER_MODE as a part of TESTUNITREADY
5218     internally generated - no directly corresponding scsi
5219     called in satIOCompleted as a part of satTestUnitReady(), SAT, revision8, 8.11.2, p42
5220   */
5221   bit32                     status;
5222   bit32                     agRequestType;
5223   agsaFisRegHostToDevice_t  *fis;
5224
5225   fis           = satIOContext->pFis;
5226
5227   TI_DBG5(("satTestUnitReady_1: start\n"));
5228
5229   /*
5230    * Send the ATA CHECK POWER MODE command.
5231    */
5232   fis->h.fisType        = 0x27;                   /* Reg host to device */
5233   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
5234   fis->h.command        = SAT_CHECK_POWER_MODE;   /* 0xE5 */
5235   fis->h.features       = 0;
5236   fis->d.lbaLow         = 0;
5237   fis->d.lbaMid         = 0;
5238   fis->d.lbaHigh        = 0;
5239   fis->d.device         = 0;
5240   fis->d.lbaLowExp      = 0;
5241   fis->d.lbaMidExp      = 0;
5242   fis->d.lbaHighExp     = 0;
5243   fis->d.featuresExp    = 0;
5244   fis->d.sectorCount    = 0;
5245   fis->d.sectorCountExp = 0;
5246   fis->d.reserved4      = 0;
5247   fis->d.control        = 0;                      /* FIS HOB bit clear */
5248   fis->d.reserved5      = 0;
5249
5250   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
5251
5252   /* Initialize CB for SATA completion.
5253    */
5254   satIOContext->satCompleteCB = &satTestUnitReadyCB;
5255
5256   /*
5257    * Prepare SGL and send FIS to LL layer.
5258    */
5259   satIOContext->reqType = agRequestType;       /* Save it */
5260
5261   status = sataLLIOStart( tiRoot,
5262                           tiIORequest,
5263                           tiDeviceHandle,
5264                           tiScsiRequest,
5265                           satIOContext);
5266
5267   TI_DBG5(("satTestUnitReady_1: return\n"));
5268
5269   return status;
5270 }
5271
5272
5273 /*****************************************************************************/
5274 /*! \brief SAT implementation for SCSI satReportLun.
5275  *
5276  *  SAT implementation for SCSI satReportLun. Only LUN0 is reported.
5277  *
5278  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
5279  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
5280  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
5281  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
5282  *  \param   satIOContext_t:   Pointer to the SAT IO Context
5283  *
5284  *  \return If command is started successfully
5285  *    - \e tiSuccess:     I/O request successfully initiated.
5286  *    - \e tiBusy:        No resources available, try again later.
5287  *    - \e tiIONoDevice:  Invalid device handle.
5288  *    - \e tiError:       Other errors.
5289  */
5290 /*****************************************************************************/
5291 GLOBAL bit32  satReportLun(
5292                    tiRoot_t                  *tiRoot,
5293                    tiIORequest_t             *tiIORequest,
5294                    tiDeviceHandle_t          *tiDeviceHandle,
5295                    tiScsiInitiatorRequest_t *tiScsiRequest,
5296                    satIOContext_t            *satIOContext)
5297 {
5298   scsiRspSense_t        *pSense;
5299   bit32                 allocationLen;
5300   bit32                 reportLunLen;
5301   scsiReportLun_t       *pReportLun;
5302   tiIniScsiCmnd_t       *scsiCmnd;
5303
5304   TI_DBG5(("satReportLun entry: tiDeviceHandle=%p tiIORequest=%p\n",
5305       tiDeviceHandle, tiIORequest));
5306
5307   pSense     = satIOContext->pSense;
5308   pReportLun = (scsiReportLun_t *) tiScsiRequest->sglVirtualAddr;
5309   scsiCmnd   = &tiScsiRequest->scsiCmnd;
5310
5311 //  tdhexdump("satReportLun cdb", (bit8 *)scsiCmnd, 16);
5312
5313   /* Find the buffer size allocated by Initiator */
5314   allocationLen = (((bit32)scsiCmnd->cdb[6]) << 24) |
5315                   (((bit32)scsiCmnd->cdb[7]) << 16) |
5316                   (((bit32)scsiCmnd->cdb[8]) << 8 ) |
5317                   (((bit32)scsiCmnd->cdb[9])      );
5318
5319   reportLunLen  = 16;     /* 8 byte header and 8 bytes of LUN0 */
5320
5321   if (allocationLen < reportLunLen)
5322   {
5323     TI_DBG1(("satReportLun *** ERROR *** insufficient len=0x%x tiDeviceHandle=%p tiIORequest=%p\n",
5324         reportLunLen, tiDeviceHandle, tiIORequest));
5325
5326     satSetSensePayload( pSense,
5327                         SCSI_SNSKEY_ILLEGAL_REQUEST,
5328                         0,
5329                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
5330                         satIOContext);
5331
5332     ostiInitiatorIOCompleted( tiRoot,
5333                               tiIORequest,
5334                               tiIOSuccess,
5335                               SCSI_STAT_CHECK_CONDITION,
5336                               satIOContext->pTiSenseData,
5337                               satIOContext->interruptContext );
5338     return tiSuccess;
5339
5340   }
5341
5342   /* Set length to one entry */
5343   pReportLun->len[0] = 0;
5344   pReportLun->len[1] = 0;
5345   pReportLun->len[2] = 0;
5346   pReportLun->len[3] = sizeof (tiLUN_t);
5347
5348   pReportLun->reserved = 0;
5349
5350   /* Set to LUN 0:
5351    * - address method to 0x00: Peripheral device addressing method,
5352    * - bus identifier to 0
5353    */
5354   pReportLun->lunList[0].lun[0] = 0;
5355   pReportLun->lunList[0].lun[1] = 0;
5356   pReportLun->lunList[0].lun[2] = 0;
5357   pReportLun->lunList[0].lun[3] = 0;
5358   pReportLun->lunList[0].lun[4] = 0;
5359   pReportLun->lunList[0].lun[5] = 0;
5360   pReportLun->lunList[0].lun[6] = 0;
5361   pReportLun->lunList[0].lun[7] = 0;
5362
5363   if (allocationLen > reportLunLen)
5364   {
5365     /* underrun */
5366     TI_DBG1(("satReportLun reporting underrun reportLunLen=0x%x allocationLen=0x%x \n", reportLunLen, allocationLen));
5367
5368     ostiInitiatorIOCompleted( tiRoot,
5369                               tiIORequest,
5370                               tiIOUnderRun,
5371                               allocationLen - reportLunLen,
5372                               agNULL,
5373                               satIOContext->interruptContext );
5374
5375
5376   }
5377   else
5378   {
5379     ostiInitiatorIOCompleted( tiRoot,
5380                               tiIORequest,
5381                               tiIOSuccess,
5382                               SCSI_STAT_GOOD,
5383                               agNULL,
5384                               satIOContext->interruptContext);
5385   }
5386   return tiSuccess;
5387 }
5388
5389
5390 /*****************************************************************************/
5391 /*! \brief SAT implementation for SCSI REQUEST SENSE.
5392  *
5393  *  SAT implementation for SCSI REQUEST SENSE.
5394  *
5395  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
5396  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
5397  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
5398  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
5399  *  \param   satIOContext_t:   Pointer to the SAT IO Context
5400  *
5401  *  \return If command is started successfully
5402  *    - \e tiSuccess:     I/O request successfully initiated.
5403  *    - \e tiBusy:        No resources available, try again later.
5404  *    - \e tiIONoDevice:  Invalid device handle.
5405  *    - \e tiError:       Other errors.
5406  */
5407 /*****************************************************************************/
5408 GLOBAL bit32  satRequestSense(
5409                    tiRoot_t                  *tiRoot,
5410                    tiIORequest_t             *tiIORequest,
5411                    tiDeviceHandle_t          *tiDeviceHandle,
5412                    tiScsiInitiatorRequest_t *tiScsiRequest,
5413                    satIOContext_t            *satIOContext)
5414 {
5415   /*
5416     SAT Rev 8 p38, Table25
5417     sending SMART RETURN STATUS
5418     Checking SMART Treshold Exceeded Condition is done in satRequestSenseCB()
5419     Only fixed format sense data is support. In other words, we don't support DESC bit is set
5420     in Request Sense
5421    */
5422   bit32                     status;
5423   bit32                     agRequestType;
5424   scsiRspSense_t            *pSense;
5425   satDeviceData_t           *pSatDevData;
5426   tiIniScsiCmnd_t           *scsiCmnd;
5427   agsaFisRegHostToDevice_t  *fis;
5428   tdIORequestBody_t         *tdIORequestBody;
5429   satInternalIo_t           *satIntIo = agNULL;
5430   satIOContext_t            *satIOContext2;
5431
5432   TI_DBG4(("satRequestSense entry: tiDeviceHandle=%p tiIORequest=%p\n",
5433       tiDeviceHandle, tiIORequest));
5434
5435   pSense            = (scsiRspSense_t *) tiScsiRequest->sglVirtualAddr;
5436   pSatDevData       = satIOContext->pSatDevData;
5437   scsiCmnd          = &tiScsiRequest->scsiCmnd;
5438   fis               = satIOContext->pFis;
5439
5440   TI_DBG4(("satRequestSense: pSatDevData=%p\n", pSatDevData));
5441
5442   /* checking CONTROL */
5443   /* NACA == 1 or LINK == 1*/
5444   if ( (scsiCmnd->cdb[5] & SCSI_NACA_MASK) || (scsiCmnd->cdb[5] & SCSI_LINK_MASK) )
5445   {
5446     satSetSensePayload( pSense,
5447                         SCSI_SNSKEY_ILLEGAL_REQUEST,
5448                         0,
5449                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
5450                         satIOContext);
5451
5452     ostiInitiatorIOCompleted( tiRoot,
5453                               tiIORequest,
5454                               tiIOSuccess,
5455                               SCSI_STAT_CHECK_CONDITION,
5456                               satIOContext->pTiSenseData,
5457                               satIOContext->interruptContext );
5458
5459     TI_DBG1(("satRequestSense: return control\n"));
5460     return tiSuccess;
5461   }
5462
5463   /*
5464     Only fixed format sense data is support. In other words, we don't support DESC bit is set
5465     in Request Sense
5466    */
5467   if ( scsiCmnd->cdb[1] & ATA_REMOVABLE_MEDIA_DEVICE_MASK )
5468   {
5469     satSetSensePayload( pSense,
5470                         SCSI_SNSKEY_ILLEGAL_REQUEST,
5471                         0,
5472                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
5473                         satIOContext);
5474
5475     ostiInitiatorIOCompleted( tiRoot,
5476                               tiIORequest,
5477                               tiIOSuccess,
5478                               SCSI_STAT_CHECK_CONDITION,
5479                               satIOContext->pTiSenseData,
5480                               satIOContext->interruptContext );
5481
5482     TI_DBG1(("satRequestSense: DESC bit is set, which we don't support\n"));
5483     return tiSuccess;
5484   }
5485
5486
5487   if (pSatDevData->satSMARTEnabled == agTRUE)
5488   {
5489     /* sends SMART RETURN STATUS */
5490     fis->h.fisType        = 0x27;                   /* Reg host to device */
5491     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
5492
5493     fis->h.command        = SAT_SMART_RETURN_STATUS;    /* 0xB0 */
5494     fis->h.features       = 0xDA;                   /* FIS features */
5495     fis->d.featuresExp    = 0;                      /* FIS reserve */
5496     fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
5497     fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
5498     fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
5499     fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
5500     fis->d.lbaMid         = 0x4F;                   /* FIS LBA (15:8 ) */
5501     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
5502     fis->d.lbaHigh        = 0xC2;                   /* FIS LBA (23:16) */
5503     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
5504     fis->d.device         = 0;                      /* FIS DEV is discared in SATA */
5505     fis->d.control        = 0;                      /* FIS HOB bit clear */
5506     fis->d.reserved4      = 0;
5507     fis->d.reserved5      = 0;
5508
5509     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
5510     /* Initialize CB for SATA completion.
5511      */
5512     satIOContext->satCompleteCB = &satRequestSenseCB;
5513
5514     /*
5515      * Prepare SGL and send FIS to LL layer.
5516      */
5517     satIOContext->reqType = agRequestType;       /* Save it */
5518
5519     status = sataLLIOStart( tiRoot,
5520                             tiIORequest,
5521                             tiDeviceHandle,
5522                             tiScsiRequest,
5523                             satIOContext);
5524
5525     TI_DBG4(("satRequestSense: if return, status %d\n", status));
5526     return (status);
5527   }
5528   else
5529   {
5530     /*allocate iocontext for xmitting xmit SAT_CHECK_POWER_MODE
5531       then call satRequestSense2 */
5532
5533     TI_DBG4(("satRequestSense: before satIntIo %p\n", satIntIo));
5534     /* allocate iocontext */
5535     satIntIo = satAllocIntIoResource( tiRoot,
5536                                       tiIORequest, /* original request */
5537                                       pSatDevData,
5538                                       tiScsiRequest->scsiCmnd.expDataLength,
5539                                       satIntIo);
5540
5541     TI_DBG4(("satRequestSense: after satIntIo %p\n", satIntIo));
5542
5543     if (satIntIo == agNULL)
5544     {
5545       /* memory allocation failure */
5546       satFreeIntIoResource( tiRoot,
5547                             pSatDevData,
5548                             satIntIo);
5549
5550       /* failed during sending SMART RETURN STATUS */
5551       satSetSensePayload( pSense,
5552                           SCSI_SNSKEY_NO_SENSE,
5553                           0,
5554                           SCSI_SNSCODE_HARDWARE_IMPENDING_FAILURE,
5555                           satIOContext);
5556
5557       ostiInitiatorIOCompleted( tiRoot,
5558                                 tiIORequest,
5559                                 tiIOSuccess,
5560                                 SCSI_STAT_GOOD,
5561                                 agNULL,
5562                                 satIOContext->interruptContext );
5563
5564       TI_DBG4(("satRequestSense: else fail 1\n"));
5565       return tiSuccess;
5566     } /* end of memory allocation failure */
5567
5568
5569     /*
5570      * Need to initialize all the fields within satIOContext except
5571      * reqType and satCompleteCB which will be set depending on cmd.
5572      */
5573
5574     if (satIntIo == agNULL)
5575     {
5576       TI_DBG4(("satRequestSense: satIntIo is NULL\n"));
5577     }
5578     else
5579     {
5580       TI_DBG4(("satRequestSense: satIntIo is NOT NULL\n"));
5581     }
5582     /* use this --- tttttthe one the same */
5583
5584
5585     satIntIo->satOrgTiIORequest = tiIORequest;
5586     tdIORequestBody = (tdIORequestBody_t *)satIntIo->satIntRequestBody;
5587     satIOContext2 = &(tdIORequestBody->transport.SATA.satIOContext);
5588
5589     satIOContext2->pSatDevData   = pSatDevData;
5590     satIOContext2->pFis          = &(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev);
5591     satIOContext2->pScsiCmnd     = &(satIntIo->satIntTiScsiXchg.scsiCmnd);
5592     satIOContext2->pSense        = &(tdIORequestBody->transport.SATA.sensePayload);
5593     satIOContext2->pTiSenseData  = &(tdIORequestBody->transport.SATA.tiSenseData);
5594     satIOContext2->pTiSenseData->senseData = satIOContext2->pSense;
5595     satIOContext2->tiRequestBody = satIntIo->satIntRequestBody;
5596     satIOContext2->interruptContext = satIOContext->interruptContext;
5597     satIOContext2->satIntIoContext  = satIntIo;
5598     satIOContext2->ptiDeviceHandle = tiDeviceHandle;
5599     satIOContext2->satOrgIOContext = satIOContext;
5600
5601     TI_DBG4(("satRequestSense: satIntIo->satIntTiScsiXchg.agSgl1.len %d\n", satIntIo->satIntTiScsiXchg.agSgl1.len));
5602
5603     TI_DBG4(("satRequestSense: satIntIo->satIntTiScsiXchg.agSgl1.upper %d\n", satIntIo->satIntTiScsiXchg.agSgl1.upper));
5604
5605     TI_DBG4(("satRequestSense: satIntIo->satIntTiScsiXchg.agSgl1.lower %d\n", satIntIo->satIntTiScsiXchg.agSgl1.lower));
5606
5607     TI_DBG4(("satRequestSense: satIntIo->satIntTiScsiXchg.agSgl1.type %d\n", satIntIo->satIntTiScsiXchg.agSgl1.type));
5608
5609     status = satRequestSense_1( tiRoot,
5610                                &(satIntIo->satIntTiIORequest),
5611                                tiDeviceHandle,
5612                                &(satIntIo->satIntTiScsiXchg),
5613                                satIOContext2);
5614
5615     if (status != tiSuccess)
5616     {
5617       satFreeIntIoResource( tiRoot,
5618                             pSatDevData,
5619                             satIntIo);
5620
5621       /* failed during sending SMART RETURN STATUS */
5622       satSetSensePayload( pSense,
5623                           SCSI_SNSKEY_NO_SENSE,
5624                           0,
5625                           SCSI_SNSCODE_HARDWARE_IMPENDING_FAILURE,
5626                           satIOContext);
5627
5628       ostiInitiatorIOCompleted( tiRoot,
5629                                 tiIORequest,
5630                                 tiIOSuccess,
5631                                 SCSI_STAT_CHECK_CONDITION,
5632                                 agNULL,
5633                                 satIOContext->interruptContext );
5634
5635       TI_DBG1(("satRequestSense: else fail 2\n"));
5636       return tiSuccess;
5637     }
5638     TI_DBG4(("satRequestSense: else return success\n"));
5639     return tiSuccess;
5640   }
5641 }
5642
5643
5644 /*****************************************************************************/
5645 /*! \brief SAT implementation for SCSI REQUEST SENSE.
5646  *
5647  *  SAT implementation for SCSI REQUEST SENSE.
5648  *  Sub function of satRequestSense
5649  *
5650  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
5651  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
5652  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
5653  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
5654  *  \param   satIOContext_t:   Pointer to the SAT IO Context
5655  *
5656  *  \return If command is started successfully
5657  *    - \e tiSuccess:     I/O request successfully initiated.
5658  *    - \e tiBusy:        No resources available, try again later.
5659  *    - \e tiIONoDevice:  Invalid device handle.
5660  *    - \e tiError:       Other errors.
5661  */
5662 /*****************************************************************************/
5663 GLOBAL bit32  satRequestSense_1(
5664                    tiRoot_t                  *tiRoot,
5665                    tiIORequest_t             *tiIORequest,
5666                    tiDeviceHandle_t          *tiDeviceHandle,
5667                    tiScsiInitiatorRequest_t *tiScsiRequest,
5668                    satIOContext_t            *satIOContext)
5669 {
5670   /*
5671     sends SAT_CHECK_POWER_MODE
5672   */
5673   bit32                     status;
5674   bit32                     agRequestType;
5675   agsaFisRegHostToDevice_t  *fis;
5676
5677   TI_DBG4(("satRequestSense_1 entry: tiDeviceHandle=%p tiIORequest=%p\n",
5678       tiDeviceHandle, tiIORequest));
5679
5680   fis               = satIOContext->pFis;
5681   /*
5682    * Send the ATA CHECK POWER MODE command.
5683    */
5684   fis->h.fisType        = 0x27;                   /* Reg host to device */
5685   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
5686
5687   fis->h.command        = SAT_CHECK_POWER_MODE;   /* 0xE5 */
5688   fis->h.features       = 0;
5689   fis->d.lbaLow         = 0;
5690   fis->d.lbaMid         = 0;
5691   fis->d.lbaHigh        = 0;
5692   fis->d.device         = 0;
5693   fis->d.lbaLowExp      = 0;
5694   fis->d.lbaMidExp      = 0;
5695   fis->d.lbaHighExp     = 0;
5696   fis->d.featuresExp    = 0;
5697   fis->d.sectorCount    = 0;
5698   fis->d.sectorCountExp = 0;
5699   fis->d.reserved4      = 0;
5700   fis->d.control        = 0;                      /* FIS HOB bit clear */
5701   fis->d.reserved5      = 0;
5702
5703   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
5704
5705   /* Initialize CB for SATA completion.
5706    */
5707   satIOContext->satCompleteCB = &satRequestSenseCB;
5708
5709   /*
5710    * Prepare SGL and send FIS to LL layer.
5711    */
5712   satIOContext->reqType = agRequestType;       /* Save it */
5713
5714
5715   TI_DBG4(("satRequestSense_1: agSgl1.len %d\n", tiScsiRequest->agSgl1.len));
5716
5717   TI_DBG4(("satRequestSense_1: agSgl1.upper %d\n", tiScsiRequest->agSgl1.upper));
5718
5719   TI_DBG4(("satRequestSense_1: agSgl1.lower %d\n", tiScsiRequest->agSgl1.lower));
5720
5721   TI_DBG4(("satRequestSense_1: agSgl1.type %d\n", tiScsiRequest->agSgl1.type));
5722
5723   //  tdhexdump("satRequestSense_1", (bit8 *)fis, sizeof(agsaFisRegHostToDevice_t));
5724
5725   status = sataLLIOStart( tiRoot,
5726                           tiIORequest,
5727                           tiDeviceHandle,
5728                           tiScsiRequest,
5729                           satIOContext);
5730
5731
5732
5733   return status;
5734 }
5735
5736
5737 /*****************************************************************************/
5738 /*! \brief SAT implementation for SCSI INQUIRY.
5739  *
5740  *  SAT implementation for SCSI INQUIRY.
5741  *
5742  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
5743  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
5744  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
5745  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
5746  *  \param   satIOContext_t:   Pointer to the SAT IO Context
5747  *
5748  *  \return If command is started successfully
5749  *    - \e tiSuccess:     I/O request successfully initiated.
5750  *    - \e tiBusy:        No resources available, try again later.
5751  *    - \e tiIONoDevice:  Invalid device handle.
5752  *    - \e tiError:       Other errors.
5753  */
5754 /*****************************************************************************/
5755 GLOBAL bit32  satInquiry(
5756                    tiRoot_t                  *tiRoot,
5757                    tiIORequest_t             *tiIORequest,
5758                    tiDeviceHandle_t          *tiDeviceHandle,
5759                    tiScsiInitiatorRequest_t *tiScsiRequest,
5760                    satIOContext_t            *satIOContext)
5761 {
5762   /*
5763     CMDDT bit is obsolete in SPC-3 and this is assumed in SAT revision 8
5764   */
5765   scsiRspSense_t            *pSense;
5766   tiIniScsiCmnd_t           *scsiCmnd;
5767   satDeviceData_t           *pSatDevData;
5768   bit32                     status;
5769
5770   TI_DBG5(("satInquiry: start\n"));
5771   TI_DBG5(("satInquiry entry: tiDeviceHandle=%p tiIORequest=%p\n",
5772       tiDeviceHandle, tiIORequest));
5773   pSense      = satIOContext->pSense;
5774   scsiCmnd    = &tiScsiRequest->scsiCmnd;
5775   pSatDevData = satIOContext->pSatDevData;
5776   TI_DBG5(("satInquiry: pSatDevData=%p\n", pSatDevData));
5777   //tdhexdump("satInquiry", (bit8 *)scsiCmnd->cdb, 6);
5778   /* checking CONTROL */
5779   /* NACA == 1 or LINK == 1*/
5780   if ( (scsiCmnd->cdb[5] & SCSI_NACA_MASK) || (scsiCmnd->cdb[5] & SCSI_LINK_MASK) )
5781   {
5782     satSetSensePayload( pSense,
5783                         SCSI_SNSKEY_ILLEGAL_REQUEST,
5784                         0,
5785                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
5786                         satIOContext);
5787     ostiInitiatorIOCompleted( tiRoot,
5788                               tiIORequest,
5789                               tiIOSuccess,
5790                               SCSI_STAT_CHECK_CONDITION,
5791                               satIOContext->pTiSenseData,
5792                               satIOContext->interruptContext );
5793     TI_DBG2(("satInquiry: return control\n"));
5794     return tiSuccess;
5795   }
5796
5797   /* checking EVPD and Allocation Length */
5798   /* SPC-4 spec 6.4 p141 */
5799   /* EVPD bit == 0 && PAGE CODE != 0 */
5800   if ( !(scsiCmnd->cdb[1] & SCSI_EVPD_MASK) &&
5801        (scsiCmnd->cdb[2] != 0)
5802        )
5803   {
5804     satSetSensePayload( pSense,
5805                         SCSI_SNSKEY_ILLEGAL_REQUEST,
5806                         0,
5807                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
5808                         satIOContext);
5809     ostiInitiatorIOCompleted( tiRoot,
5810                               tiIORequest,
5811                               tiIOSuccess,
5812                               SCSI_STAT_CHECK_CONDITION,
5813                               satIOContext->pTiSenseData,
5814                               satIOContext->interruptContext );
5815     TI_DBG1(("satInquiry: return EVPD and PAGE CODE\n"));
5816     return tiSuccess;
5817   }
5818   TI_DBG6(("satInquiry: allocation length 0x%x %d\n", ((scsiCmnd->cdb[3]) << 8) + scsiCmnd->cdb[4], ((scsiCmnd->cdb[3]) << 8) + scsiCmnd->cdb[4]));
5819
5820   /* convert OS IO to TD internal IO */
5821   if ( pSatDevData->IDDeviceValid == agFALSE)
5822   {
5823     status = satStartIDDev(
5824                          tiRoot,
5825                          tiIORequest,
5826                          tiDeviceHandle,
5827                          tiScsiRequest,
5828                          satIOContext
5829                          );
5830     TI_DBG6(("satInquiry: end status %d\n", status));
5831     return status;
5832   }
5833   else
5834   {
5835     TI_DBG6(("satInquiry: calling satInquiryIntCB\n"));
5836     satInquiryIntCB(
5837                     tiRoot,
5838                     tiIORequest,
5839                     tiDeviceHandle,
5840                     tiScsiRequest,
5841                     satIOContext
5842                     );
5843
5844     return tiSuccess;
5845   }
5846
5847 }
5848
5849
5850 /*****************************************************************************/
5851 /*! \brief SAT implementation for SCSI satReadCapacity10.
5852  *
5853  *  SAT implementation for SCSI satReadCapacity10.
5854  *
5855  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
5856  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
5857  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
5858  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
5859  *  \param   satIOContext_t:   Pointer to the SAT IO Context
5860  *
5861  *  \return If command is started successfully
5862  *    - \e tiSuccess:     I/O request successfully initiated.
5863  *    - \e tiBusy:        No resources available, try again later.
5864  *    - \e tiIONoDevice:  Invalid device handle.
5865  *    - \e tiError:       Other errors.
5866  */
5867 /*****************************************************************************/
5868 GLOBAL bit32  satReadCapacity10(
5869                    tiRoot_t                  *tiRoot,
5870                    tiIORequest_t             *tiIORequest,
5871                    tiDeviceHandle_t          *tiDeviceHandle,
5872                    tiScsiInitiatorRequest_t *tiScsiRequest,
5873                    satIOContext_t            *satIOContext)
5874 {
5875   scsiRspSense_t          *pSense;
5876   tiIniScsiCmnd_t         *scsiCmnd;
5877   bit8              *pVirtAddr;
5878   satDeviceData_t         *pSatDevData;
5879   agsaSATAIdentifyData_t  *pSATAIdData;
5880   bit32                   lastLba;
5881   bit32                   word117_118;
5882   bit32                   word117;
5883   bit32                   word118;
5884   TI_DBG5(("satReadCapacity10: start: tiDeviceHandle=%p tiIORequest=%p\n",
5885       tiDeviceHandle, tiIORequest));
5886
5887   pSense      = satIOContext->pSense;
5888   pVirtAddr   = (bit8 *) tiScsiRequest->sglVirtualAddr;
5889   scsiCmnd    = &tiScsiRequest->scsiCmnd;
5890   pSatDevData = satIOContext->pSatDevData;
5891   pSATAIdData = &pSatDevData->satIdentifyData;
5892
5893
5894   /* checking CONTROL */
5895   /* NACA == 1 or LINK == 1*/
5896   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
5897   {
5898     satSetSensePayload( pSense,
5899                         SCSI_SNSKEY_ILLEGAL_REQUEST,
5900                         0,
5901                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
5902                         satIOContext);
5903
5904     ostiInitiatorIOCompleted( tiRoot,
5905                               tiIORequest,
5906                               tiIOSuccess,
5907                               SCSI_STAT_CHECK_CONDITION,
5908                               satIOContext->pTiSenseData,
5909                               satIOContext->interruptContext );
5910
5911     TI_DBG1(("satReadCapacity10: return control\n"));
5912     return tiSuccess;
5913   }
5914
5915
5916   /*
5917    * If Logical block address is not set to zero, return error
5918    */
5919   if ((scsiCmnd->cdb[2] || scsiCmnd->cdb[3] || scsiCmnd->cdb[4] || scsiCmnd->cdb[5]))
5920   {
5921     TI_DBG1(("satReadCapacity10 *** ERROR *** logical address non zero, tiDeviceHandle=%p tiIORequest=%p\n",
5922         tiDeviceHandle, tiIORequest));
5923
5924     satSetSensePayload( pSense,
5925                         SCSI_SNSKEY_ILLEGAL_REQUEST,
5926                         0,
5927                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
5928                         satIOContext);
5929
5930     ostiInitiatorIOCompleted( tiRoot,
5931                               tiIORequest,
5932                               tiIOSuccess,
5933                               SCSI_STAT_CHECK_CONDITION,
5934                               satIOContext->pTiSenseData,
5935                               satIOContext->interruptContext );
5936     return tiSuccess;
5937
5938   }
5939
5940   /*
5941    * If PMI bit is not zero, return error
5942    */
5943   if ( ((scsiCmnd->cdb[8]) & SCSI_READ_CAPACITY10_PMI_MASK) != 0 )
5944   {
5945     TI_DBG1(("satReadCapacity10 *** ERROR *** PMI is not zero, tiDeviceHandle=%p tiIORequest=%p\n",
5946         tiDeviceHandle, tiIORequest));
5947
5948     satSetSensePayload( pSense,
5949                         SCSI_SNSKEY_ILLEGAL_REQUEST,
5950                         0,
5951                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
5952                         satIOContext);
5953
5954     ostiInitiatorIOCompleted( tiRoot,
5955                               tiIORequest,
5956                               tiIOSuccess,
5957                               SCSI_STAT_CHECK_CONDITION,
5958                               satIOContext->pTiSenseData,
5959                               satIOContext->interruptContext );
5960     return tiSuccess;
5961
5962   }
5963
5964   /*
5965     filling in Read Capacity parameter data
5966     saved identify device has been already flipped
5967     See ATA spec p125 and p136 and SBC spec p54
5968   */
5969   /*
5970    * If 48-bit addressing is supported, set capacity information from Identify
5971    * Device Word 100-103.
5972    */
5973   if (pSatDevData->sat48BitSupport == agTRUE)
5974   {
5975     /*
5976      * Setting RETURNED LOGICAL BLOCK ADDRESS in READ CAPACITY(10) response data:
5977      * SBC-2 specifies that if the capacity exceeded the 4-byte RETURNED LOGICAL
5978      * BLOCK ADDRESS in READ CAPACITY(10) parameter data, the the RETURNED LOGICAL
5979      * BLOCK ADDRESS should be set to 0xFFFFFFFF so the application client would
5980      * then issue a READ CAPACITY(16) command.
5981      */
5982     /* ATA Identify Device information word 100 - 103 */
5983     if ( (pSATAIdData->maxLBA32_47 != 0 ) || (pSATAIdData->maxLBA48_63 != 0))
5984     {
5985       pVirtAddr[0] = 0xFF;        /* MSB number of block */
5986       pVirtAddr[1] = 0xFF;
5987       pVirtAddr[2] = 0xFF;
5988       pVirtAddr[3] = 0xFF;        /* LSB number of block */
5989       TI_DBG1(("satReadCapacity10: returns 0xFFFFFFFF\n"));
5990     }
5991     else  /* Fit the Readcapacity10 4-bytes response length */
5992     {
5993       lastLba = (((pSATAIdData->maxLBA16_31) << 16) ) |
5994                   (pSATAIdData->maxLBA0_15);
5995       lastLba = lastLba - 1;      /* LBA starts from zero */
5996
5997       /*
5998         for testing
5999       lastLba = lastLba - (512*10) - 1;
6000       */
6001
6002
6003       pVirtAddr[0] = (bit8)((lastLba >> 24) & 0xFF);    /* MSB */
6004       pVirtAddr[1] = (bit8)((lastLba >> 16) & 0xFF);
6005       pVirtAddr[2] = (bit8)((lastLba >> 8)  & 0xFF);
6006       pVirtAddr[3] = (bit8)((lastLba )      & 0xFF);    /* LSB */
6007
6008       TI_DBG3(("satReadCapacity10: lastLba is 0x%x %d\n", lastLba, lastLba));
6009       TI_DBG3(("satReadCapacity10: LBA 0 is 0x%x %d\n", pVirtAddr[0], pVirtAddr[0]));
6010       TI_DBG3(("satReadCapacity10: LBA 1 is 0x%x %d\n", pVirtAddr[1], pVirtAddr[1]));
6011       TI_DBG3(("satReadCapacity10: LBA 2 is 0x%x %d\n", pVirtAddr[2], pVirtAddr[2]));
6012       TI_DBG3(("satReadCapacity10: LBA 3 is 0x%x %d\n", pVirtAddr[3], pVirtAddr[3]));
6013
6014     }
6015   }
6016
6017   /*
6018    * For 28-bit addressing, set capacity information from Identify
6019    * Device Word 60-61.
6020    */
6021   else
6022   {
6023     /* ATA Identify Device information word 60 - 61 */
6024     lastLba = (((pSATAIdData->numOfUserAddressableSectorsHi) << 16) ) |
6025                 (pSATAIdData->numOfUserAddressableSectorsLo);
6026     lastLba = lastLba - 1;      /* LBA starts from zero */
6027
6028     pVirtAddr[0] = (bit8)((lastLba >> 24) & 0xFF);    /* MSB */
6029     pVirtAddr[1] = (bit8)((lastLba >> 16) & 0xFF);
6030     pVirtAddr[2] = (bit8)((lastLba >> 8)  & 0xFF);
6031     pVirtAddr[3] = (bit8)((lastLba )      & 0xFF);    /* LSB */
6032   }
6033   /* SAT Rev 8d */
6034   if (((pSATAIdData->word104_107[2]) & 0x1000) == 0)
6035   {
6036     TI_DBG5(("satReadCapacity10: Default Block Length is 512\n"));
6037     /*
6038      * Set the block size, fixed at 512 bytes.
6039      */
6040     pVirtAddr[4] = 0x00;        /* MSB block size in bytes */
6041     pVirtAddr[5] = 0x00;
6042     pVirtAddr[6] = 0x02;
6043     pVirtAddr[7] = 0x00;        /* LSB block size in bytes */
6044   }
6045   else
6046   {
6047     word118 = pSATAIdData->word112_126[6];
6048     word117 = pSATAIdData->word112_126[5];
6049
6050     word117_118 = (word118 << 16) + word117;
6051     word117_118 = word117_118 * 2;
6052     pVirtAddr[4] = (bit8)((word117_118 >> 24) & 0xFF);        /* MSB block size in bytes */
6053     pVirtAddr[5] = (bit8)((word117_118 >> 16) & 0xFF);
6054     pVirtAddr[6] = (bit8)((word117_118 >> 8) & 0xFF);
6055     pVirtAddr[7] = (bit8)(word117_118 & 0xFF);                /* LSB block size in bytes */
6056
6057     TI_DBG1(("satReadCapacity10: Nondefault word118 %d 0x%x \n", word118, word118));
6058     TI_DBG1(("satReadCapacity10: Nondefault word117 %d 0x%x \n", word117, word117));
6059     TI_DBG1(("satReadCapacity10: Nondefault Block Length is %d 0x%x \n",word117_118, word117_118));
6060
6061   }
6062
6063   /* fill in MAX LBA, which is used in satSendDiagnostic_1() */
6064   pSatDevData->satMaxLBA[0] = 0;            /* MSB */
6065   pSatDevData->satMaxLBA[1] = 0;
6066   pSatDevData->satMaxLBA[2] = 0;
6067   pSatDevData->satMaxLBA[3] = 0;
6068   pSatDevData->satMaxLBA[4] = pVirtAddr[0];
6069   pSatDevData->satMaxLBA[5] = pVirtAddr[1];
6070   pSatDevData->satMaxLBA[6] = pVirtAddr[2];
6071   pSatDevData->satMaxLBA[7] = pVirtAddr[3]; /* LSB */
6072
6073
6074   TI_DBG4(("satReadCapacity10 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x , tiDeviceHandle=%p tiIORequest=%p\n",
6075         pVirtAddr[0], pVirtAddr[1], pVirtAddr[2], pVirtAddr[3],
6076         pVirtAddr[4], pVirtAddr[5], pVirtAddr[6], pVirtAddr[7],
6077         tiDeviceHandle, tiIORequest));
6078
6079
6080   /*
6081    * Send the completion response now.
6082    */
6083   ostiInitiatorIOCompleted( tiRoot,
6084                             tiIORequest,
6085                             tiIOSuccess,
6086                             SCSI_STAT_GOOD,
6087                             agNULL,
6088                             satIOContext->interruptContext);
6089   return tiSuccess;
6090 }
6091
6092
6093 /*****************************************************************************/
6094 /*! \brief SAT implementation for SCSI satReadCapacity16.
6095  *
6096  *  SAT implementation for SCSI satReadCapacity16.
6097  *
6098  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
6099  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
6100  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
6101  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
6102  *  \param   satIOContext_t:   Pointer to the SAT IO Context
6103  *
6104  *  \return If command is started successfully
6105  *    - \e tiSuccess:     I/O request successfully initiated.
6106  *    - \e tiBusy:        No resources available, try again later.
6107  *    - \e tiIONoDevice:  Invalid device handle.
6108  *    - \e tiError:       Other errors.
6109  */
6110 /*****************************************************************************/
6111 GLOBAL bit32  satReadCapacity16(
6112                    tiRoot_t                  *tiRoot,
6113                    tiIORequest_t             *tiIORequest,
6114                    tiDeviceHandle_t          *tiDeviceHandle,
6115                    tiScsiInitiatorRequest_t *tiScsiRequest,
6116                    satIOContext_t            *satIOContext)
6117 {
6118
6119   scsiRspSense_t          *pSense;
6120   tiIniScsiCmnd_t         *scsiCmnd;
6121   bit8                    *pVirtAddr;
6122   satDeviceData_t         *pSatDevData;
6123   agsaSATAIdentifyData_t  *pSATAIdData;
6124   bit32                   lastLbaLo;
6125   bit32                   allocationLen;
6126   bit32                   readCapacityLen  = 32;
6127   bit32                   i = 0;
6128   TI_DBG5(("satReadCapacity16 start: tiDeviceHandle=%p tiIORequest=%p\n",
6129       tiDeviceHandle, tiIORequest));
6130
6131   pSense      = satIOContext->pSense;
6132   pVirtAddr   = (bit8 *) tiScsiRequest->sglVirtualAddr;
6133   scsiCmnd    = &tiScsiRequest->scsiCmnd;
6134   pSatDevData = satIOContext->pSatDevData;
6135   pSATAIdData = &pSatDevData->satIdentifyData;
6136
6137   /* Find the buffer size allocated by Initiator */
6138   allocationLen = (((bit32)scsiCmnd->cdb[10]) << 24) |
6139                   (((bit32)scsiCmnd->cdb[11]) << 16) |
6140                   (((bit32)scsiCmnd->cdb[12]) << 8 ) |
6141                   (((bit32)scsiCmnd->cdb[13])      );
6142
6143
6144   if (allocationLen < readCapacityLen)
6145   {
6146     TI_DBG1(("satReadCapacity16 *** ERROR *** insufficient len=0x%x readCapacityLen=0x%x\n", allocationLen, readCapacityLen));
6147
6148     satSetSensePayload( pSense,
6149                         SCSI_SNSKEY_ILLEGAL_REQUEST,
6150                         0,
6151                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
6152                         satIOContext);
6153
6154     ostiInitiatorIOCompleted( tiRoot,
6155                               tiIORequest,
6156                               tiIOSuccess,
6157                               SCSI_STAT_CHECK_CONDITION,
6158                               satIOContext->pTiSenseData,
6159                               satIOContext->interruptContext );
6160     return tiSuccess;
6161
6162   }
6163
6164   /* checking CONTROL */
6165   /* NACA == 1 or LINK == 1*/
6166   if ( (scsiCmnd->cdb[15] & SCSI_NACA_MASK) || (scsiCmnd->cdb[15] & SCSI_LINK_MASK) )
6167   {
6168     satSetSensePayload( pSense,
6169                         SCSI_SNSKEY_ILLEGAL_REQUEST,
6170                         0,
6171                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
6172                         satIOContext);
6173
6174     ostiInitiatorIOCompleted( tiRoot,
6175                               tiIORequest,
6176                               tiIOSuccess,
6177                               SCSI_STAT_CHECK_CONDITION,
6178                               satIOContext->pTiSenseData,
6179                               satIOContext->interruptContext );
6180
6181     TI_DBG1(("satReadCapacity16: return control\n"));
6182     return tiSuccess;
6183   }
6184
6185   /*
6186    * If Logical blcok address is not set to zero, return error
6187    */
6188   if ((scsiCmnd->cdb[2] || scsiCmnd->cdb[3] || scsiCmnd->cdb[4] || scsiCmnd->cdb[5]) ||
6189       (scsiCmnd->cdb[6] || scsiCmnd->cdb[7] || scsiCmnd->cdb[8] || scsiCmnd->cdb[9])  )
6190   {
6191     TI_DBG1(("satReadCapacity16 *** ERROR *** logical address non zero, tiDeviceHandle=%p tiIORequest=%p\n",
6192         tiDeviceHandle, tiIORequest));
6193
6194     satSetSensePayload( pSense,
6195                         SCSI_SNSKEY_ILLEGAL_REQUEST,
6196                         0,
6197                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
6198                         satIOContext);
6199
6200     ostiInitiatorIOCompleted( tiRoot,
6201                               tiIORequest,
6202                               tiIOSuccess,
6203                               SCSI_STAT_CHECK_CONDITION,
6204                               satIOContext->pTiSenseData,
6205                               satIOContext->interruptContext );
6206     return tiSuccess;
6207
6208   }
6209
6210   /*
6211    * If PMI bit is not zero, return error
6212    */
6213   if ( ((scsiCmnd->cdb[14]) & SCSI_READ_CAPACITY16_PMI_MASK) != 0 )
6214   {
6215     TI_DBG1(("satReadCapacity16 *** ERROR *** PMI is not zero, tiDeviceHandle=%p tiIORequest=%p\n",
6216         tiDeviceHandle, tiIORequest));
6217
6218     satSetSensePayload( pSense,
6219                         SCSI_SNSKEY_ILLEGAL_REQUEST,
6220                         0,
6221                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
6222                         satIOContext);
6223
6224     ostiInitiatorIOCompleted( tiRoot,
6225                               tiIORequest,
6226                               tiIOSuccess,
6227                               SCSI_STAT_CHECK_CONDITION,
6228                               satIOContext->pTiSenseData,
6229                               satIOContext->interruptContext );
6230     return tiSuccess;
6231
6232   }
6233
6234   /*
6235     filling in Read Capacity parameter data
6236   */
6237
6238   /*
6239    * If 48-bit addressing is supported, set capacity information from Identify
6240    * Device Word 100-103.
6241    */
6242   if (pSatDevData->sat48BitSupport == agTRUE)
6243   {
6244     pVirtAddr[0] = (bit8)(((pSATAIdData->maxLBA48_63) >> 8) & 0xff);  /* MSB */
6245     pVirtAddr[1] = (bit8)((pSATAIdData->maxLBA48_63)        & 0xff);
6246     pVirtAddr[2] = (bit8)(((pSATAIdData->maxLBA32_47) >> 8) & 0xff);
6247     pVirtAddr[3] = (bit8)((pSATAIdData->maxLBA32_47)        & 0xff);
6248
6249     lastLbaLo = (((pSATAIdData->maxLBA16_31) << 16) ) | (pSATAIdData->maxLBA0_15);
6250     lastLbaLo = lastLbaLo - 1;      /* LBA starts from zero */
6251
6252     pVirtAddr[4] = (bit8)((lastLbaLo >> 24) & 0xFF);
6253     pVirtAddr[5] = (bit8)((lastLbaLo >> 16) & 0xFF);
6254     pVirtAddr[6] = (bit8)((lastLbaLo >> 8)  & 0xFF);
6255     pVirtAddr[7] = (bit8)((lastLbaLo )      & 0xFF);    /* LSB */
6256
6257   }
6258
6259   /*
6260    * For 28-bit addressing, set capacity information from Identify
6261    * Device Word 60-61.
6262    */
6263   else
6264   {
6265     pVirtAddr[0] = 0;       /* MSB */
6266     pVirtAddr[1] = 0;
6267     pVirtAddr[2] = 0;
6268     pVirtAddr[3] = 0;
6269
6270     lastLbaLo = (((pSATAIdData->numOfUserAddressableSectorsHi) << 16) ) |
6271                   (pSATAIdData->numOfUserAddressableSectorsLo);
6272     lastLbaLo = lastLbaLo - 1;      /* LBA starts from zero */
6273
6274     pVirtAddr[4] = (bit8)((lastLbaLo >> 24) & 0xFF);
6275     pVirtAddr[5] = (bit8)((lastLbaLo >> 16) & 0xFF);
6276     pVirtAddr[6] = (bit8)((lastLbaLo >> 8)  & 0xFF);
6277     pVirtAddr[7] = (bit8)((lastLbaLo )      & 0xFF);    /* LSB */
6278
6279   }
6280
6281   /*
6282    * Set the block size, fixed at 512 bytes.
6283    */
6284   pVirtAddr[8]  = 0x00;        /* MSB block size in bytes */
6285   pVirtAddr[9]  = 0x00;
6286   pVirtAddr[10] = 0x02;
6287   pVirtAddr[11] = 0x00;        /* LSB block size in bytes */
6288
6289
6290   /* fill in MAX LBA, which is used in satSendDiagnostic_1() */
6291   pSatDevData->satMaxLBA[0] = pVirtAddr[0];            /* MSB */
6292   pSatDevData->satMaxLBA[1] = pVirtAddr[1];
6293   pSatDevData->satMaxLBA[2] = pVirtAddr[2];
6294   pSatDevData->satMaxLBA[3] = pVirtAddr[3];
6295   pSatDevData->satMaxLBA[4] = pVirtAddr[4];
6296   pSatDevData->satMaxLBA[5] = pVirtAddr[5];
6297   pSatDevData->satMaxLBA[6] = pVirtAddr[6];
6298   pSatDevData->satMaxLBA[7] = pVirtAddr[7];             /* LSB */
6299
6300   TI_DBG5(("satReadCapacity16 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x , tiDeviceHandle=%p tiIORequest=%p\n",
6301         pVirtAddr[0], pVirtAddr[1], pVirtAddr[2], pVirtAddr[3],
6302         pVirtAddr[4], pVirtAddr[5], pVirtAddr[6], pVirtAddr[7],
6303         pVirtAddr[8], pVirtAddr[9], pVirtAddr[10], pVirtAddr[11],
6304         tiDeviceHandle, tiIORequest));
6305
6306   for(i=12;i<=31;i++)
6307   {
6308     pVirtAddr[i] = 0x00;
6309   }
6310
6311   /*
6312    * Send the completion response now.
6313    */
6314   if (allocationLen > readCapacityLen)
6315   {
6316     /* underrun */
6317     TI_DBG1(("satReadCapacity16 reporting underrun readCapacityLen=0x%x allocationLen=0x%x \n", readCapacityLen, allocationLen));
6318
6319     ostiInitiatorIOCompleted( tiRoot,
6320                               tiIORequest,
6321                               tiIOUnderRun,
6322                               allocationLen - readCapacityLen,
6323                               agNULL,
6324                               satIOContext->interruptContext );
6325
6326
6327   }
6328   else
6329   {
6330     ostiInitiatorIOCompleted( tiRoot,
6331                               tiIORequest,
6332                               tiIOSuccess,
6333                               SCSI_STAT_GOOD,
6334                               agNULL,
6335                               satIOContext->interruptContext);
6336   }
6337   return tiSuccess;
6338
6339 }
6340
6341
6342 /*****************************************************************************/
6343 /*! \brief SAT implementation for SCSI MODE SENSE (6).
6344  *
6345  *  SAT implementation for SCSI MODE SENSE (6).
6346  *
6347  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
6348  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
6349  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
6350  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
6351  *  \param   satIOContext_t:   Pointer to the SAT IO Context
6352  *
6353  *  \return If command is started successfully
6354  *    - \e tiSuccess:     I/O request successfully initiated.
6355  *    - \e tiBusy:        No resources available, try again later.
6356  *    - \e tiIONoDevice:  Invalid device handle.
6357  *    - \e tiError:       Other errors.
6358  */
6359 /*****************************************************************************/
6360 GLOBAL bit32  satModeSense6(
6361                    tiRoot_t                  *tiRoot,
6362                    tiIORequest_t             *tiIORequest,
6363                    tiDeviceHandle_t          *tiDeviceHandle,
6364                    tiScsiInitiatorRequest_t *tiScsiRequest,
6365                    satIOContext_t            *satIOContext)
6366 {
6367
6368   scsiRspSense_t          *pSense;
6369   bit32                   requestLen;
6370   tiIniScsiCmnd_t         *scsiCmnd;
6371   bit32                   pageSupported;
6372   bit8                    page;
6373   bit8                    *pModeSense;    /* Mode Sense data buffer */
6374   satDeviceData_t         *pSatDevData;
6375   bit8                    PC;
6376   bit8                    AllPages[MODE_SENSE6_RETURN_ALL_PAGES_LEN];
6377   bit8                    Control[MODE_SENSE6_CONTROL_PAGE_LEN];
6378   bit8                    RWErrorRecovery[MODE_SENSE6_READ_WRITE_ERROR_RECOVERY_PAGE_LEN];
6379   bit8                    Caching[MODE_SENSE6_CACHING_LEN];
6380   bit8                    InfoExceptionCtrl[MODE_SENSE6_INFORMATION_EXCEPTION_CONTROL_PAGE_LEN];
6381   bit8                    lenRead = 0;
6382
6383
6384   TI_DBG5(("satModeSense6 entry: tiDeviceHandle=%p tiIORequest=%p\n",
6385       tiDeviceHandle, tiIORequest));
6386
6387   pSense      = satIOContext->pSense;
6388   scsiCmnd    = &tiScsiRequest->scsiCmnd;
6389   pModeSense  = (bit8 *) tiScsiRequest->sglVirtualAddr;
6390   pSatDevData = satIOContext->pSatDevData;
6391
6392   //tdhexdump("satModeSense6", (bit8 *)scsiCmnd->cdb, 6);
6393   /* checking CONTROL */
6394   /* NACA == 1 or LINK == 1*/
6395   if ( (scsiCmnd->cdb[5] & SCSI_NACA_MASK) || (scsiCmnd->cdb[5] & SCSI_LINK_MASK) )
6396   {
6397     satSetSensePayload( pSense,
6398                         SCSI_SNSKEY_ILLEGAL_REQUEST,
6399                         0,
6400                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
6401                         satIOContext);
6402
6403     ostiInitiatorIOCompleted( tiRoot,
6404                               tiIORequest,
6405                               tiIOSuccess,
6406                               SCSI_STAT_CHECK_CONDITION,
6407                               satIOContext->pTiSenseData,
6408                               satIOContext->interruptContext );
6409
6410     TI_DBG2(("satModeSense6: return control\n"));
6411     return tiSuccess;
6412   }
6413
6414   /* checking PC(Page Control)
6415      SAT revion 8, 8.5.3 p33 and 10.1.2, p66
6416   */
6417   PC = (bit8)((scsiCmnd->cdb[2]) & SCSI_MODE_SENSE6_PC_MASK);
6418   if (PC != 0)
6419   {
6420     satSetSensePayload( pSense,
6421                         SCSI_SNSKEY_ILLEGAL_REQUEST,
6422                         0,
6423                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
6424                         satIOContext);
6425
6426     ostiInitiatorIOCompleted( tiRoot,
6427                               tiIORequest,
6428                               tiIOSuccess,
6429                               SCSI_STAT_CHECK_CONDITION,
6430                               satIOContext->pTiSenseData,
6431                               satIOContext->interruptContext );
6432
6433     TI_DBG1(("satModeSense6: return due to PC value pc 0x%x\n", PC >> 6));
6434     return tiSuccess;
6435   }
6436
6437   /* reading PAGE CODE */
6438   page = (bit8)((scsiCmnd->cdb[2]) & SCSI_MODE_SENSE6_PAGE_CODE_MASK);
6439
6440
6441   TI_DBG5(("satModeSense6: page=0x%x, tiDeviceHandle=%p tiIORequest=%p\n",
6442              page, tiDeviceHandle, tiIORequest));
6443
6444   requestLen = scsiCmnd->cdb[4];
6445
6446     /*
6447     Based on page code value, returns a corresponding mode page
6448     note: no support for subpage
6449   */
6450
6451   switch(page)
6452   {
6453     case MODESENSE_RETURN_ALL_PAGES:
6454     case MODESENSE_CONTROL_PAGE: /* control */
6455     case MODESENSE_READ_WRITE_ERROR_RECOVERY_PAGE: /* Read-Write Error Recovery */
6456     case MODESENSE_CACHING: /* caching */
6457     case MODESENSE_INFORMATION_EXCEPTION_CONTROL_PAGE: /* informational exceptions control*/
6458       pageSupported = agTRUE;
6459       break;
6460     case MODESENSE_VENDOR_SPECIFIC_PAGE: /* vendor specific */
6461     default:
6462       pageSupported = agFALSE;
6463       break;
6464   }
6465
6466   if (pageSupported == agFALSE)
6467   {
6468
6469     TI_DBG1(("satModeSense6 *** ERROR *** not supported page 0x%x tiDeviceHandle=%p tiIORequest=%p\n",
6470         page, tiDeviceHandle, tiIORequest));
6471
6472     satSetSensePayload( pSense,
6473                         SCSI_SNSKEY_ILLEGAL_REQUEST,
6474                         0,
6475                         SCSI_SNSCODE_INVALID_COMMAND,
6476                         satIOContext);
6477
6478     ostiInitiatorIOCompleted( tiRoot,
6479                               tiIORequest,
6480                               tiIOSuccess,
6481                               SCSI_STAT_CHECK_CONDITION,
6482                               satIOContext->pTiSenseData,
6483                               satIOContext->interruptContext );
6484     return tiSuccess;
6485   }
6486
6487   switch(page)
6488   {
6489   case MODESENSE_RETURN_ALL_PAGES:
6490     lenRead = (bit8)MIN(requestLen, MODE_SENSE6_RETURN_ALL_PAGES_LEN);
6491     break;
6492   case MODESENSE_CONTROL_PAGE: /* control */
6493     lenRead = (bit8)MIN(requestLen, MODE_SENSE6_CONTROL_PAGE_LEN);
6494     break;
6495   case MODESENSE_READ_WRITE_ERROR_RECOVERY_PAGE: /* Read-Write Error Recovery */
6496     lenRead = (bit8)MIN(requestLen, MODE_SENSE6_READ_WRITE_ERROR_RECOVERY_PAGE_LEN);
6497     break;
6498   case MODESENSE_CACHING: /* caching */
6499     lenRead = (bit8)MIN(requestLen, MODE_SENSE6_CACHING_LEN);
6500     break;
6501   case MODESENSE_INFORMATION_EXCEPTION_CONTROL_PAGE: /* informational exceptions control*/
6502     lenRead = (bit8)MIN(requestLen, MODE_SENSE6_INFORMATION_EXCEPTION_CONTROL_PAGE_LEN);
6503     break;
6504   default:
6505     TI_DBG1(("satModeSense6: default error page %d\n", page));
6506     break;
6507   }
6508
6509   if (page == MODESENSE_RETURN_ALL_PAGES)
6510   {
6511     TI_DBG5(("satModeSense6: MODESENSE_RETURN_ALL_PAGES\n"));
6512     AllPages[0] = (bit8)(lenRead - 1);
6513     AllPages[1] = 0x00; /* default medium type (currently mounted medium type) */
6514     AllPages[2] = 0x00; /* no write-protect, no support for DPO-FUA */
6515     AllPages[3] = 0x08; /* block descriptor length */
6516
6517     /*
6518      * Fill-up direct-access device block-descriptor, SAT, Table 19
6519      */
6520
6521     /* density code */
6522     AllPages[4]  = 0x04; /* density-code : reserved for direct-access */
6523     /* number of blocks */
6524     AllPages[5]  = 0x00; /* unspecified */
6525     AllPages[6]  = 0x00; /* unspecified */
6526     AllPages[7]  = 0x00; /* unspecified */
6527     /* reserved */
6528     AllPages[8]  = 0x00; /* reserved */
6529     /* Block size */
6530     AllPages[9]  = 0x00;
6531     AllPages[10] = 0x02;   /* Block size is always 512 bytes */
6532     AllPages[11] = 0x00;
6533
6534     /* MODESENSE_READ_WRITE_ERROR_RECOVERY_PAGE */
6535     AllPages[12] = 0x01; /* page code */
6536     AllPages[13] = 0x0A; /* page length */
6537     AllPages[14] = 0x40; /* ARRE is set */
6538     AllPages[15] = 0x00;
6539     AllPages[16] = 0x00;
6540     AllPages[17] = 0x00;
6541     AllPages[18] = 0x00;
6542     AllPages[19] = 0x00;
6543     AllPages[20] = 0x00;
6544     AllPages[21] = 0x00;
6545     AllPages[22] = 0x00;
6546     AllPages[23] = 0x00;
6547     /* MODESENSE_CACHING */
6548     AllPages[24] = 0x08; /* page code */
6549     AllPages[25] = 0x12; /* page length */
6550 #ifdef NOT_YET
6551     if (pSatDevData->satWriteCacheEnabled == agTRUE)
6552     {
6553       AllPages[26] = 0x04;/* WCE bit is set */
6554     }
6555     else
6556     {
6557       AllPages[26] = 0x00;/* WCE bit is NOT set */
6558     }
6559 #endif
6560     AllPages[26] = 0x00;/* WCE bit is NOT set */
6561
6562     AllPages[27] = 0x00;
6563     AllPages[28] = 0x00;
6564     AllPages[29] = 0x00;
6565     AllPages[30] = 0x00;
6566     AllPages[31] = 0x00;
6567     AllPages[32] = 0x00;
6568     AllPages[33] = 0x00;
6569     AllPages[34] = 0x00;
6570     AllPages[35] = 0x00;
6571     if (pSatDevData->satLookAheadEnabled == agTRUE)
6572     {
6573       AllPages[36] = 0x00;/* DRA bit is NOT set */
6574     }
6575     else
6576     {
6577       AllPages[36] = 0x20;/* DRA bit is set */
6578     }
6579     AllPages[37] = 0x00;
6580     AllPages[38] = 0x00;
6581     AllPages[39] = 0x00;
6582     AllPages[40] = 0x00;
6583     AllPages[41] = 0x00;
6584     AllPages[42] = 0x00;
6585     AllPages[43] = 0x00;
6586     /* MODESENSE_CONTROL_PAGE */
6587     AllPages[44] = 0x0A; /* page code */
6588     AllPages[45] = 0x0A; /* page length */
6589     AllPages[46] = 0x02; /* only GLTSD bit is set */
6590     if (pSatDevData->satNCQ == agTRUE)
6591     {
6592       AllPages[47] = 0x12; /* Queue Alogorithm modifier 1b and QErr 01b*/
6593     }
6594     else
6595     {
6596       AllPages[47] = 0x02; /* Queue Alogorithm modifier 0b and QErr 01b */
6597     }
6598     AllPages[48] = 0x00;
6599     AllPages[49] = 0x00;
6600     AllPages[50] = 0x00; /* obsolete */
6601     AllPages[51] = 0x00; /* obsolete */
6602     AllPages[52] = 0xFF; /* Busy Timeout Period */
6603     AllPages[53] = 0xFF; /* Busy Timeout Period */
6604     AllPages[54] = 0x00; /* we don't support non-000b value for the self-test code */
6605     AllPages[55] = 0x00; /* we don't support non-000b value for the self-test code */
6606     /* MODESENSE_INFORMATION_EXCEPTION_CONTROL_PAGE */
6607     AllPages[56] = 0x1C; /* page code */
6608     AllPages[57] = 0x0A; /* page length */
6609     if (pSatDevData->satSMARTEnabled == agTRUE)
6610     {
6611       AllPages[58] = 0x00;/* DEXCPT bit is NOT set */
6612     }
6613     else
6614     {
6615       AllPages[58] = 0x08;/* DEXCPT bit is set */
6616     }
6617     AllPages[59] = 0x00; /* We don't support MRIE */
6618     AllPages[60] = 0x00; /* Interval timer vendor-specific */
6619     AllPages[61] = 0x00;
6620     AllPages[62] = 0x00;
6621     AllPages[63] = 0x00;
6622     AllPages[64] = 0x00; /* REPORT-COUNT */
6623     AllPages[65] = 0x00;
6624     AllPages[66] = 0x00;
6625     AllPages[67] = 0x00;
6626
6627     osti_memcpy(pModeSense, &AllPages, lenRead);
6628   }
6629   else if (page == MODESENSE_CONTROL_PAGE)
6630   {
6631     TI_DBG5(("satModeSense6: MODESENSE_CONTROL_PAGE\n"));
6632     Control[0] = MODE_SENSE6_CONTROL_PAGE_LEN - 1;
6633     Control[1] = 0x00; /* default medium type (currently mounted medium type) */
6634     Control[2] = 0x00; /* no write-protect, no support for DPO-FUA */
6635     Control[3] = 0x08; /* block descriptor length */
6636     /*
6637      * Fill-up direct-access device block-descriptor, SAT, Table 19
6638      */
6639
6640     /* density code */
6641     Control[4]  = 0x04; /* density-code : reserved for direct-access */
6642     /* number of blocks */
6643     Control[5]  = 0x00; /* unspecified */
6644     Control[6]  = 0x00; /* unspecified */
6645     Control[7]  = 0x00; /* unspecified */
6646     /* reserved */
6647     Control[8]  = 0x00; /* reserved */
6648     /* Block size */
6649     Control[9]  = 0x00;
6650     Control[10] = 0x02;   /* Block size is always 512 bytes */
6651     Control[11] = 0x00;
6652     /*
6653      * Fill-up control mode page, SAT, Table 65
6654      */
6655     Control[12] = 0x0A; /* page code */
6656     Control[13] = 0x0A; /* page length */
6657     Control[14] = 0x02; /* only GLTSD bit is set */
6658     if (pSatDevData->satNCQ == agTRUE)
6659     {
6660       Control[15] = 0x12; /* Queue Alogorithm modifier 1b and QErr 01b*/
6661     }
6662     else
6663     {
6664       Control[15] = 0x02; /* Queue Alogorithm modifier 0b and QErr 01b */
6665     }
6666     Control[16] = 0x00;
6667     Control[17] = 0x00;
6668     Control[18] = 0x00; /* obsolete */
6669     Control[19] = 0x00; /* obsolete */
6670     Control[20] = 0xFF; /* Busy Timeout Period */
6671     Control[21] = 0xFF; /* Busy Timeout Period */
6672     Control[22] = 0x00; /* we don't support non-000b value for the self-test code */
6673     Control[23] = 0x00; /* we don't support non-000b value for the self-test code */
6674
6675     osti_memcpy(pModeSense, &Control, lenRead);
6676
6677   }
6678   else if (page == MODESENSE_READ_WRITE_ERROR_RECOVERY_PAGE)
6679   {
6680     TI_DBG5(("satModeSense6: MODESENSE_READ_WRITE_ERROR_RECOVERY_PAGE\n"));
6681     RWErrorRecovery[0] = MODE_SENSE6_READ_WRITE_ERROR_RECOVERY_PAGE_LEN - 1;
6682     RWErrorRecovery[1] = 0x00; /* default medium type (currently mounted medium type) */
6683     RWErrorRecovery[2] = 0x00; /* no write-protect, no support for DPO-FUA */
6684     RWErrorRecovery[3] = 0x08; /* block descriptor length */
6685     /*
6686      * Fill-up direct-access device block-descriptor, SAT, Table 19
6687      */
6688
6689     /* density code */
6690     RWErrorRecovery[4]  = 0x04; /* density-code : reserved for direct-access */
6691     /* number of blocks */
6692     RWErrorRecovery[5]  = 0x00; /* unspecified */
6693     RWErrorRecovery[6]  = 0x00; /* unspecified */
6694     RWErrorRecovery[7]  = 0x00; /* unspecified */
6695     /* reserved */
6696     RWErrorRecovery[8]  = 0x00; /* reserved */
6697     /* Block size */
6698     RWErrorRecovery[9]  = 0x00;
6699     RWErrorRecovery[10] = 0x02;   /* Block size is always 512 bytes */
6700     RWErrorRecovery[11] = 0x00;
6701     /*
6702      * Fill-up Read-Write Error Recovery mode page, SAT, Table 66
6703      */
6704     RWErrorRecovery[12] = 0x01; /* page code */
6705     RWErrorRecovery[13] = 0x0A; /* page length */
6706     RWErrorRecovery[14] = 0x40; /* ARRE is set */
6707     RWErrorRecovery[15] = 0x00;
6708     RWErrorRecovery[16] = 0x00;
6709     RWErrorRecovery[17] = 0x00;
6710     RWErrorRecovery[18] = 0x00;
6711     RWErrorRecovery[19] = 0x00;
6712     RWErrorRecovery[20] = 0x00;
6713     RWErrorRecovery[21] = 0x00;
6714     RWErrorRecovery[22] = 0x00;
6715     RWErrorRecovery[23] = 0x00;
6716
6717     osti_memcpy(pModeSense, &RWErrorRecovery, lenRead);
6718
6719   }
6720   else if (page == MODESENSE_CACHING)
6721   {
6722     TI_DBG5(("satModeSense6: MODESENSE_CACHING\n"));
6723     /* special case */
6724     if (requestLen == 4 && page == MODESENSE_CACHING)
6725     {
6726       TI_DBG5(("satModeSense6: linux 2.6.8.24 support\n"));
6727
6728       pModeSense[0] = 0x20 - 1; /* 32 - 1 */
6729       pModeSense[1] = 0x00; /* default medium type (currently mounted medium type) */
6730       pModeSense[2] = 0x00; /* no write-protect, no support for DPO-FUA */
6731       pModeSense[3] = 0x08; /* block descriptor length */
6732       ostiInitiatorIOCompleted( tiRoot,
6733                                 tiIORequest,
6734                                 tiIOSuccess,
6735                                 SCSI_STAT_GOOD,
6736                                 agNULL,
6737                                 satIOContext->interruptContext);
6738       return tiSuccess;
6739     }
6740     Caching[0] = MODE_SENSE6_CACHING_LEN - 1;
6741     Caching[1] = 0x00; /* default medium type (currently mounted medium type) */
6742     Caching[2] = 0x00; /* no write-protect, no support for DPO-FUA */
6743     Caching[3] = 0x08; /* block descriptor length */
6744     /*
6745      * Fill-up direct-access device block-descriptor, SAT, Table 19
6746      */
6747
6748     /* density code */
6749     Caching[4]  = 0x04; /* density-code : reserved for direct-access */
6750     /* number of blocks */
6751     Caching[5]  = 0x00; /* unspecified */
6752     Caching[6]  = 0x00; /* unspecified */
6753     Caching[7]  = 0x00; /* unspecified */
6754     /* reserved */
6755     Caching[8]  = 0x00; /* reserved */
6756     /* Block size */
6757     Caching[9]  = 0x00;
6758     Caching[10] = 0x02;   /* Block size is always 512 bytes */
6759     Caching[11] = 0x00;
6760     /*
6761      * Fill-up Caching mode page, SAT, Table 67
6762      */
6763     /* length 20 */
6764     Caching[12] = 0x08; /* page code */
6765     Caching[13] = 0x12; /* page length */
6766 #ifdef NOT_YET
6767     if (pSatDevData->satWriteCacheEnabled == agTRUE)
6768     {
6769       Caching[14] = 0x04;/* WCE bit is set */
6770     }
6771     else
6772     {
6773       Caching[14] = 0x00;/* WCE bit is NOT set */
6774     }
6775 #endif
6776     Caching[14] = 0x00;/* WCE bit is NOT set */
6777
6778     Caching[15] = 0x00;
6779     Caching[16] = 0x00;
6780     Caching[17] = 0x00;
6781     Caching[18] = 0x00;
6782     Caching[19] = 0x00;
6783     Caching[20] = 0x00;
6784     Caching[21] = 0x00;
6785     Caching[22] = 0x00;
6786     Caching[23] = 0x00;
6787     if (pSatDevData->satLookAheadEnabled == agTRUE)
6788     {
6789       Caching[24] = 0x00;/* DRA bit is NOT set */
6790     }
6791     else
6792     {
6793       Caching[24] = 0x20;/* DRA bit is set */
6794     }
6795     Caching[25] = 0x00;
6796     Caching[26] = 0x00;
6797     Caching[27] = 0x00;
6798     Caching[28] = 0x00;
6799     Caching[29] = 0x00;
6800     Caching[30] = 0x00;
6801     Caching[31] = 0x00;
6802
6803     osti_memcpy(pModeSense, &Caching, lenRead);
6804
6805   }
6806   else if (page == MODESENSE_INFORMATION_EXCEPTION_CONTROL_PAGE)
6807   {
6808     TI_DBG5(("satModeSense6: MODESENSE_INFORMATION_EXCEPTION_CONTROL_PAGE\n"));
6809     InfoExceptionCtrl[0] = MODE_SENSE6_INFORMATION_EXCEPTION_CONTROL_PAGE_LEN - 1;
6810     InfoExceptionCtrl[1] = 0x00; /* default medium type (currently mounted medium type) */
6811     InfoExceptionCtrl[2] = 0x00; /* no write-protect, no support for DPO-FUA */
6812     InfoExceptionCtrl[3] = 0x08; /* block descriptor length */
6813     /*
6814      * Fill-up direct-access device block-descriptor, SAT, Table 19
6815      */
6816
6817     /* density code */
6818     InfoExceptionCtrl[4]  = 0x04; /* density-code : reserved for direct-access */
6819     /* number of blocks */
6820     InfoExceptionCtrl[5]  = 0x00; /* unspecified */
6821     InfoExceptionCtrl[6]  = 0x00; /* unspecified */
6822     InfoExceptionCtrl[7]  = 0x00; /* unspecified */
6823     /* reserved */
6824     InfoExceptionCtrl[8]  = 0x00; /* reserved */
6825     /* Block size */
6826     InfoExceptionCtrl[9]  = 0x00;
6827     InfoExceptionCtrl[10] = 0x02;   /* Block size is always 512 bytes */
6828     InfoExceptionCtrl[11] = 0x00;
6829     /*
6830      * Fill-up informational-exceptions control mode page, SAT, Table 68
6831      */
6832     InfoExceptionCtrl[12] = 0x1C; /* page code */
6833     InfoExceptionCtrl[13] = 0x0A; /* page length */
6834      if (pSatDevData->satSMARTEnabled == agTRUE)
6835     {
6836       InfoExceptionCtrl[14] = 0x00;/* DEXCPT bit is NOT set */
6837     }
6838     else
6839     {
6840       InfoExceptionCtrl[14] = 0x08;/* DEXCPT bit is set */
6841     }
6842     InfoExceptionCtrl[15] = 0x00; /* We don't support MRIE */
6843     InfoExceptionCtrl[16] = 0x00; /* Interval timer vendor-specific */
6844     InfoExceptionCtrl[17] = 0x00;
6845     InfoExceptionCtrl[18] = 0x00;
6846     InfoExceptionCtrl[19] = 0x00;
6847     InfoExceptionCtrl[20] = 0x00; /* REPORT-COUNT */
6848     InfoExceptionCtrl[21] = 0x00;
6849     InfoExceptionCtrl[22] = 0x00;
6850     InfoExceptionCtrl[23] = 0x00;
6851     osti_memcpy(pModeSense, &InfoExceptionCtrl, lenRead);
6852
6853   }
6854   else
6855   {
6856     /* Error */
6857     TI_DBG1(("satModeSense6: Error page %d\n", page));
6858     satSetSensePayload( pSense,
6859                         SCSI_SNSKEY_ILLEGAL_REQUEST,
6860                         0,
6861                         SCSI_SNSCODE_INVALID_COMMAND,
6862                         satIOContext);
6863
6864     ostiInitiatorIOCompleted( tiRoot,
6865                               tiIORequest,
6866                               tiIOSuccess,
6867                               SCSI_STAT_CHECK_CONDITION,
6868                               satIOContext->pTiSenseData,
6869                               satIOContext->interruptContext );
6870     return tiSuccess;
6871   }
6872
6873   /* there can be only underrun not overrun in error case */
6874   if (requestLen > lenRead)
6875   {
6876     TI_DBG6(("satModeSense6 reporting underrun lenRead=0x%x requestLen=0x%x tiIORequest=%p\n", lenRead, requestLen, tiIORequest));
6877
6878     ostiInitiatorIOCompleted( tiRoot,
6879                               tiIORequest,
6880                               tiIOUnderRun,
6881                               requestLen - lenRead,
6882                               agNULL,
6883                               satIOContext->interruptContext );
6884
6885
6886   }
6887   else
6888   {
6889     ostiInitiatorIOCompleted( tiRoot,
6890                               tiIORequest,
6891                               tiIOSuccess,
6892                               SCSI_STAT_GOOD,
6893                               agNULL,
6894                               satIOContext->interruptContext);
6895   }
6896
6897   return tiSuccess;
6898
6899 }
6900
6901 /*****************************************************************************/
6902 /*! \brief SAT implementation for SCSI MODE SENSE (10).
6903  *
6904  *  SAT implementation for SCSI MODE SENSE (10).
6905  *
6906  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
6907  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
6908  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
6909  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
6910  *  \param   satIOContext_t:   Pointer to the SAT IO Context
6911  *
6912  *  \return If command is started successfully
6913  *    - \e tiSuccess:     I/O request successfully initiated.
6914  *    - \e tiBusy:        No resources available, try again later.
6915  *    - \e tiIONoDevice:  Invalid device handle.
6916  *    - \e tiError:       Other errors.
6917  */
6918 /*****************************************************************************/
6919 GLOBAL bit32  satModeSense10(
6920                    tiRoot_t                  *tiRoot,
6921                    tiIORequest_t             *tiIORequest,
6922                    tiDeviceHandle_t          *tiDeviceHandle,
6923                    tiScsiInitiatorRequest_t *tiScsiRequest,
6924                    satIOContext_t            *satIOContext)
6925 {
6926
6927   scsiRspSense_t          *pSense;
6928   bit32                   requestLen;
6929   tiIniScsiCmnd_t         *scsiCmnd;
6930   bit32                   pageSupported;
6931   bit8                    page;
6932   bit8                    *pModeSense;    /* Mode Sense data buffer */
6933   satDeviceData_t         *pSatDevData;
6934   bit8                    PC; /* page control */
6935   bit8                    LLBAA; /* Long LBA Accepted */
6936   bit32                   index;
6937   bit8                    AllPages[MODE_SENSE10_RETURN_ALL_PAGES_LLBAA_LEN];
6938   bit8                    Control[MODE_SENSE10_CONTROL_PAGE_LLBAA_LEN];
6939   bit8                    RWErrorRecovery[MODE_SENSE10_READ_WRITE_ERROR_RECOVERY_PAGE_LLBAA_LEN];
6940   bit8                    Caching[MODE_SENSE10_CACHING_LLBAA_LEN];
6941   bit8                    InfoExceptionCtrl[MODE_SENSE10_INFORMATION_EXCEPTION_CONTROL_PAGE_LLBAA_LEN];
6942   bit8                    lenRead = 0;
6943
6944   TI_DBG5(("satModeSense10 entry: tiDeviceHandle=%p tiIORequest=%p\n",
6945       tiDeviceHandle, tiIORequest));
6946
6947   pSense      = satIOContext->pSense;
6948   scsiCmnd    = &tiScsiRequest->scsiCmnd;
6949   pModeSense  = (bit8 *) tiScsiRequest->sglVirtualAddr;
6950   pSatDevData = satIOContext->pSatDevData;
6951
6952   /* checking CONTROL */
6953   /* NACA == 1 or LINK == 1*/
6954   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
6955   {
6956     satSetSensePayload( pSense,
6957                         SCSI_SNSKEY_ILLEGAL_REQUEST,
6958                         0,
6959                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
6960                         satIOContext);
6961
6962     ostiInitiatorIOCompleted( tiRoot,
6963                               tiIORequest,
6964                               tiIOSuccess,
6965                               SCSI_STAT_CHECK_CONDITION,
6966                               satIOContext->pTiSenseData,
6967                               satIOContext->interruptContext );
6968
6969     TI_DBG2(("satModeSense10: return control\n"));
6970     return tiSuccess;
6971   }
6972
6973   /* checking PC(Page Control)
6974      SAT revion 8, 8.5.3 p33 and 10.1.2, p66
6975   */
6976   PC = (bit8)((scsiCmnd->cdb[2]) & SCSI_MODE_SENSE10_PC_MASK);
6977   if (PC != 0)
6978   {
6979     satSetSensePayload( pSense,
6980                         SCSI_SNSKEY_ILLEGAL_REQUEST,
6981                         0,
6982                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
6983                         satIOContext);
6984
6985     ostiInitiatorIOCompleted( tiRoot,
6986                               tiIORequest,
6987                               tiIOSuccess,
6988                               SCSI_STAT_CHECK_CONDITION,
6989                               satIOContext->pTiSenseData,
6990                               satIOContext->interruptContext );
6991
6992     TI_DBG1(("satModeSense10: return due to PC value pc 0x%x\n", PC));
6993     return tiSuccess;
6994   }
6995   /* finding LLBAA bit */
6996   LLBAA = (bit8)((scsiCmnd->cdb[1]) & SCSI_MODE_SENSE10_LLBAA_MASK);
6997   /* reading PAGE CODE */
6998   page = (bit8)((scsiCmnd->cdb[2]) & SCSI_MODE_SENSE10_PAGE_CODE_MASK);
6999
7000   TI_DBG5(("satModeSense10: page=0x%x, tiDeviceHandle=%p tiIORequest=%p\n",
7001              page, tiDeviceHandle, tiIORequest));
7002   requestLen = (scsiCmnd->cdb[7] << 8) + scsiCmnd->cdb[8];
7003
7004   /*
7005     Based on page code value, returns a corresponding mode page
7006     note: no support for subpage
7007   */
7008   switch(page)
7009   {
7010     case MODESENSE_RETURN_ALL_PAGES: /* return all pages */
7011     case MODESENSE_CONTROL_PAGE: /* control */
7012     case MODESENSE_READ_WRITE_ERROR_RECOVERY_PAGE: /* Read-Write Error Recovery */
7013     case MODESENSE_CACHING: /* caching */
7014     case MODESENSE_INFORMATION_EXCEPTION_CONTROL_PAGE: /* informational exceptions control*/
7015       pageSupported = agTRUE;
7016       break;
7017     case MODESENSE_VENDOR_SPECIFIC_PAGE: /* vendor specific */
7018     default:
7019       pageSupported = agFALSE;
7020       break;
7021   }
7022
7023   if (pageSupported == agFALSE)
7024   {
7025
7026     TI_DBG1(("satModeSense10 *** ERROR *** not supported page 0x%x tiDeviceHandle=%p tiIORequest=%p\n",
7027         page, tiDeviceHandle, tiIORequest));
7028
7029     satSetSensePayload( pSense,
7030                         SCSI_SNSKEY_ILLEGAL_REQUEST,
7031                         0,
7032                         SCSI_SNSCODE_INVALID_COMMAND,
7033                         satIOContext);
7034
7035     ostiInitiatorIOCompleted( tiRoot,
7036                               tiIORequest,
7037                               tiIOSuccess,
7038                               SCSI_STAT_CHECK_CONDITION,
7039                               satIOContext->pTiSenseData,
7040                               satIOContext->interruptContext );
7041     return tiSuccess;
7042   }
7043
7044   switch(page)
7045   {
7046   case MODESENSE_RETURN_ALL_PAGES:
7047     if (LLBAA)
7048     {
7049       lenRead = (bit8)MIN(requestLen, MODE_SENSE10_RETURN_ALL_PAGES_LLBAA_LEN);
7050     }
7051     else
7052     {
7053       lenRead = (bit8)MIN(requestLen, MODE_SENSE10_RETURN_ALL_PAGES_LEN);
7054     }
7055     break;
7056   case MODESENSE_CONTROL_PAGE: /* control */
7057     if (LLBAA)
7058     {
7059       lenRead = (bit8)MIN(requestLen, MODE_SENSE10_CONTROL_PAGE_LLBAA_LEN);
7060     }
7061     else
7062     {
7063       lenRead = (bit8)MIN(requestLen, MODE_SENSE10_CONTROL_PAGE_LEN);
7064     }
7065     break;
7066   case MODESENSE_READ_WRITE_ERROR_RECOVERY_PAGE: /* Read-Write Error Recovery */
7067     if (LLBAA)
7068     {
7069       lenRead = (bit8)MIN(requestLen, MODE_SENSE10_READ_WRITE_ERROR_RECOVERY_PAGE_LLBAA_LEN);
7070     }
7071     else
7072     {
7073       lenRead = (bit8)MIN(requestLen, MODE_SENSE10_READ_WRITE_ERROR_RECOVERY_PAGE_LEN);
7074     }
7075     break;
7076   case MODESENSE_CACHING: /* caching */
7077     if (LLBAA)
7078     {
7079       lenRead = (bit8)MIN(requestLen, MODE_SENSE10_CACHING_LLBAA_LEN);
7080     }
7081     else
7082     {
7083       lenRead = (bit8)MIN(requestLen, MODE_SENSE10_CACHING_LEN);
7084     }
7085     break;
7086   case MODESENSE_INFORMATION_EXCEPTION_CONTROL_PAGE: /* informational exceptions control*/
7087     if (LLBAA)
7088     {
7089       lenRead = (bit8)MIN(requestLen, MODE_SENSE10_INFORMATION_EXCEPTION_CONTROL_PAGE_LLBAA_LEN);
7090     }
7091     else
7092     {
7093       lenRead = (bit8)MIN(requestLen, MODE_SENSE10_INFORMATION_EXCEPTION_CONTROL_PAGE_LEN);
7094     }
7095     break;
7096   default:
7097     TI_DBG1(("satModeSense10: default error page %d\n", page));
7098     break;
7099   }
7100
7101   if (page == MODESENSE_RETURN_ALL_PAGES)
7102   {
7103     TI_DBG5(("satModeSense10: MODESENSE_RETURN_ALL_PAGES\n"));
7104     AllPages[0] = 0;
7105     AllPages[1] = (bit8)(lenRead - 2);
7106     AllPages[2] = 0x00; /* medium type: default medium type (currently mounted medium type) */
7107     AllPages[3] = 0x00; /* device-specific param: no write-protect, no support for DPO-FUA */
7108     if (LLBAA)
7109     {
7110       AllPages[4] = 0x00; /* reserved and LONGLBA */
7111       AllPages[4] = (bit8)(AllPages[4] | 0x1); /* LONGLBA is set */
7112     }
7113     else
7114     {
7115       AllPages[4] = 0x00; /* reserved and LONGLBA: LONGLBA is not set */
7116     }
7117     AllPages[5] = 0x00; /* reserved */
7118     AllPages[6] = 0x00; /* block descriptot length */
7119     if (LLBAA)
7120     {
7121       AllPages[7] = 0x10; /* block descriptor length: LONGLBA is set. So, length is 16 */
7122     }
7123     else
7124     {
7125       AllPages[7] = 0x08; /* block descriptor length: LONGLBA is NOT set. So, length is 8 */
7126     }
7127
7128     /*
7129      * Fill-up direct-access device block-descriptor, SAT, Table 19
7130      */
7131
7132     if (LLBAA)
7133     {
7134       /* density code */
7135       AllPages[8]   = 0x04; /* density-code : reserved for direct-access */
7136       /* number of blocks */
7137       AllPages[9]   = 0x00; /* unspecified */
7138       AllPages[10]  = 0x00; /* unspecified */
7139       AllPages[11]  = 0x00; /* unspecified */
7140       AllPages[12]  = 0x00; /* unspecified */
7141       AllPages[13]  = 0x00; /* unspecified */
7142       AllPages[14]  = 0x00; /* unspecified */
7143       AllPages[15]  = 0x00; /* unspecified */
7144       /* reserved */
7145       AllPages[16]  = 0x00; /* reserved */
7146       AllPages[17]  = 0x00; /* reserved */
7147       AllPages[18]  = 0x00; /* reserved */
7148       AllPages[19]  = 0x00; /* reserved */
7149       /* Block size */
7150       AllPages[20]  = 0x00;
7151       AllPages[21]  = 0x00;
7152       AllPages[22]  = 0x02;   /* Block size is always 512 bytes */
7153       AllPages[23]  = 0x00;
7154     }
7155     else
7156     {
7157       /* density code */
7158       AllPages[8]   = 0x04; /* density-code : reserved for direct-access */
7159       /* number of blocks */
7160       AllPages[9]   = 0x00; /* unspecified */
7161       AllPages[10]  = 0x00; /* unspecified */
7162       AllPages[11]  = 0x00; /* unspecified */
7163       /* reserved */
7164       AllPages[12]  = 0x00; /* reserved */
7165       /* Block size */
7166       AllPages[13]  = 0x00;
7167       AllPages[14]  = 0x02;   /* Block size is always 512 bytes */
7168       AllPages[15]  = 0x00;
7169     }
7170
7171     if (LLBAA)
7172     {
7173       index = 24;
7174     }
7175     else
7176     {
7177       index = 16;
7178     }
7179     /* MODESENSE_READ_WRITE_ERROR_RECOVERY_PAGE */
7180     AllPages[index+0] = 0x01; /* page code */
7181     AllPages[index+1] = 0x0A; /* page length */
7182     AllPages[index+2] = 0x40; /* ARRE is set */
7183     AllPages[index+3] = 0x00;
7184     AllPages[index+4] = 0x00;
7185     AllPages[index+5] = 0x00;
7186     AllPages[index+6] = 0x00;
7187     AllPages[index+7] = 0x00;
7188     AllPages[index+8] = 0x00;
7189     AllPages[index+9] = 0x00;
7190     AllPages[index+10] = 0x00;
7191     AllPages[index+11] = 0x00;
7192
7193     /* MODESENSE_CACHING */
7194     /*
7195      * Fill-up Caching mode page, SAT, Table 67
7196      */
7197     /* length 20 */
7198     AllPages[index+12] = 0x08; /* page code */
7199     AllPages[index+13] = 0x12; /* page length */
7200 #ifdef NOT_YET
7201     if (pSatDevData->satWriteCacheEnabled == agTRUE)
7202     {
7203       AllPages[index+14] = 0x04;/* WCE bit is set */
7204     }
7205     else
7206     {
7207       AllPages[index+14] = 0x00;/* WCE bit is NOT set */
7208     }
7209 #endif
7210     AllPages[index+14] = 0x00;/* WCE bit is NOT set */
7211     AllPages[index+15] = 0x00;
7212     AllPages[index+16] = 0x00;
7213     AllPages[index+17] = 0x00;
7214     AllPages[index+18] = 0x00;
7215     AllPages[index+19] = 0x00;
7216     AllPages[index+20] = 0x00;
7217     AllPages[index+21] = 0x00;
7218     AllPages[index+22] = 0x00;
7219     AllPages[index+23] = 0x00;
7220     if (pSatDevData->satLookAheadEnabled == agTRUE)
7221     {
7222       AllPages[index+24] = 0x00;/* DRA bit is NOT set */
7223     }
7224     else
7225     {
7226       AllPages[index+24] = 0x20;/* DRA bit is set */
7227     }
7228     AllPages[index+25] = 0x00;
7229     AllPages[index+26] = 0x00;
7230     AllPages[index+27] = 0x00;
7231     AllPages[index+28] = 0x00;
7232     AllPages[index+29] = 0x00;
7233     AllPages[index+30] = 0x00;
7234     AllPages[index+31] = 0x00;
7235
7236     /* MODESENSE_CONTROL_PAGE */
7237     /*
7238      * Fill-up control mode page, SAT, Table 65
7239      */
7240     AllPages[index+32] = 0x0A; /* page code */
7241     AllPages[index+33] = 0x0A; /* page length */
7242     AllPages[index+34] = 0x02; /* only GLTSD bit is set */
7243     if (pSatDevData->satNCQ == agTRUE)
7244     {
7245       AllPages[index+35] = 0x12; /* Queue Alogorithm modifier 1b and QErr 01b*/
7246     }
7247     else
7248     {
7249       AllPages[index+35] = 0x02; /* Queue Alogorithm modifier 0b and QErr 01b */
7250     }
7251     AllPages[index+36] = 0x00;
7252     AllPages[index+37] = 0x00;
7253     AllPages[index+38] = 0x00; /* obsolete */
7254     AllPages[index+39] = 0x00; /* obsolete */
7255     AllPages[index+40] = 0xFF; /* Busy Timeout Period */
7256     AllPages[index+41] = 0xFF; /* Busy Timeout Period */
7257     AllPages[index+42] = 0x00; /* we don't support non-000b value for the self-test code */
7258     AllPages[index+43] = 0x00; /* we don't support non-000b value for the self-test code */
7259
7260     /* MODESENSE_INFORMATION_EXCEPTION_CONTROL_PAGE */
7261     /*
7262      * Fill-up informational-exceptions control mode page, SAT, Table 68
7263      */
7264     AllPages[index+44] = 0x1C; /* page code */
7265     AllPages[index+45] = 0x0A; /* page length */
7266      if (pSatDevData->satSMARTEnabled == agTRUE)
7267     {
7268       AllPages[index+46] = 0x00;/* DEXCPT bit is NOT set */
7269     }
7270     else
7271     {
7272       AllPages[index+46] = 0x08;/* DEXCPT bit is set */
7273     }
7274     AllPages[index+47] = 0x00; /* We don't support MRIE */
7275     AllPages[index+48] = 0x00; /* Interval timer vendor-specific */
7276     AllPages[index+49] = 0x00;
7277     AllPages[index+50] = 0x00;
7278     AllPages[index+51] = 0x00;
7279     AllPages[index+52] = 0x00; /* REPORT-COUNT */
7280     AllPages[index+53] = 0x00;
7281     AllPages[index+54] = 0x00;
7282     AllPages[index+55] = 0x00;
7283
7284     osti_memcpy(pModeSense, &AllPages, lenRead);
7285   }
7286   else if (page == MODESENSE_CONTROL_PAGE)
7287   {
7288     TI_DBG5(("satModeSense10: MODESENSE_CONTROL_PAGE\n"));
7289     Control[0] = 0;
7290     Control[1] = (bit8)(lenRead - 2);
7291     Control[2] = 0x00; /* medium type: default medium type (currently mounted medium type) */
7292     Control[3] = 0x00; /* device-specific param: no write-protect, no support for DPO-FUA */
7293     if (LLBAA)
7294     {
7295       Control[4] = 0x00; /* reserved and LONGLBA */
7296       Control[4] = (bit8)(Control[4] | 0x1); /* LONGLBA is set */
7297     }
7298     else
7299     {
7300       Control[4] = 0x00; /* reserved and LONGLBA: LONGLBA is not set */
7301     }
7302     Control[5] = 0x00; /* reserved */
7303     Control[6] = 0x00; /* block descriptot length */
7304     if (LLBAA)
7305     {
7306       Control[7] = 0x10; /* block descriptor length: LONGLBA is set. So, length is 16 */
7307     }
7308     else
7309     {
7310       Control[7] = 0x08; /* block descriptor length: LONGLBA is NOT set. So, length is 8 */
7311     }
7312
7313     /*
7314      * Fill-up direct-access device block-descriptor, SAT, Table 19
7315      */
7316
7317     if (LLBAA)
7318     {
7319       /* density code */
7320       Control[8]   = 0x04; /* density-code : reserved for direct-access */
7321       /* number of blocks */
7322       Control[9]   = 0x00; /* unspecified */
7323       Control[10]  = 0x00; /* unspecified */
7324       Control[11]  = 0x00; /* unspecified */
7325       Control[12]  = 0x00; /* unspecified */
7326       Control[13]  = 0x00; /* unspecified */
7327       Control[14]  = 0x00; /* unspecified */
7328       Control[15]  = 0x00; /* unspecified */
7329       /* reserved */
7330       Control[16]  = 0x00; /* reserved */
7331       Control[17]  = 0x00; /* reserved */
7332       Control[18]  = 0x00; /* reserved */
7333       Control[19]  = 0x00; /* reserved */
7334       /* Block size */
7335       Control[20]  = 0x00;
7336       Control[21]  = 0x00;
7337       Control[22]  = 0x02;   /* Block size is always 512 bytes */
7338       Control[23]  = 0x00;
7339     }
7340     else
7341     {
7342       /* density code */
7343       Control[8]   = 0x04; /* density-code : reserved for direct-access */
7344       /* number of blocks */
7345       Control[9]   = 0x00; /* unspecified */
7346       Control[10]  = 0x00; /* unspecified */
7347       Control[11]  = 0x00; /* unspecified */
7348       /* reserved */
7349       Control[12]  = 0x00; /* reserved */
7350       /* Block size */
7351       Control[13]  = 0x00;
7352       Control[14]  = 0x02;   /* Block size is always 512 bytes */
7353       Control[15]  = 0x00;
7354     }
7355
7356     if (LLBAA)
7357     {
7358       index = 24;
7359     }
7360     else
7361     {
7362       index = 16;
7363     }
7364     /*
7365      * Fill-up control mode page, SAT, Table 65
7366      */
7367     Control[index+0] = 0x0A; /* page code */
7368     Control[index+1] = 0x0A; /* page length */
7369     Control[index+2] = 0x02; /* only GLTSD bit is set */
7370     if (pSatDevData->satNCQ == agTRUE)
7371     {
7372       Control[index+3] = 0x12; /* Queue Alogorithm modifier 1b and QErr 01b*/
7373     }
7374     else
7375     {
7376       Control[index+3] = 0x02; /* Queue Alogorithm modifier 0b and QErr 01b */
7377     }
7378     Control[index+4] = 0x00;
7379     Control[index+5] = 0x00;
7380     Control[index+6] = 0x00; /* obsolete */
7381     Control[index+7] = 0x00; /* obsolete */
7382     Control[index+8] = 0xFF; /* Busy Timeout Period */
7383     Control[index+9] = 0xFF; /* Busy Timeout Period */
7384     Control[index+10] = 0x00; /* we don't support non-000b value for the self-test code */
7385     Control[index+11] = 0x00; /* we don't support non-000b value for the self-test code */
7386
7387     osti_memcpy(pModeSense, &Control, lenRead);
7388   }
7389   else if (page == MODESENSE_READ_WRITE_ERROR_RECOVERY_PAGE)
7390   {
7391     TI_DBG5(("satModeSense10: MODESENSE_READ_WRITE_ERROR_RECOVERY_PAGE\n"));
7392     RWErrorRecovery[0] = 0;
7393     RWErrorRecovery[1] = (bit8)(lenRead - 2);
7394     RWErrorRecovery[2] = 0x00; /* medium type: default medium type (currently mounted medium type) */
7395     RWErrorRecovery[3] = 0x00; /* device-specific param: no write-protect, no support for DPO-FUA */
7396     if (LLBAA)
7397     {
7398       RWErrorRecovery[4] = 0x00; /* reserved and LONGLBA */
7399       RWErrorRecovery[4] = (bit8)(RWErrorRecovery[4] | 0x1); /* LONGLBA is set */
7400     }
7401     else
7402     {
7403       RWErrorRecovery[4] = 0x00; /* reserved and LONGLBA: LONGLBA is not set */
7404     }
7405     RWErrorRecovery[5] = 0x00; /* reserved */
7406     RWErrorRecovery[6] = 0x00; /* block descriptot length */
7407     if (LLBAA)
7408     {
7409       RWErrorRecovery[7] = 0x10; /* block descriptor length: LONGLBA is set. So, length is 16 */
7410     }
7411     else
7412     {
7413       RWErrorRecovery[7] = 0x08; /* block descriptor length: LONGLBA is NOT set. So, length is 8 */
7414     }
7415
7416     /*
7417      * Fill-up direct-access device block-descriptor, SAT, Table 19
7418      */
7419
7420     if (LLBAA)
7421     {
7422       /* density code */
7423       RWErrorRecovery[8]   = 0x04; /* density-code : reserved for direct-access */
7424       /* number of blocks */
7425       RWErrorRecovery[9]   = 0x00; /* unspecified */
7426       RWErrorRecovery[10]  = 0x00; /* unspecified */
7427       RWErrorRecovery[11]  = 0x00; /* unspecified */
7428       RWErrorRecovery[12]  = 0x00; /* unspecified */
7429       RWErrorRecovery[13]  = 0x00; /* unspecified */
7430       RWErrorRecovery[14]  = 0x00; /* unspecified */
7431       RWErrorRecovery[15]  = 0x00; /* unspecified */
7432       /* reserved */
7433       RWErrorRecovery[16]  = 0x00; /* reserved */
7434       RWErrorRecovery[17]  = 0x00; /* reserved */
7435       RWErrorRecovery[18]  = 0x00; /* reserved */
7436       RWErrorRecovery[19]  = 0x00; /* reserved */
7437       /* Block size */
7438       RWErrorRecovery[20]  = 0x00;
7439       RWErrorRecovery[21]  = 0x00;
7440       RWErrorRecovery[22]  = 0x02;   /* Block size is always 512 bytes */
7441       RWErrorRecovery[23]  = 0x00;
7442     }
7443     else
7444     {
7445       /* density code */
7446       RWErrorRecovery[8]   = 0x04; /* density-code : reserved for direct-access */
7447       /* number of blocks */
7448       RWErrorRecovery[9]   = 0x00; /* unspecified */
7449       RWErrorRecovery[10]  = 0x00; /* unspecified */
7450       RWErrorRecovery[11]  = 0x00; /* unspecified */
7451       /* reserved */
7452       RWErrorRecovery[12]  = 0x00; /* reserved */
7453       /* Block size */
7454       RWErrorRecovery[13]  = 0x00;
7455       RWErrorRecovery[14]  = 0x02;   /* Block size is always 512 bytes */
7456       RWErrorRecovery[15]  = 0x00;
7457     }
7458
7459     if (LLBAA)
7460     {
7461       index = 24;
7462     }
7463     else
7464     {
7465       index = 16;
7466     }
7467     /*
7468      * Fill-up Read-Write Error Recovery mode page, SAT, Table 66
7469      */
7470     RWErrorRecovery[index+0] = 0x01; /* page code */
7471     RWErrorRecovery[index+1] = 0x0A; /* page length */
7472     RWErrorRecovery[index+2] = 0x40; /* ARRE is set */
7473     RWErrorRecovery[index+3] = 0x00;
7474     RWErrorRecovery[index+4] = 0x00;
7475     RWErrorRecovery[index+5] = 0x00;
7476     RWErrorRecovery[index+6] = 0x00;
7477     RWErrorRecovery[index+7] = 0x00;
7478     RWErrorRecovery[index+8] = 0x00;
7479     RWErrorRecovery[index+9] = 0x00;
7480     RWErrorRecovery[index+10] = 0x00;
7481     RWErrorRecovery[index+11] = 0x00;
7482
7483     osti_memcpy(pModeSense, &RWErrorRecovery, lenRead);
7484   }
7485   else if (page == MODESENSE_CACHING)
7486   {
7487     TI_DBG5(("satModeSense10: MODESENSE_CACHING\n"));
7488     Caching[0] = 0;
7489     Caching[1] = (bit8)(lenRead - 2);
7490     Caching[2] = 0x00; /* medium type: default medium type (currently mounted medium type) */
7491     Caching[3] = 0x00; /* device-specific param: no write-protect, no support for DPO-FUA */
7492     if (LLBAA)
7493     {
7494       Caching[4] = 0x00; /* reserved and LONGLBA */
7495       Caching[4] = (bit8)(Caching[4] | 0x1); /* LONGLBA is set */
7496     }
7497     else
7498     {
7499       Caching[4] = 0x00; /* reserved and LONGLBA: LONGLBA is not set */
7500     }
7501     Caching[5] = 0x00; /* reserved */
7502     Caching[6] = 0x00; /* block descriptot length */
7503     if (LLBAA)
7504     {
7505       Caching[7] = 0x10; /* block descriptor length: LONGLBA is set. So, length is 16 */
7506     }
7507     else
7508     {
7509       Caching[7] = 0x08; /* block descriptor length: LONGLBA is NOT set. So, length is 8 */
7510     }
7511
7512     /*
7513      * Fill-up direct-access device block-descriptor, SAT, Table 19
7514      */
7515
7516     if (LLBAA)
7517     {
7518       /* density code */
7519       Caching[8]   = 0x04; /* density-code : reserved for direct-access */
7520       /* number of blocks */
7521       Caching[9]   = 0x00; /* unspecified */
7522       Caching[10]  = 0x00; /* unspecified */
7523       Caching[11]  = 0x00; /* unspecified */
7524       Caching[12]  = 0x00; /* unspecified */
7525       Caching[13]  = 0x00; /* unspecified */
7526       Caching[14]  = 0x00; /* unspecified */
7527       Caching[15]  = 0x00; /* unspecified */
7528       /* reserved */
7529       Caching[16]  = 0x00; /* reserved */
7530       Caching[17]  = 0x00; /* reserved */
7531       Caching[18]  = 0x00; /* reserved */
7532       Caching[19]  = 0x00; /* reserved */
7533       /* Block size */
7534       Caching[20]  = 0x00;
7535       Caching[21]  = 0x00;
7536       Caching[22]  = 0x02;   /* Block size is always 512 bytes */
7537       Caching[23]  = 0x00;
7538     }
7539     else
7540     {
7541       /* density code */
7542       Caching[8]   = 0x04; /* density-code : reserved for direct-access */
7543       /* number of blocks */
7544       Caching[9]   = 0x00; /* unspecified */
7545       Caching[10]  = 0x00; /* unspecified */
7546       Caching[11]  = 0x00; /* unspecified */
7547       /* reserved */
7548       Caching[12]  = 0x00; /* reserved */
7549       /* Block size */
7550       Caching[13]  = 0x00;
7551       Caching[14]  = 0x02;   /* Block size is always 512 bytes */
7552       Caching[15]  = 0x00;
7553     }
7554
7555     if (LLBAA)
7556     {
7557       index = 24;
7558     }
7559     else
7560     {
7561       index = 16;
7562     }
7563     /*
7564      * Fill-up Caching mode page, SAT, Table 67
7565      */
7566     /* length 20 */
7567     Caching[index+0] = 0x08; /* page code */
7568     Caching[index+1] = 0x12; /* page length */
7569 #ifdef NOT_YET
7570     if (pSatDevData->satWriteCacheEnabled == agTRUE)
7571     {
7572       Caching[index+2] = 0x04;/* WCE bit is set */
7573     }
7574     else
7575     {
7576       Caching[index+2] = 0x00;/* WCE bit is NOT set */
7577     }
7578 #endif
7579     Caching[index+2] = 0x00;/* WCE bit is NOT set */
7580     Caching[index+3] = 0x00;
7581     Caching[index+4] = 0x00;
7582     Caching[index+5] = 0x00;
7583     Caching[index+6] = 0x00;
7584     Caching[index+7] = 0x00;
7585     Caching[index+8] = 0x00;
7586     Caching[index+9] = 0x00;
7587     Caching[index+10] = 0x00;
7588     Caching[index+11] = 0x00;
7589     if (pSatDevData->satLookAheadEnabled == agTRUE)
7590     {
7591       Caching[index+12] = 0x00;/* DRA bit is NOT set */
7592     }
7593     else
7594     {
7595       Caching[index+12] = 0x20;/* DRA bit is set */
7596     }
7597     Caching[index+13] = 0x00;
7598     Caching[index+14] = 0x00;
7599     Caching[index+15] = 0x00;
7600     Caching[index+16] = 0x00;
7601     Caching[index+17] = 0x00;
7602     Caching[index+18] = 0x00;
7603     Caching[index+19] = 0x00;
7604     osti_memcpy(pModeSense, &Caching, lenRead);
7605
7606   }
7607   else if (page == MODESENSE_INFORMATION_EXCEPTION_CONTROL_PAGE)
7608   {
7609     TI_DBG5(("satModeSense10: MODESENSE_INFORMATION_EXCEPTION_CONTROL_PAGE\n"));
7610     InfoExceptionCtrl[0] = 0;
7611     InfoExceptionCtrl[1] = (bit8)(lenRead - 2);
7612     InfoExceptionCtrl[2] = 0x00; /* medium type: default medium type (currently mounted medium type) */
7613     InfoExceptionCtrl[3] = 0x00; /* device-specific param: no write-protect, no support for DPO-FUA */
7614     if (LLBAA)
7615     {
7616       InfoExceptionCtrl[4] = 0x00; /* reserved and LONGLBA */
7617       InfoExceptionCtrl[4] = (bit8)(InfoExceptionCtrl[4] | 0x1); /* LONGLBA is set */
7618     }
7619     else
7620     {
7621       InfoExceptionCtrl[4] = 0x00; /* reserved and LONGLBA: LONGLBA is not set */
7622     }
7623     InfoExceptionCtrl[5] = 0x00; /* reserved */
7624     InfoExceptionCtrl[6] = 0x00; /* block descriptot length */
7625     if (LLBAA)
7626     {
7627       InfoExceptionCtrl[7] = 0x10; /* block descriptor length: LONGLBA is set. So, length is 16 */
7628     }
7629     else
7630     {
7631       InfoExceptionCtrl[7] = 0x08; /* block descriptor length: LONGLBA is NOT set. So, length is 8 */
7632     }
7633
7634     /*
7635      * Fill-up direct-access device block-descriptor, SAT, Table 19
7636      */
7637
7638     if (LLBAA)
7639     {
7640       /* density code */
7641       InfoExceptionCtrl[8]   = 0x04; /* density-code : reserved for direct-access */
7642       /* number of blocks */
7643       InfoExceptionCtrl[9]   = 0x00; /* unspecified */
7644       InfoExceptionCtrl[10]  = 0x00; /* unspecified */
7645       InfoExceptionCtrl[11]  = 0x00; /* unspecified */
7646       InfoExceptionCtrl[12]  = 0x00; /* unspecified */
7647       InfoExceptionCtrl[13]  = 0x00; /* unspecified */
7648       InfoExceptionCtrl[14]  = 0x00; /* unspecified */
7649       InfoExceptionCtrl[15]  = 0x00; /* unspecified */
7650       /* reserved */
7651       InfoExceptionCtrl[16]  = 0x00; /* reserved */
7652       InfoExceptionCtrl[17]  = 0x00; /* reserved */
7653       InfoExceptionCtrl[18]  = 0x00; /* reserved */
7654       InfoExceptionCtrl[19]  = 0x00; /* reserved */
7655       /* Block size */
7656       InfoExceptionCtrl[20]  = 0x00;
7657       InfoExceptionCtrl[21]  = 0x00;
7658       InfoExceptionCtrl[22]  = 0x02;   /* Block size is always 512 bytes */
7659       InfoExceptionCtrl[23]  = 0x00;
7660     }
7661     else
7662     {
7663       /* density code */
7664       InfoExceptionCtrl[8]   = 0x04; /* density-code : reserved for direct-access */
7665       /* number of blocks */
7666       InfoExceptionCtrl[9]   = 0x00; /* unspecified */
7667       InfoExceptionCtrl[10]  = 0x00; /* unspecified */
7668       InfoExceptionCtrl[11]  = 0x00; /* unspecified */
7669       /* reserved */
7670       InfoExceptionCtrl[12]  = 0x00; /* reserved */
7671       /* Block size */
7672       InfoExceptionCtrl[13]  = 0x00;
7673       InfoExceptionCtrl[14]  = 0x02;   /* Block size is always 512 bytes */
7674       InfoExceptionCtrl[15]  = 0x00;
7675     }
7676
7677     if (LLBAA)
7678     {
7679       index = 24;
7680     }
7681     else
7682     {
7683       index = 16;
7684     }
7685     /*
7686      * Fill-up informational-exceptions control mode page, SAT, Table 68
7687      */
7688     InfoExceptionCtrl[index+0] = 0x1C; /* page code */
7689     InfoExceptionCtrl[index+1] = 0x0A; /* page length */
7690      if (pSatDevData->satSMARTEnabled == agTRUE)
7691     {
7692       InfoExceptionCtrl[index+2] = 0x00;/* DEXCPT bit is NOT set */
7693     }
7694     else
7695     {
7696       InfoExceptionCtrl[index+2] = 0x08;/* DEXCPT bit is set */
7697     }
7698     InfoExceptionCtrl[index+3] = 0x00; /* We don't support MRIE */
7699     InfoExceptionCtrl[index+4] = 0x00; /* Interval timer vendor-specific */
7700     InfoExceptionCtrl[index+5] = 0x00;
7701     InfoExceptionCtrl[index+6] = 0x00;
7702     InfoExceptionCtrl[index+7] = 0x00;
7703     InfoExceptionCtrl[index+8] = 0x00; /* REPORT-COUNT */
7704     InfoExceptionCtrl[index+9] = 0x00;
7705     InfoExceptionCtrl[index+10] = 0x00;
7706     InfoExceptionCtrl[index+11] = 0x00;
7707     osti_memcpy(pModeSense, &InfoExceptionCtrl, lenRead);
7708
7709   }
7710   else
7711   {
7712     /* Error */
7713     TI_DBG1(("satModeSense10: Error page %d\n", page));
7714     satSetSensePayload( pSense,
7715                         SCSI_SNSKEY_ILLEGAL_REQUEST,
7716                         0,
7717                         SCSI_SNSCODE_INVALID_COMMAND,
7718                         satIOContext);
7719
7720     ostiInitiatorIOCompleted( tiRoot,
7721                               tiIORequest,
7722                               tiIOSuccess,
7723                               SCSI_STAT_CHECK_CONDITION,
7724                               satIOContext->pTiSenseData,
7725                               satIOContext->interruptContext );
7726     return tiSuccess;
7727   }
7728
7729   if (requestLen > lenRead)
7730   {
7731     TI_DBG1(("satModeSense10 reporting underrun lenRead=0x%x requestLen=0x%x tiIORequest=%p\n", lenRead, requestLen, tiIORequest));
7732
7733     ostiInitiatorIOCompleted( tiRoot,
7734                               tiIORequest,
7735                               tiIOUnderRun,
7736                               requestLen - lenRead,
7737                               agNULL,
7738                               satIOContext->interruptContext );
7739
7740
7741   }
7742   else
7743   {
7744     ostiInitiatorIOCompleted( tiRoot,
7745                               tiIORequest,
7746                               tiIOSuccess,
7747                               SCSI_STAT_GOOD,
7748                               agNULL,
7749                               satIOContext->interruptContext);
7750   }
7751
7752   return tiSuccess;
7753 }
7754
7755
7756 /*****************************************************************************/
7757 /*! \brief SAT implementation for SCSI VERIFY (10).
7758  *
7759  *  SAT implementation for SCSI VERIFY (10).
7760  *
7761  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
7762  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
7763  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
7764  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
7765  *  \param   satIOContext_t:   Pointer to the SAT IO Context
7766  *
7767  *  \return If command is started successfully
7768  *    - \e tiSuccess:     I/O request successfully initiated.
7769  *    - \e tiBusy:        No resources available, try again later.
7770  *    - \e tiIONoDevice:  Invalid device handle.
7771  *    - \e tiError:       Other errors.
7772  */
7773 /*****************************************************************************/
7774 GLOBAL bit32  satVerify10(
7775                    tiRoot_t                  *tiRoot,
7776                    tiIORequest_t             *tiIORequest,
7777                    tiDeviceHandle_t          *tiDeviceHandle,
7778                    tiScsiInitiatorRequest_t *tiScsiRequest,
7779                    satIOContext_t            *satIOContext)
7780 {
7781   /*
7782     For simple implementation,
7783     no byte comparison supported as of 4/5/06
7784   */
7785   scsiRspSense_t            *pSense;
7786   tiIniScsiCmnd_t           *scsiCmnd;
7787   satDeviceData_t           *pSatDevData;
7788   agsaFisRegHostToDevice_t  *fis;
7789   bit32                     status;
7790   bit32                     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
7791   bit32                     lba = 0;
7792   bit32                     tl = 0;
7793   bit32                     LoopNum = 1;
7794   bit8                      LBA[4];
7795   bit8                      TL[4];
7796   bit32                     rangeChk = agFALSE; /* lba and tl range check */
7797
7798
7799   TI_DBG5(("satVerify10 entry: tiDeviceHandle=%p tiIORequest=%p\n",
7800       tiDeviceHandle, tiIORequest));
7801
7802   pSense            = satIOContext->pSense;
7803   scsiCmnd          = &tiScsiRequest->scsiCmnd;
7804   pSatDevData       = satIOContext->pSatDevData;
7805   fis               = satIOContext->pFis;
7806
7807   /* checking BYTCHK */
7808   if (scsiCmnd->cdb[1] & SCSI_VERIFY_BYTCHK_MASK)
7809   {
7810     /*
7811       should do the byte check
7812       but not supported in this version
7813      */
7814     satSetSensePayload( pSense,
7815                         SCSI_SNSKEY_ILLEGAL_REQUEST,
7816                         0,
7817                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
7818                         satIOContext);
7819
7820     ostiInitiatorIOCompleted( tiRoot,
7821                               tiIORequest,
7822                               tiIOSuccess,
7823                               SCSI_STAT_CHECK_CONDITION,
7824                               satIOContext->pTiSenseData,
7825                               satIOContext->interruptContext );
7826
7827     TI_DBG1(("satVerify10: no byte checking \n"));
7828     return tiSuccess;
7829   }
7830
7831   /* checking CONTROL */
7832   /* NACA == 1 or LINK == 1*/
7833   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
7834   {
7835     satSetSensePayload( pSense,
7836                         SCSI_SNSKEY_ILLEGAL_REQUEST,
7837                         0,
7838                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
7839                         satIOContext);
7840
7841     ostiInitiatorIOCompleted( tiRoot,
7842                               tiIORequest,
7843                               tiIOSuccess,
7844                               SCSI_STAT_CHECK_CONDITION,
7845                               satIOContext->pTiSenseData,
7846                               satIOContext->interruptContext );
7847
7848     TI_DBG2(("satVerify10: return control\n"));
7849     return tiSuccess;
7850   }
7851
7852   osti_memset(LBA, 0, sizeof(LBA));
7853   osti_memset(TL, 0, sizeof(TL));
7854
7855   /* do not use memcpy due to indexing in LBA and TL */
7856   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
7857   LBA[1] = scsiCmnd->cdb[3];
7858   LBA[2] = scsiCmnd->cdb[4];
7859   LBA[3] = scsiCmnd->cdb[5];  /* LSB */
7860
7861   TL[0] = 0;
7862   TL[1] = 0;
7863   TL[2] = scsiCmnd->cdb[7];  /* MSB */
7864   TL[3] = scsiCmnd->cdb[8];  /* LSB */
7865
7866   rangeChk = satAddNComparebit32(LBA, TL);
7867
7868   /* cbd10; computing LBA and transfer length */
7869   lba = (scsiCmnd->cdb[2] << (8*3)) + (scsiCmnd->cdb[3] << (8*2))
7870     + (scsiCmnd->cdb[4] << 8) + scsiCmnd->cdb[5];
7871   tl = (scsiCmnd->cdb[7] << 8) + scsiCmnd->cdb[8];
7872
7873   if (pSatDevData->satNCQ != agTRUE &&
7874       pSatDevData->sat48BitSupport != agTRUE
7875       )
7876   {
7877     if (lba > SAT_TR_LBA_LIMIT - 1)
7878     {
7879       satSetSensePayload( pSense,
7880                           SCSI_SNSKEY_ILLEGAL_REQUEST,
7881                           0,
7882                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
7883                           satIOContext);
7884
7885       ostiInitiatorIOCompleted( tiRoot,
7886                                 tiIORequest,
7887                                 tiIOSuccess,
7888                                 SCSI_STAT_CHECK_CONDITION,
7889                                 satIOContext->pTiSenseData,
7890                                 satIOContext->interruptContext );
7891
7892     TI_DBG1(("satVerify10: return LBA out of range, not EXT\n"));
7893     TI_DBG1(("satVerify10: cdb 0x%x 0x%x 0x%x 0x%x\n",scsiCmnd->cdb[2], scsiCmnd->cdb[3],
7894              scsiCmnd->cdb[4], scsiCmnd->cdb[5]));
7895     TI_DBG1(("satVerify10: lba 0x%x SAT_TR_LBA_LIMIT 0x%x\n", lba, SAT_TR_LBA_LIMIT));
7896     return tiSuccess;
7897     }
7898
7899     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
7900     {
7901       TI_DBG1(("satVerify10: return LBA+TL out of range, not EXT\n"));
7902       satSetSensePayload( pSense,
7903                           SCSI_SNSKEY_ILLEGAL_REQUEST,
7904                           0,
7905                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
7906                           satIOContext);
7907
7908       ostiInitiatorIOCompleted( tiRoot,
7909                                 tiIORequest,
7910                                 tiIOSuccess,
7911                                 SCSI_STAT_CHECK_CONDITION,
7912                                 satIOContext->pTiSenseData,
7913                                 satIOContext->interruptContext );
7914
7915     return tiSuccess;
7916     }
7917   }
7918
7919   if (pSatDevData->sat48BitSupport == agTRUE)
7920   {
7921     TI_DBG5(("satVerify10: SAT_READ_VERIFY_SECTORS_EXT\n"));
7922     fis->h.fisType        = 0x27;                   /* Reg host to device */
7923     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
7924
7925     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
7926     fis->h.features       = 0;                      /* FIS reserve */
7927     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
7928     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
7929     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
7930     fis->d.device         = 0x40;                   /* FIS LBA mode set 01000000 */
7931     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
7932     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
7933     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
7934     fis->d.featuresExp    = 0;                      /* FIS reserve */
7935     fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
7936     fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
7937
7938     fis->d.reserved4      = 0;
7939     fis->d.control        = 0;                      /* FIS HOB bit clear */
7940     fis->d.reserved5      = 0;
7941
7942     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
7943     satIOContext->ATACmd = SAT_READ_VERIFY_SECTORS_EXT;
7944   }
7945   else
7946   {
7947     TI_DBG5(("satVerify10: SAT_READ_VERIFY_SECTORS\n"));
7948     fis->h.fisType        = 0x27;                   /* Reg host to device */
7949     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
7950     fis->h.command        = SAT_READ_VERIFY_SECTORS;      /* 0x40 */
7951     fis->h.features       = 0;                      /* FIS reserve */
7952     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
7953     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
7954     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
7955       /* FIS LBA mode set LBA (27:24) */
7956     fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));
7957     fis->d.lbaLowExp      = 0;
7958     fis->d.lbaMidExp      = 0;
7959     fis->d.lbaHighExp     = 0;
7960     fis->d.featuresExp    = 0;
7961     fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
7962     fis->d.sectorCountExp = 0;
7963     fis->d.reserved4      = 0;
7964     fis->d.control        = 0;                      /* FIS HOB bit clear */
7965     fis->d.reserved5      = 0;
7966
7967     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
7968     satIOContext->ATACmd = SAT_READ_VERIFY_SECTORS;
7969
7970  }
7971
7972   satIOContext->currentLBA = lba;
7973   satIOContext->OrgTL = tl;
7974
7975   /*
7976     computing number of loop and remainder for tl
7977     0xFF in case not ext
7978     0xFFFF in case EXT
7979   */
7980   if (fis->h.command == SAT_READ_VERIFY_SECTORS)
7981   {
7982     LoopNum = satComputeLoopNum(tl, 0xFF);
7983   }
7984   else if (fis->h.command == SAT_READ_VERIFY_SECTORS_EXT)
7985   {
7986     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
7987     LoopNum = satComputeLoopNum(tl, 0xFFFF);
7988   }
7989   else
7990   {
7991     TI_DBG1(("satVerify10: error case 1!!!\n"));
7992     LoopNum = 1;
7993   }
7994
7995   satIOContext->LoopNum = LoopNum;
7996
7997   if (LoopNum == 1)
7998   {
7999     TI_DBG5(("satVerify10: NON CHAINED data\n"));
8000     /* Initialize CB for SATA completion.
8001      */
8002     satIOContext->satCompleteCB = &satNonChainedVerifyCB;
8003   }
8004   else
8005   {
8006     TI_DBG1(("satVerify10: CHAINED data\n"));
8007     /* re-setting tl */
8008     if (fis->h.command == SAT_READ_VERIFY_SECTORS)
8009     {
8010        fis->d.sectorCount    = 0xFF;
8011     }
8012     else if (fis->h.command == SAT_READ_VERIFY_SECTORS_EXT)
8013     {
8014       fis->d.sectorCount    = 0xFF;
8015       fis->d.sectorCountExp = 0xFF;
8016     }
8017     else
8018     {
8019       TI_DBG1(("satVerify10: error case 2!!!\n"));
8020     }
8021
8022     /* Initialize CB for SATA completion.
8023      */
8024     satIOContext->satCompleteCB = &satChainedVerifyCB;
8025   }
8026
8027
8028   /*
8029    * Prepare SGL and send FIS to LL layer.
8030    */
8031   satIOContext->reqType = agRequestType;       /* Save it */
8032
8033   status = sataLLIOStart( tiRoot,
8034                           tiIORequest,
8035                           tiDeviceHandle,
8036                           tiScsiRequest,
8037                           satIOContext);
8038   return (status);
8039 }
8040
8041 GLOBAL bit32  satChainedVerify(
8042                    tiRoot_t                  *tiRoot,
8043                    tiIORequest_t             *tiIORequest,
8044                    tiDeviceHandle_t          *tiDeviceHandle,
8045                    tiScsiInitiatorRequest_t *tiScsiRequest,
8046                    satIOContext_t            *satIOContext)
8047 {
8048   bit32                     status;
8049   satIOContext_t            *satOrgIOContext = agNULL;
8050   agsaFisRegHostToDevice_t  *fis;
8051   bit32                     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
8052   bit32                     lba = 0;
8053   bit32                     DenomTL = 0xFF;
8054   bit32                     Remainder = 0;
8055   bit8                      LBA[4]; /* 0 MSB, 3 LSB */
8056
8057   TI_DBG2(("satChainedVerify: start\n"));
8058
8059   fis             = satIOContext->pFis;
8060   satOrgIOContext = satIOContext->satOrgIOContext;
8061   osti_memset(LBA,0, sizeof(LBA));
8062
8063   switch (satOrgIOContext->ATACmd)
8064   {
8065   case SAT_READ_VERIFY_SECTORS:
8066     DenomTL = 0xFF;
8067     break;
8068   case SAT_READ_VERIFY_SECTORS_EXT:
8069     DenomTL = 0xFFFF;
8070     break;
8071   default:
8072     TI_DBG1(("satChainedVerify: error incorrect ata command 0x%x\n", satIOContext->ATACmd));
8073     return tiError;
8074     break;
8075   }
8076
8077   Remainder = satOrgIOContext->OrgTL % DenomTL;
8078   satOrgIOContext->currentLBA = satOrgIOContext->currentLBA + DenomTL;
8079   lba = satOrgIOContext->currentLBA;
8080
8081   LBA[0] = (bit8)((lba & 0xF000) >> (8 * 3)); /* MSB */
8082   LBA[1] = (bit8)((lba & 0xF00) >> (8 * 2));
8083   LBA[2] = (bit8)((lba & 0xF0) >> 8);
8084   LBA[3] = (bit8)(lba & 0xF);               /* LSB */
8085
8086   switch (satOrgIOContext->ATACmd)
8087   {
8088   case SAT_READ_VERIFY_SECTORS:
8089     fis->h.fisType        = 0x27;                   /* Reg host to device */
8090     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
8091     fis->h.command        = SAT_READ_VERIFY_SECTORS;          /* 0x40 */
8092     fis->h.features       = 0;                      /* FIS reserve */
8093     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
8094     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
8095     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
8096
8097     /* FIS LBA mode set LBA (27:24) */
8098     fis->d.device         = (bit8)((0x4 << 4) | (LBA[0] & 0xF));
8099
8100     fis->d.lbaLowExp      = 0;
8101     fis->d.lbaMidExp      = 0;
8102     fis->d.lbaHighExp     = 0;
8103     fis->d.featuresExp    = 0;
8104     if (satOrgIOContext->LoopNum == 1)
8105     {
8106       /* last loop */
8107       fis->d.sectorCount    = (bit8)Remainder;             /* FIS sector count (7:0) */
8108     }
8109     else
8110     {
8111       fis->d.sectorCount    = 0xFF;                   /* FIS sector count (7:0) */
8112     }
8113     fis->d.sectorCountExp = 0;
8114     fis->d.reserved4      = 0;
8115     fis->d.control        = 0;                      /* FIS HOB bit clear */
8116     fis->d.reserved5      = 0;
8117
8118     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
8119
8120     break;
8121   case SAT_READ_VERIFY_SECTORS_EXT:
8122     fis->h.fisType        = 0x27;                   /* Reg host to device */
8123     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
8124     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;      /* 0x42 */
8125     fis->h.features       = 0;                      /* FIS reserve */
8126     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
8127     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
8128     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
8129     fis->d.device         = 0x40;                   /* FIS LBA mode set */
8130     fis->d.lbaLowExp      = LBA[0];                 /* FIS LBA (31:24) */
8131     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
8132     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
8133     fis->d.featuresExp    = 0;                      /* FIS reserve */
8134     if (satOrgIOContext->LoopNum == 1)
8135     {
8136       /* last loop */
8137       fis->d.sectorCount    = (bit8)(Remainder & 0xFF);       /* FIS sector count (7:0) */
8138       fis->d.sectorCountExp = (bit8)((Remainder & 0xFF00) >> 8);       /* FIS sector count (15:8) */
8139     }
8140     else
8141     {
8142       fis->d.sectorCount    = 0xFF;                  /* FIS sector count (7:0) */
8143       fis->d.sectorCountExp = 0xFF;                  /* FIS sector count (15:8) */
8144     }
8145     fis->d.reserved4      = 0;
8146     fis->d.control        = 0;                       /* FIS HOB bit clear */
8147     fis->d.reserved5      = 0;
8148
8149     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
8150
8151     break;
8152
8153   default:
8154     TI_DBG1(("satChainedVerify: error incorrect ata command 0x%x\n", satIOContext->ATACmd));
8155     return tiError;
8156     break;
8157   }
8158
8159   /* Initialize CB for SATA completion.
8160    */
8161   /* chained data */
8162   satIOContext->satCompleteCB = &satChainedVerifyCB;
8163
8164
8165   /*
8166    * Prepare SGL and send FIS to LL layer.
8167    */
8168   satIOContext->reqType = agRequestType;       /* Save it */
8169
8170   status = sataLLIOStart( tiRoot,
8171                           tiIORequest,
8172                           tiDeviceHandle,
8173                           tiScsiRequest,
8174                           satIOContext);
8175
8176   TI_DBG5(("satChainedVerify: return\n"));
8177   return (status);
8178
8179 }
8180
8181
8182 /*****************************************************************************/
8183 /*! \brief SAT implementation for SCSI VERIFY (12).
8184  *
8185  *  SAT implementation for SCSI VERIFY (12).
8186  *
8187  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
8188  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
8189  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
8190  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
8191  *  \param   satIOContext_t:   Pointer to the SAT IO Context
8192  *
8193  *  \return If command is started successfully
8194  *    - \e tiSuccess:     I/O request successfully initiated.
8195  *    - \e tiBusy:        No resources available, try again later.
8196  *    - \e tiIONoDevice:  Invalid device handle.
8197  *    - \e tiError:       Other errors.
8198  */
8199 /*****************************************************************************/
8200 GLOBAL bit32  satVerify12(
8201                    tiRoot_t                  *tiRoot,
8202                    tiIORequest_t             *tiIORequest,
8203                    tiDeviceHandle_t          *tiDeviceHandle,
8204                    tiScsiInitiatorRequest_t *tiScsiRequest,
8205                    satIOContext_t            *satIOContext)
8206 {
8207   /*
8208     For simple implementation,
8209     no byte comparison supported as of 4/5/06
8210   */
8211   scsiRspSense_t            *pSense;
8212   tiIniScsiCmnd_t           *scsiCmnd;
8213   satDeviceData_t           *pSatDevData;
8214   agsaFisRegHostToDevice_t  *fis;
8215   bit32                     status;
8216   bit32                     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
8217   bit32                     lba = 0;
8218   bit32                     tl = 0;
8219   bit32                     LoopNum = 1;
8220   bit8                      LBA[4];
8221   bit8                      TL[4];
8222   bit32                     rangeChk = agFALSE; /* lba and tl range check */
8223
8224   TI_DBG5(("satVerify12 entry: tiDeviceHandle=%p tiIORequest=%p\n",
8225            tiDeviceHandle, tiIORequest));
8226
8227   pSense            = satIOContext->pSense;
8228   scsiCmnd          = &tiScsiRequest->scsiCmnd;
8229   pSatDevData       = satIOContext->pSatDevData;
8230   fis               = satIOContext->pFis;
8231
8232
8233   /* checking BYTCHK */
8234   if (scsiCmnd->cdb[1] & SCSI_VERIFY_BYTCHK_MASK)
8235   {
8236     /*
8237       should do the byte check
8238       but not supported in this version
8239      */
8240     satSetSensePayload( pSense,
8241                         SCSI_SNSKEY_ILLEGAL_REQUEST,
8242                         0,
8243                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
8244                         satIOContext);
8245
8246     ostiInitiatorIOCompleted( tiRoot,
8247                               tiIORequest,
8248                               tiIOSuccess,
8249                               SCSI_STAT_CHECK_CONDITION,
8250                               satIOContext->pTiSenseData,
8251                               satIOContext->interruptContext );
8252
8253     TI_DBG1(("satVerify12: no byte checking \n"));
8254     return tiSuccess;
8255   }
8256
8257   /* checking CONTROL */
8258   /* NACA == 1 or LINK == 1*/
8259   if ( (scsiCmnd->cdb[11] & SCSI_NACA_MASK) || (scsiCmnd->cdb[11] & SCSI_LINK_MASK) )
8260   {
8261     satSetSensePayload( pSense,
8262                         SCSI_SNSKEY_ILLEGAL_REQUEST,
8263                         0,
8264                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
8265                         satIOContext);
8266
8267     ostiInitiatorIOCompleted( tiRoot,
8268                               tiIORequest,
8269                               tiIOSuccess,
8270                               SCSI_STAT_CHECK_CONDITION,
8271                               satIOContext->pTiSenseData,
8272                               satIOContext->interruptContext );
8273
8274     TI_DBG1(("satVerify12: return control\n"));
8275     return tiSuccess;
8276   }
8277
8278   osti_memset(LBA, 0, sizeof(LBA));
8279   osti_memset(TL, 0, sizeof(TL));
8280
8281   /* do not use memcpy due to indexing in LBA and TL */
8282   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
8283   LBA[1] = scsiCmnd->cdb[3];
8284   LBA[2] = scsiCmnd->cdb[4];
8285   LBA[3] = scsiCmnd->cdb[5];  /* LSB */
8286
8287   TL[0] = scsiCmnd->cdb[6];   /* MSB */
8288   TL[1] = scsiCmnd->cdb[7];
8289   TL[2] = scsiCmnd->cdb[7];
8290   TL[3] = scsiCmnd->cdb[8];   /* LSB */
8291
8292   rangeChk = satAddNComparebit32(LBA, TL);
8293
8294   lba = satComputeCDB12LBA(satIOContext);
8295   tl = satComputeCDB12TL(satIOContext);
8296
8297   if (pSatDevData->satNCQ != agTRUE &&
8298       pSatDevData->sat48BitSupport != agTRUE
8299       )
8300   {
8301     if (lba > SAT_TR_LBA_LIMIT - 1)
8302     {
8303       satSetSensePayload( pSense,
8304                           SCSI_SNSKEY_ILLEGAL_REQUEST,
8305                           0,
8306                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
8307                           satIOContext);
8308
8309       ostiInitiatorIOCompleted( tiRoot,
8310                                 tiIORequest,
8311                                 tiIOSuccess,
8312                                 SCSI_STAT_CHECK_CONDITION,
8313                                 satIOContext->pTiSenseData,
8314                                 satIOContext->interruptContext );
8315
8316     TI_DBG1(("satVerify12: return LBA out of range, not EXT\n"));
8317     TI_DBG1(("satVerify12: cdb 0x%x 0x%x 0x%x 0x%x\n",scsiCmnd->cdb[2], scsiCmnd->cdb[3],
8318              scsiCmnd->cdb[4], scsiCmnd->cdb[5]));
8319     TI_DBG1(("satVerify12: lba 0x%x SAT_TR_LBA_LIMIT 0x%x\n", lba, SAT_TR_LBA_LIMIT));
8320     return tiSuccess;
8321     }
8322
8323     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
8324     {
8325       TI_DBG1(("satVerify12: return LBA+TL out of range, not EXT\n"));
8326       satSetSensePayload( pSense,
8327                           SCSI_SNSKEY_ILLEGAL_REQUEST,
8328                           0,
8329                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
8330                           satIOContext);
8331
8332       ostiInitiatorIOCompleted( tiRoot,
8333                                 tiIORequest,
8334                                 tiIOSuccess,
8335                                 SCSI_STAT_CHECK_CONDITION,
8336                                 satIOContext->pTiSenseData,
8337                                 satIOContext->interruptContext );
8338
8339     return tiSuccess;
8340     }
8341   }
8342
8343   if (pSatDevData->sat48BitSupport == agTRUE)
8344   {
8345     TI_DBG5(("satVerify12: SAT_READ_VERIFY_SECTORS_EXT\n"));
8346     fis->h.fisType        = 0x27;                   /* Reg host to device */
8347     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
8348
8349     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
8350     fis->h.features       = 0;                      /* FIS reserve */
8351     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
8352     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
8353     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
8354     fis->d.device         = 0x40;                   /* FIS LBA mode set 01000000 */
8355     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
8356     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
8357     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
8358     fis->d.featuresExp    = 0;                      /* FIS reserve */
8359     fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
8360     fis->d.sectorCountExp = scsiCmnd->cdb[8];       /* FIS sector count (15:8) */
8361
8362     fis->d.reserved4      = 0;
8363     fis->d.control        = 0;                      /* FIS HOB bit clear */
8364     fis->d.reserved5      = 0;
8365
8366     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
8367     satIOContext->ATACmd = SAT_READ_VERIFY_SECTORS_EXT;
8368   }
8369   else
8370   {
8371     TI_DBG5(("satVerify12: SAT_READ_VERIFY_SECTORS\n"));
8372     fis->h.fisType        = 0x27;                   /* Reg host to device */
8373     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
8374     fis->h.command        = SAT_READ_VERIFY_SECTORS;      /* 0x40 */
8375     fis->h.features       = 0;                      /* FIS reserve */
8376     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
8377     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
8378     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
8379       /* FIS LBA mode set LBA (27:24) */
8380     fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));
8381     fis->d.lbaLowExp      = 0;
8382     fis->d.lbaMidExp      = 0;
8383     fis->d.lbaHighExp     = 0;
8384     fis->d.featuresExp    = 0;
8385     fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
8386     fis->d.sectorCountExp = 0;
8387     fis->d.reserved4      = 0;
8388     fis->d.control        = 0;                      /* FIS HOB bit clear */
8389     fis->d.reserved5      = 0;
8390
8391     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
8392     satIOContext->ATACmd = SAT_READ_VERIFY_SECTORS;
8393
8394  }
8395
8396   satIOContext->currentLBA = lba;
8397   satIOContext->OrgTL = tl;
8398
8399   /*
8400     computing number of loop and remainder for tl
8401     0xFF in case not ext
8402     0xFFFF in case EXT
8403   */
8404   if (fis->h.command == SAT_READ_VERIFY_SECTORS)
8405   {
8406     LoopNum = satComputeLoopNum(tl, 0xFF);
8407   }
8408   else if (fis->h.command == SAT_READ_VERIFY_SECTORS_EXT)
8409   {
8410     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
8411     LoopNum = satComputeLoopNum(tl, 0xFFFF);
8412   }
8413   else
8414   {
8415     TI_DBG1(("satVerify12: error case 1!!!\n"));
8416     LoopNum = 1;
8417   }
8418
8419   satIOContext->LoopNum = LoopNum;
8420
8421   if (LoopNum == 1)
8422   {
8423     TI_DBG5(("satVerify12: NON CHAINED data\n"));
8424     /* Initialize CB for SATA completion.
8425      */
8426     satIOContext->satCompleteCB = &satNonChainedVerifyCB;
8427   }
8428   else
8429   {
8430     TI_DBG1(("satVerify12: CHAINED data\n"));
8431     /* re-setting tl */
8432     if (fis->h.command == SAT_READ_VERIFY_SECTORS)
8433     {
8434        fis->d.sectorCount    = 0xFF;
8435     }
8436     else if (fis->h.command == SAT_READ_VERIFY_SECTORS_EXT)
8437     {
8438       fis->d.sectorCount    = 0xFF;
8439       fis->d.sectorCountExp = 0xFF;
8440     }
8441     else
8442     {
8443       TI_DBG1(("satVerify10: error case 2!!!\n"));
8444     }
8445
8446     /* Initialize CB for SATA completion.
8447      */
8448     satIOContext->satCompleteCB = &satChainedVerifyCB;
8449   }
8450
8451
8452   /*
8453    * Prepare SGL and send FIS to LL layer.
8454    */
8455   satIOContext->reqType = agRequestType;       /* Save it */
8456
8457   status = sataLLIOStart( tiRoot,
8458                           tiIORequest,
8459                           tiDeviceHandle,
8460                           tiScsiRequest,
8461                           satIOContext);
8462   return (status);
8463 }
8464 /*****************************************************************************/
8465 /*! \brief SAT implementation for SCSI VERIFY (16).
8466  *
8467  *  SAT implementation for SCSI VERIFY (16).
8468  *
8469  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
8470  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
8471  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
8472  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
8473  *  \param   satIOContext_t:   Pointer to the SAT IO Context
8474  *
8475  *  \return If command is started successfully
8476  *    - \e tiSuccess:     I/O request successfully initiated.
8477  *    - \e tiBusy:        No resources available, try again later.
8478  *    - \e tiIONoDevice:  Invalid device handle.
8479  *    - \e tiError:       Other errors.
8480  */
8481 /*****************************************************************************/
8482 GLOBAL bit32  satVerify16(
8483                    tiRoot_t                  *tiRoot,
8484                    tiIORequest_t             *tiIORequest,
8485                    tiDeviceHandle_t          *tiDeviceHandle,
8486                    tiScsiInitiatorRequest_t *tiScsiRequest,
8487                    satIOContext_t            *satIOContext)
8488 {
8489   /*
8490     For simple implementation,
8491     no byte comparison supported as of 4/5/06
8492   */
8493   scsiRspSense_t            *pSense;
8494   tiIniScsiCmnd_t           *scsiCmnd;
8495   satDeviceData_t           *pSatDevData;
8496   agsaFisRegHostToDevice_t  *fis;
8497   bit32                     status;
8498   bit32                     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
8499   bit32                     lba = 0;
8500   bit32                     tl = 0;
8501   bit32                     LoopNum = 1;
8502   bit8                      LBA[8];
8503   bit8                      TL[8];
8504   bit32                     rangeChk = agFALSE; /* lba and tl range check */
8505   bit32                     limitChk = agFALSE; /* lba and tl range check */
8506
8507   TI_DBG5(("satVerify16 entry: tiDeviceHandle=%p tiIORequest=%p\n",
8508       tiDeviceHandle, tiIORequest));
8509
8510   pSense            = satIOContext->pSense;
8511   scsiCmnd          = &tiScsiRequest->scsiCmnd;
8512   pSatDevData       = satIOContext->pSatDevData;
8513   fis               = satIOContext->pFis;
8514
8515   /* checking BYTCHK */
8516   if (scsiCmnd->cdb[1] & SCSI_VERIFY_BYTCHK_MASK)
8517   {
8518     /*
8519       should do the byte check
8520       but not supported in this version
8521      */
8522     satSetSensePayload( pSense,
8523                         SCSI_SNSKEY_ILLEGAL_REQUEST,
8524                         0,
8525                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
8526                         satIOContext);
8527
8528     ostiInitiatorIOCompleted( tiRoot,
8529                               tiIORequest,
8530                               tiIOSuccess,
8531                               SCSI_STAT_CHECK_CONDITION,
8532                               satIOContext->pTiSenseData,
8533                               satIOContext->interruptContext );
8534
8535     TI_DBG1(("satVerify16: no byte checking \n"));
8536     return tiSuccess;
8537   }
8538
8539   /* checking CONTROL */
8540   /* NACA == 1 or LINK == 1*/
8541   if ( (scsiCmnd->cdb[15] & SCSI_NACA_MASK) || (scsiCmnd->cdb[15] & SCSI_LINK_MASK) )
8542   {
8543     satSetSensePayload( pSense,
8544                         SCSI_SNSKEY_ILLEGAL_REQUEST,
8545                         0,
8546                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
8547                         satIOContext);
8548
8549     ostiInitiatorIOCompleted( tiRoot,
8550                               tiIORequest,
8551                               tiIOSuccess,
8552                               SCSI_STAT_CHECK_CONDITION,
8553                               satIOContext->pTiSenseData,
8554                               satIOContext->interruptContext );
8555
8556     TI_DBG2(("satVerify16: return control\n"));
8557     return tiSuccess;
8558   }
8559
8560   osti_memset(LBA, 0, sizeof(LBA));
8561   osti_memset(TL, 0, sizeof(TL));
8562
8563
8564   /* do not use memcpy due to indexing in LBA and TL */
8565   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
8566   LBA[1] = scsiCmnd->cdb[3];
8567   LBA[2] = scsiCmnd->cdb[4];
8568   LBA[3] = scsiCmnd->cdb[5];
8569   LBA[4] = scsiCmnd->cdb[6];
8570   LBA[5] = scsiCmnd->cdb[7];
8571   LBA[6] = scsiCmnd->cdb[8];
8572   LBA[7] = scsiCmnd->cdb[9];  /* LSB */
8573
8574   TL[0] = 0;
8575   TL[1] = 0;
8576   TL[2] = 0;
8577   TL[3] = 0;
8578   TL[4] = scsiCmnd->cdb[10];   /* MSB */
8579   TL[5] = scsiCmnd->cdb[11];
8580   TL[6] = scsiCmnd->cdb[12];
8581   TL[7] = scsiCmnd->cdb[13];   /* LSB */
8582
8583   rangeChk = satAddNComparebit64(LBA, TL);
8584
8585   limitChk = satCompareLBALimitbit(LBA);
8586
8587   lba = satComputeCDB16LBA(satIOContext);
8588   tl = satComputeCDB16TL(satIOContext);
8589
8590   if (pSatDevData->satNCQ != agTRUE &&
8591      pSatDevData->sat48BitSupport != agTRUE
8592      )
8593   {
8594     if (limitChk)
8595     {
8596       TI_DBG1(("satVerify16: return LBA out of range, not EXT\n"));
8597       satSetSensePayload( pSense,
8598                           SCSI_SNSKEY_ILLEGAL_REQUEST,
8599                           0,
8600                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
8601                           satIOContext);
8602
8603       ostiInitiatorIOCompleted( tiRoot,
8604                                 tiIORequest,
8605                                 tiIOSuccess,
8606                                 SCSI_STAT_CHECK_CONDITION,
8607                                 satIOContext->pTiSenseData,
8608                                 satIOContext->interruptContext );
8609
8610     return tiSuccess;
8611     }
8612     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
8613     {
8614       TI_DBG1(("satVerify16: return LBA+TL out of range, not EXT\n"));
8615       satSetSensePayload( pSense,
8616                           SCSI_SNSKEY_ILLEGAL_REQUEST,
8617                           0,
8618                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
8619                           satIOContext);
8620
8621       ostiInitiatorIOCompleted( tiRoot,
8622                                 tiIORequest,
8623                                 tiIOSuccess,
8624                                 SCSI_STAT_CHECK_CONDITION,
8625                                 satIOContext->pTiSenseData,
8626                                 satIOContext->interruptContext );
8627
8628     return tiSuccess;
8629     }
8630   }
8631
8632   if (pSatDevData->sat48BitSupport == agTRUE)
8633   {
8634     TI_DBG5(("satVerify16: SAT_READ_VERIFY_SECTORS_EXT\n"));
8635     fis->h.fisType        = 0x27;                   /* Reg host to device */
8636     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
8637
8638     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
8639     fis->h.features       = 0;                      /* FIS reserve */
8640     fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
8641     fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
8642     fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
8643     fis->d.device         = 0x40;                   /* FIS LBA mode set 01000000 */
8644     fis->d.lbaLowExp      = scsiCmnd->cdb[6];       /* FIS LBA (31:24) */
8645     fis->d.lbaMidExp      = scsiCmnd->cdb[5];       /* FIS LBA (39:32) */
8646     fis->d.lbaHighExp     = scsiCmnd->cdb[4];       /* FIS LBA (47:40) */
8647     fis->d.featuresExp    = 0;                      /* FIS reserve */
8648     fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
8649     fis->d.sectorCountExp = scsiCmnd->cdb[12];       /* FIS sector count (15:8) */
8650
8651     fis->d.reserved4      = 0;
8652     fis->d.control        = 0;                      /* FIS HOB bit clear */
8653     fis->d.reserved5      = 0;
8654
8655     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
8656     satIOContext->ATACmd = SAT_READ_VERIFY_SECTORS_EXT;
8657   }
8658   else
8659   {
8660     TI_DBG5(("satVerify12: SAT_READ_VERIFY_SECTORS\n"));
8661     fis->h.fisType        = 0x27;                   /* Reg host to device */
8662     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
8663     fis->h.command        = SAT_READ_VERIFY_SECTORS;      /* 0x40 */
8664     fis->h.features       = 0;                      /* FIS reserve */
8665     fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
8666     fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
8667     fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
8668       /* FIS LBA mode set LBA (27:24) */
8669     fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[6] & 0xF));
8670     fis->d.lbaLowExp      = 0;
8671     fis->d.lbaMidExp      = 0;
8672     fis->d.lbaHighExp     = 0;
8673     fis->d.featuresExp    = 0;
8674     fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
8675     fis->d.sectorCountExp = 0;
8676     fis->d.reserved4      = 0;
8677     fis->d.control        = 0;                      /* FIS HOB bit clear */
8678     fis->d.reserved5      = 0;
8679
8680     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
8681     satIOContext->ATACmd = SAT_READ_VERIFY_SECTORS;
8682
8683  }
8684
8685   satIOContext->currentLBA = lba;
8686   satIOContext->OrgTL = tl;
8687
8688   /*
8689     computing number of loop and remainder for tl
8690     0xFF in case not ext
8691     0xFFFF in case EXT
8692   */
8693   if (fis->h.command == SAT_READ_VERIFY_SECTORS)
8694   {
8695     LoopNum = satComputeLoopNum(tl, 0xFF);
8696   }
8697   else if (fis->h.command == SAT_READ_VERIFY_SECTORS_EXT)
8698   {
8699     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
8700     LoopNum = satComputeLoopNum(tl, 0xFFFF);
8701   }
8702   else
8703   {
8704     TI_DBG1(("satVerify12: error case 1!!!\n"));
8705     LoopNum = 1;
8706   }
8707
8708   satIOContext->LoopNum = LoopNum;
8709
8710   if (LoopNum == 1)
8711   {
8712     TI_DBG5(("satVerify12: NON CHAINED data\n"));
8713     /* Initialize CB for SATA completion.
8714      */
8715     satIOContext->satCompleteCB = &satNonChainedVerifyCB;
8716   }
8717   else
8718   {
8719     TI_DBG1(("satVerify12: CHAINED data\n"));
8720     /* re-setting tl */
8721     if (fis->h.command == SAT_READ_VERIFY_SECTORS)
8722     {
8723        fis->d.sectorCount    = 0xFF;
8724     }
8725     else if (fis->h.command == SAT_READ_VERIFY_SECTORS_EXT)
8726     {
8727       fis->d.sectorCount    = 0xFF;
8728       fis->d.sectorCountExp = 0xFF;
8729     }
8730     else
8731     {
8732       TI_DBG1(("satVerify10: error case 2!!!\n"));
8733     }
8734
8735     /* Initialize CB for SATA completion.
8736      */
8737     satIOContext->satCompleteCB = &satChainedVerifyCB;
8738   }
8739
8740
8741   /*
8742    * Prepare SGL and send FIS to LL layer.
8743    */
8744   satIOContext->reqType = agRequestType;       /* Save it */
8745
8746   status = sataLLIOStart( tiRoot,
8747                           tiIORequest,
8748                           tiDeviceHandle,
8749                           tiScsiRequest,
8750                           satIOContext);
8751   return (status);
8752 }
8753 /*****************************************************************************/
8754 /*! \brief SAT implementation for SCSI satFormatUnit.
8755  *
8756  *  SAT implementation for SCSI satFormatUnit.
8757  *
8758  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
8759  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
8760  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
8761  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
8762  *  \param   satIOContext_t:   Pointer to the SAT IO Context
8763  *
8764  *  \return If command is started successfully
8765  *    - \e tiSuccess:     I/O request successfully initiated.
8766  *    - \e tiBusy:        No resources available, try again later.
8767  *    - \e tiIONoDevice:  Invalid device handle.
8768  *    - \e tiError:       Other errors.
8769  */
8770 /*****************************************************************************/
8771 GLOBAL bit32  satFormatUnit(
8772                    tiRoot_t                  *tiRoot,
8773                    tiIORequest_t             *tiIORequest,
8774                    tiDeviceHandle_t          *tiDeviceHandle,
8775                    tiScsiInitiatorRequest_t *tiScsiRequest,
8776                    satIOContext_t            *satIOContext)
8777 {
8778   /*
8779     note: we don't support media certification in this version and IP bit
8780     satDevData->satFormatState will be agFalse since SAT does not actually sends
8781     any ATA command
8782    */
8783
8784   scsiRspSense_t          *pSense;
8785   tiIniScsiCmnd_t         *scsiCmnd;
8786   bit32                    index = 0;
8787
8788   pSense        = satIOContext->pSense;
8789   scsiCmnd      = &tiScsiRequest->scsiCmnd;
8790
8791   TI_DBG5(("satFormatUnit:start\n"));
8792
8793   /*
8794     checking opcode
8795     1. FMTDATA bit == 0(no defect list header)
8796     2. FMTDATA bit == 1 and DCRT bit == 1(defect list header is provided
8797     with DCRT bit set)
8798   */
8799   if ( ((scsiCmnd->cdb[1] & SCSI_FORMAT_UNIT_FMTDATA_MASK) == 0) ||
8800        ((scsiCmnd->cdb[1] & SCSI_FORMAT_UNIT_FMTDATA_MASK) &&
8801         (scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_DCRT_MASK))
8802        )
8803   {
8804     ostiInitiatorIOCompleted( tiRoot,
8805                               tiIORequest,
8806                               tiIOSuccess,
8807                               SCSI_STAT_GOOD,
8808                               agNULL,
8809                               satIOContext->interruptContext);
8810
8811     TI_DBG2(("satFormatUnit: return opcode\n"));
8812     return tiSuccess;
8813   }
8814
8815   /*
8816     checking DEFECT LIST FORMAT and defect list length
8817   */
8818   if ( (((scsiCmnd->cdb[1] & SCSI_FORMAT_UNIT_DEFECT_LIST_FORMAT_MASK) == 0x00) ||
8819         ((scsiCmnd->cdb[1] & SCSI_FORMAT_UNIT_DEFECT_LIST_FORMAT_MASK) == 0x06)) )
8820   {
8821     /* short parameter header */
8822     if ((scsiCmnd->cdb[2] & SCSI_FORMAT_UNIT_LONGLIST_MASK) == 0x00)
8823     {
8824       index = 8;
8825     }
8826     /* long parameter header */
8827     if ((scsiCmnd->cdb[2] & SCSI_FORMAT_UNIT_LONGLIST_MASK) == 0x01)
8828     {
8829       index = 10;
8830     }
8831     /* defect list length */
8832     if ((scsiCmnd->cdb[index] != 0) || (scsiCmnd->cdb[index+1] != 0))
8833     {
8834       satSetSensePayload( pSense,
8835                           SCSI_SNSKEY_ILLEGAL_REQUEST,
8836                           0,
8837                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
8838                           satIOContext);
8839
8840       ostiInitiatorIOCompleted( tiRoot,
8841                                 tiIORequest,
8842                                 tiIOSuccess,
8843                                 SCSI_STAT_CHECK_CONDITION,
8844                                 satIOContext->pTiSenseData,
8845                                 satIOContext->interruptContext );
8846
8847       TI_DBG1(("satFormatUnit: return defect list format\n"));
8848       return tiSuccess;
8849     }
8850   }
8851
8852    /* FMTDATA == 1 && CMPLIST == 1*/
8853   if ( (scsiCmnd->cdb[1] & SCSI_FORMAT_UNIT_FMTDATA_MASK) &&
8854        (scsiCmnd->cdb[1] & SCSI_FORMAT_UNIT_CMPLIST_MASK) )
8855   {
8856     satSetSensePayload( pSense,
8857                         SCSI_SNSKEY_ILLEGAL_REQUEST,
8858                         0,
8859                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
8860                         satIOContext);
8861
8862     ostiInitiatorIOCompleted( tiRoot,
8863                               tiIORequest,
8864                               tiIOSuccess,
8865                               SCSI_STAT_CHECK_CONDITION,
8866                               satIOContext->pTiSenseData,
8867                               satIOContext->interruptContext );
8868
8869     TI_DBG1(("satFormatUnit: return cmplist\n"));
8870     return tiSuccess;
8871
8872   }
8873
8874  if ( (scsiCmnd->cdb[5] & SCSI_NACA_MASK) || (scsiCmnd->cdb[5] & SCSI_LINK_MASK) )
8875   {
8876     satSetSensePayload( pSense,
8877                         SCSI_SNSKEY_ILLEGAL_REQUEST,
8878                         0,
8879                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
8880                         satIOContext);
8881
8882     ostiInitiatorIOCompleted( tiRoot,
8883                               tiIORequest,
8884                               tiIOSuccess,
8885                               SCSI_STAT_CHECK_CONDITION,
8886                               satIOContext->pTiSenseData,
8887                               satIOContext->interruptContext );
8888
8889     TI_DBG1(("satFormatUnit: return control\n"));
8890     return tiSuccess;
8891   }
8892
8893   /* defect list header filed, if exists, SAT rev8, Table 37, p48 */
8894   if (scsiCmnd->cdb[1] & SCSI_FORMAT_UNIT_FMTDATA_MASK)
8895   {
8896     /* case 1,2,3 */
8897     /* IMMED 1; FOV 0; FOV 1, DCRT 1, IP 0 */
8898     if ( (scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_IMMED_MASK) ||
8899          ( !(scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_FOV_MASK)) ||
8900          ( (scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_FOV_MASK) &&
8901            (scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_DCRT_MASK) &&
8902            !(scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_IP_MASK))
8903          )
8904     {
8905       ostiInitiatorIOCompleted( tiRoot,
8906                                 tiIORequest,
8907                                 tiIOSuccess,
8908                                 SCSI_STAT_GOOD,
8909                                 agNULL,
8910                                 satIOContext->interruptContext);
8911
8912       TI_DBG5(("satFormatUnit: return defect list case 1\n"));
8913       return tiSuccess;
8914     }
8915     /* case 4,5,6 */
8916     /*
8917         1. IMMED 0, FOV 1, DCRT 0, IP 0
8918         2. IMMED 0, FOV 1, DCRT 0, IP 1
8919         3. IMMED 0, FOV 1, DCRT 1, IP 1
8920       */
8921
8922     if ( ( !(scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_IMMED_MASK) &&
8923             (scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_FOV_MASK) &&
8924            !(scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_DCRT_MASK) &&
8925            !(scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_IP_MASK) )
8926          ||
8927          ( !(scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_IMMED_MASK) &&
8928             (scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_FOV_MASK) &&
8929            !(scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_DCRT_MASK) &&
8930             (scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_IP_MASK) )
8931          ||
8932          ( !(scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_IMMED_MASK) &&
8933             (scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_FOV_MASK) &&
8934             (scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_DCRT_MASK) &&
8935             (scsiCmnd->cdb[7] & SCSI_FORMAT_UNIT_IP_MASK) )
8936          )
8937     {
8938
8939       satSetSensePayload( pSense,
8940                           SCSI_SNSKEY_ILLEGAL_REQUEST,
8941                           0,
8942                           SCSI_SNSCODE_INVALID_FIELD_PARAMETER_LIST,
8943                           satIOContext);
8944
8945       ostiInitiatorIOCompleted( tiRoot,
8946                                 tiIORequest,
8947                                 tiIOSuccess,
8948                                 SCSI_STAT_CHECK_CONDITION,
8949                                 satIOContext->pTiSenseData,
8950                                 satIOContext->interruptContext );
8951
8952       TI_DBG5(("satFormatUnit: return defect list case 2\n"));
8953       return tiSuccess;
8954
8955     }
8956   }
8957
8958
8959   /*
8960    * Send the completion response now.
8961    */
8962   ostiInitiatorIOCompleted( tiRoot,
8963                             tiIORequest,
8964                             tiIOSuccess,
8965                             SCSI_STAT_GOOD,
8966                             agNULL,
8967                             satIOContext->interruptContext);
8968
8969   TI_DBG5(("satFormatUnit: return last\n"));
8970   return tiSuccess;
8971 }
8972
8973
8974 /*****************************************************************************/
8975 /*! \brief SAT implementation for SCSI satSendDiagnostic.
8976  *
8977  *  SAT implementation for SCSI satSendDiagnostic.
8978  *
8979  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
8980  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
8981  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
8982  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
8983  *  \param   satIOContext_t:   Pointer to the SAT IO Context
8984  *
8985  *  \return If command is started successfully
8986  *    - \e tiSuccess:     I/O request successfully initiated.
8987  *    - \e tiBusy:        No resources available, try again later.
8988  *    - \e tiIONoDevice:  Invalid device handle.
8989  *    - \e tiError:       Other errors.
8990  */
8991 /*****************************************************************************/
8992 GLOBAL bit32  satSendDiagnostic(
8993                    tiRoot_t                  *tiRoot,
8994                    tiIORequest_t             *tiIORequest,
8995                    tiDeviceHandle_t          *tiDeviceHandle,
8996                    tiScsiInitiatorRequest_t *tiScsiRequest,
8997                    satIOContext_t            *satIOContext)
8998 {
8999   bit32                     status;
9000   bit32                     agRequestType;
9001   satDeviceData_t           *pSatDevData;
9002   scsiRspSense_t            *pSense;
9003   tiIniScsiCmnd_t           *scsiCmnd;
9004   agsaFisRegHostToDevice_t  *fis;
9005   bit32                     parmLen;
9006
9007   pSense        = satIOContext->pSense;
9008   pSatDevData   = satIOContext->pSatDevData;
9009   scsiCmnd      = &tiScsiRequest->scsiCmnd;
9010   fis           = satIOContext->pFis;
9011
9012   TI_DBG5(("satSendDiagnostic:start\n"));
9013
9014   /* reset satVerifyState */
9015   pSatDevData->satVerifyState = 0;
9016   /* no pending diagnostic in background */
9017   pSatDevData->satBGPendingDiag = agFALSE;
9018
9019   /* table 27, 8.10 p39 SAT Rev8 */
9020   /*
9021     1. checking PF == 1
9022     2. checking DEVOFFL == 1
9023     3. checking UNITOFFL == 1
9024     4. checking PARAMETER LIST LENGTH != 0
9025
9026   */
9027   if ( (scsiCmnd->cdb[1] & SCSI_PF_MASK) ||
9028        (scsiCmnd->cdb[1] & SCSI_DEVOFFL_MASK) ||
9029        (scsiCmnd->cdb[1] & SCSI_UNITOFFL_MASK) ||
9030        ( (scsiCmnd->cdb[3] != 0) || (scsiCmnd->cdb[4] != 0) )
9031        )
9032   {
9033     satSetSensePayload( pSense,
9034                         SCSI_SNSKEY_ILLEGAL_REQUEST,
9035                         0,
9036                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
9037                         satIOContext);
9038
9039     ostiInitiatorIOCompleted( tiRoot,
9040                               tiIORequest,
9041                               tiIOSuccess,
9042                               SCSI_STAT_CHECK_CONDITION,
9043                               satIOContext->pTiSenseData,
9044                               satIOContext->interruptContext );
9045
9046     TI_DBG1(("satSendDiagnostic: return PF, DEVOFFL, UNITOFFL, PARAM LIST\n"));
9047     return tiSuccess;
9048   }
9049
9050   /* checking CONTROL */
9051   /* NACA == 1 or LINK == 1*/
9052   if ( (scsiCmnd->cdb[5] & SCSI_NACA_MASK) || (scsiCmnd->cdb[5] & SCSI_LINK_MASK) )
9053   {
9054     satSetSensePayload( pSense,
9055                         SCSI_SNSKEY_ILLEGAL_REQUEST,
9056                         0,
9057                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
9058                         satIOContext);
9059
9060     ostiInitiatorIOCompleted( tiRoot,
9061                               tiIORequest,
9062                               tiIOSuccess,
9063                               SCSI_STAT_CHECK_CONDITION,
9064                               satIOContext->pTiSenseData,
9065                               satIOContext->interruptContext );
9066
9067     TI_DBG2(("satSendDiagnostic: return control\n"));
9068     return tiSuccess;
9069   }
9070
9071   parmLen = (scsiCmnd->cdb[3] << 8) + scsiCmnd->cdb[4];
9072
9073   /* checking SELFTEST bit*/
9074   /* table 29, 8.10.3, p41 SAT Rev8 */
9075   /* case 1 */
9076   if ( !(scsiCmnd->cdb[1] & SCSI_SEND_DIAGNOSTIC_SELFTEST_MASK) &&
9077        (pSatDevData->satSMARTSelfTest == agFALSE)
9078        )
9079   {
9080     satSetSensePayload( pSense,
9081                         SCSI_SNSKEY_ILLEGAL_REQUEST,
9082                         0,
9083                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
9084                         satIOContext);
9085
9086     ostiInitiatorIOCompleted( tiRoot,
9087                               tiIORequest,
9088                               tiIOSuccess,
9089                               SCSI_STAT_CHECK_CONDITION,
9090                               satIOContext->pTiSenseData,
9091                               satIOContext->interruptContext );
9092
9093     TI_DBG1(("satSendDiagnostic: return Table 29 case 1\n"));
9094     return tiSuccess;
9095   }
9096
9097   /* case 2 */
9098   if ( !(scsiCmnd->cdb[1] & SCSI_SEND_DIAGNOSTIC_SELFTEST_MASK) &&
9099        (pSatDevData->satSMARTSelfTest == agTRUE) &&
9100        (pSatDevData->satSMARTEnabled == agFALSE)
9101        )
9102   {
9103     satSetSensePayload( pSense,
9104                         SCSI_SNSKEY_ABORTED_COMMAND,
9105                         0,
9106                         SCSI_SNSCODE_ATA_DEVICE_FEATURE_NOT_ENABLED,
9107                         satIOContext);
9108
9109     ostiInitiatorIOCompleted( tiRoot,
9110                               tiIORequest,
9111                               tiIOSuccess,
9112                               SCSI_STAT_CHECK_CONDITION,
9113                               satIOContext->pTiSenseData,
9114                               satIOContext->interruptContext );
9115
9116     TI_DBG5(("satSendDiagnostic: return Table 29 case 2\n"));
9117     return tiSuccess;
9118   }
9119   /*
9120     case 3
9121      see SELF TEST CODE later
9122   */
9123
9124
9125
9126   /* case 4 */
9127
9128   /*
9129     sends three ATA verify commands
9130
9131   */
9132   if ( ((scsiCmnd->cdb[1] & SCSI_SEND_DIAGNOSTIC_SELFTEST_MASK) &&
9133         (pSatDevData->satSMARTSelfTest == agFALSE))
9134        ||
9135        ((scsiCmnd->cdb[1] & SCSI_SEND_DIAGNOSTIC_SELFTEST_MASK) &&
9136         (pSatDevData->satSMARTSelfTest == agTRUE) &&
9137         (pSatDevData->satSMARTEnabled == agFALSE))
9138        )
9139   {
9140     /*
9141       sector count 1, LBA 0
9142       sector count 1, LBA MAX
9143       sector count 1, LBA random
9144     */
9145     if (pSatDevData->sat48BitSupport == agTRUE)
9146     {
9147       /* sends READ VERIFY SECTOR(S) EXT*/
9148       fis->h.fisType        = 0x27;                   /* Reg host to device */
9149       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9150       fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
9151       fis->h.features       = 0;                      /* FIS reserve */
9152       fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
9153       fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
9154       fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
9155       fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
9156       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
9157       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
9158       fis->d.featuresExp    = 0;                      /* FIS reserve */
9159       fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
9160       fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
9161       fis->d.reserved4      = 0;
9162       fis->d.device         = 0x40;                   /* 01000000 */
9163       fis->d.control        = 0;                      /* FIS HOB bit clear */
9164       fis->d.reserved5      = 0;
9165
9166       agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9167     }
9168     else
9169     {
9170       /* READ VERIFY SECTOR(S)*/
9171       fis->h.fisType        = 0x27;                   /* Reg host to device */
9172       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9173       fis->h.command        = SAT_READ_VERIFY_SECTORS;/* 0x40 */
9174       fis->h.features       = 0;                      /* FIS features NA       */
9175       fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
9176       fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
9177       fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
9178       fis->d.lbaLowExp      = 0;
9179       fis->d.lbaMidExp      = 0;
9180       fis->d.lbaHighExp     = 0;
9181       fis->d.featuresExp    = 0;
9182       fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
9183       fis->d.sectorCountExp = 0;
9184       fis->d.reserved4      = 0;
9185       fis->d.device         = 0x40;                   /* 01000000 */
9186       fis->d.control        = 0;                      /* FIS HOB bit clear */
9187       fis->d.reserved5      = 0;
9188
9189       agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9190     }
9191
9192     /* Initialize CB for SATA completion.
9193      */
9194     satIOContext->satCompleteCB = &satSendDiagnosticCB;
9195
9196     /*
9197      * Prepare SGL and send FIS to LL layer.
9198      */
9199     satIOContext->reqType = agRequestType;       /* Save it */
9200
9201     status = sataLLIOStart( tiRoot,
9202                             tiIORequest,
9203                             tiDeviceHandle,
9204                             tiScsiRequest,
9205                             satIOContext);
9206
9207
9208     TI_DBG5(("satSendDiagnostic: return Table 29 case 4\n"));
9209     return (status);
9210   }
9211   /* case 5 */
9212   if ( (scsiCmnd->cdb[1] & SCSI_SEND_DIAGNOSTIC_SELFTEST_MASK) &&
9213        (pSatDevData->satSMARTSelfTest == agTRUE) &&
9214        (pSatDevData->satSMARTEnabled == agTRUE)
9215        )
9216   {
9217     /* sends SMART EXECUTE OFF-LINE IMMEDIATE */
9218     fis->h.fisType        = 0x27;                   /* Reg host to device */
9219     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9220     fis->h.command        = SAT_SMART_EXEUTE_OFF_LINE_IMMEDIATE;/* 0xB0 */
9221     fis->h.features       = 0xD4;                      /* FIS features NA       */
9222     fis->d.lbaLow         = 0x81;                      /* FIS LBA (7 :0 ) */
9223     fis->d.lbaMid         = 0x4F;                      /* FIS LBA (15:8 ) */
9224     fis->d.lbaHigh        = 0xC2;                      /* FIS LBA (23:16) */
9225     fis->d.lbaLowExp      = 0;
9226     fis->d.lbaMidExp      = 0;
9227     fis->d.lbaHighExp     = 0;
9228     fis->d.featuresExp    = 0;
9229     fis->d.sectorCount    = 0;                         /* FIS sector count (7:0) */
9230     fis->d.sectorCountExp = 0;
9231     fis->d.reserved4      = 0;
9232     fis->d.device         = 0;                         /* FIS DEV is discared in SATA */
9233     fis->d.control        = 0;                         /* FIS HOB bit clear */
9234     fis->d.reserved5      = 0;
9235
9236     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9237
9238     /* Initialize CB for SATA completion.
9239      */
9240     satIOContext->satCompleteCB = &satSendDiagnosticCB;
9241
9242     /*
9243      * Prepare SGL and send FIS to LL layer.
9244      */
9245     satIOContext->reqType = agRequestType;       /* Save it */
9246
9247     status = sataLLIOStart( tiRoot,
9248                             tiIORequest,
9249                             tiDeviceHandle,
9250                             tiScsiRequest,
9251                             satIOContext);
9252
9253
9254     TI_DBG5(("satSendDiagnostic: return Table 29 case 5\n"));
9255     return (status);
9256   }
9257
9258
9259
9260
9261   /* SAT rev8 Table29 p41 case 3*/
9262   /* checking SELF TEST CODE*/
9263   if ( !(scsiCmnd->cdb[1] & SCSI_SEND_DIAGNOSTIC_SELFTEST_MASK) &&
9264        (pSatDevData->satSMARTSelfTest == agTRUE) &&
9265        (pSatDevData->satSMARTEnabled == agTRUE)
9266        )
9267   {
9268     /* SAT rev8 Table28 p40 */
9269     /* finding self-test code */
9270     switch ((scsiCmnd->cdb[1] & SCSI_SEND_DIAGNOSTIC_TEST_CODE_MASK) >> 5)
9271     {
9272     case 1:
9273       pSatDevData->satBGPendingDiag = agTRUE;
9274
9275       ostiInitiatorIOCompleted( tiRoot,
9276                                 tiIORequest,
9277                                 tiIOSuccess,
9278                                 SCSI_STAT_GOOD,
9279                                 agNULL,
9280                                 satIOContext->interruptContext );
9281       /* sends SMART EXECUTE OFF-LINE IMMEDIATE */
9282       fis->h.fisType        = 0x27;                   /* Reg host to device */
9283       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9284       fis->h.command        = SAT_SMART_EXEUTE_OFF_LINE_IMMEDIATE;/* 0x40 */
9285       fis->h.features       = 0xD4;                      /* FIS features NA       */
9286       fis->d.lbaLow         = 0x01;                      /* FIS LBA (7 :0 ) */
9287       fis->d.lbaMid         = 0x4F;                      /* FIS LBA (15:8 ) */
9288       fis->d.lbaHigh        = 0xC2;                      /* FIS LBA (23:16) */
9289
9290       fis->d.lbaLowExp      = 0;
9291       fis->d.lbaMidExp      = 0;
9292       fis->d.lbaHighExp     = 0;
9293       fis->d.featuresExp    = 0;
9294       fis->d.sectorCount    = 0;                         /* FIS sector count (7:0) */
9295       fis->d.sectorCountExp = 0;
9296       fis->d.reserved4      = 0;
9297       fis->d.device         = 0;                         /* FIS DEV is discared in SATA */
9298       fis->d.control        = 0;                         /* FIS HOB bit clear */
9299       fis->d.reserved5      = 0;
9300
9301       agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9302
9303       /* Initialize CB for SATA completion.
9304        */
9305       satIOContext->satCompleteCB = &satSendDiagnosticCB;
9306
9307       /*
9308        * Prepare SGL and send FIS to LL layer.
9309        */
9310       satIOContext->reqType = agRequestType;       /* Save it */
9311
9312       status = sataLLIOStart( tiRoot,
9313                               tiIORequest,
9314                               tiDeviceHandle,
9315                               tiScsiRequest,
9316                               satIOContext);
9317
9318
9319       TI_DBG5(("satSendDiagnostic: return Table 28 case 1\n"));
9320       return (status);
9321     case 2:
9322       pSatDevData->satBGPendingDiag = agTRUE;
9323
9324       ostiInitiatorIOCompleted( tiRoot,
9325                                 tiIORequest,
9326                                 tiIOSuccess,
9327                                 SCSI_STAT_GOOD,
9328                                 agNULL,
9329                                 satIOContext->interruptContext );
9330
9331
9332       /* issuing SMART EXECUTE OFF-LINE IMMEDIATE */
9333       fis->h.fisType        = 0x27;                   /* Reg host to device */
9334       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9335       fis->h.command        = SAT_SMART_EXEUTE_OFF_LINE_IMMEDIATE;/* 0x40 */
9336       fis->h.features       = 0xD4;                      /* FIS features NA       */
9337       fis->d.lbaLow         = 0x02;                      /* FIS LBA (7 :0 ) */
9338       fis->d.lbaMid         = 0x4F;                      /* FIS LBA (15:8 ) */
9339       fis->d.lbaHigh        = 0xC2;                      /* FIS LBA (23:16) */
9340       fis->d.lbaLowExp      = 0;
9341       fis->d.lbaMidExp      = 0;
9342       fis->d.lbaHighExp     = 0;
9343       fis->d.featuresExp    = 0;
9344       fis->d.sectorCount    = 0;                         /* FIS sector count (7:0) */
9345       fis->d.sectorCountExp = 0;
9346       fis->d.reserved4      = 0;
9347       fis->d.device         = 0;                         /* FIS DEV is discared in SATA */
9348       fis->d.control        = 0;                         /* FIS HOB bit clear */
9349       fis->d.reserved5      = 0;
9350
9351       agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9352
9353       /* Initialize CB for SATA completion.
9354        */
9355       satIOContext->satCompleteCB = &satSendDiagnosticCB;
9356
9357       /*
9358        * Prepare SGL and send FIS to LL layer.
9359        */
9360       satIOContext->reqType = agRequestType;       /* Save it */
9361
9362       status = sataLLIOStart( tiRoot,
9363                               tiIORequest,
9364                               tiDeviceHandle,
9365                               tiScsiRequest,
9366                               satIOContext);
9367
9368
9369       TI_DBG5(("satSendDiagnostic: return Table 28 case 2\n"));
9370       return (status);
9371     case 4:
9372       /* For simplicity, no abort is supported
9373          Returns good status
9374          need a flag in device data for previously sent background Send Diagnostic
9375       */
9376       if (parmLen != 0)
9377       {
9378         /* check condition */
9379         satSetSensePayload( pSense,
9380                             SCSI_SNSKEY_ILLEGAL_REQUEST,
9381                             0,
9382                             SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
9383                             satIOContext);
9384
9385         ostiInitiatorIOCompleted( tiRoot,
9386                                   tiIORequest,
9387                                   tiIOSuccess,
9388                                   SCSI_STAT_CHECK_CONDITION,
9389                                   satIOContext->pTiSenseData,
9390                                   satIOContext->interruptContext );
9391
9392         TI_DBG1(("satSendDiagnostic: case 4, non zero ParmLen %d\n", parmLen));
9393         return tiSuccess;
9394       }
9395       if (pSatDevData->satBGPendingDiag == agTRUE)
9396       {
9397         /* sends SMART EXECUTE OFF-LINE IMMEDIATE abort */
9398         fis->h.fisType        = 0x27;                   /* Reg host to device */
9399         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9400         fis->h.command        = SAT_SMART_EXEUTE_OFF_LINE_IMMEDIATE;/* 0x40 */
9401         fis->h.features       = 0xD4;                      /* FIS features NA       */
9402         fis->d.lbaLow         = 0x7F;                      /* FIS LBA (7 :0 ) */
9403         fis->d.lbaMid         = 0x4F;                      /* FIS LBA (15:8 ) */
9404         fis->d.lbaHigh        = 0xC2;                      /* FIS LBA (23:16) */
9405
9406         fis->d.lbaLowExp      = 0;
9407         fis->d.lbaMidExp      = 0;
9408         fis->d.lbaHighExp     = 0;
9409         fis->d.featuresExp    = 0;
9410         fis->d.sectorCount    = 0;                         /* FIS sector count (7:0) */
9411         fis->d.sectorCountExp = 0;
9412         fis->d.reserved4      = 0;
9413         fis->d.device         = 0;                         /* FIS DEV is discared in SATA */
9414         fis->d.control        = 0;                         /* FIS HOB bit clear */
9415         fis->d.reserved5      = 0;
9416
9417         agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9418
9419         /* Initialize CB for SATA completion.
9420          */
9421         satIOContext->satCompleteCB = &satSendDiagnosticCB;
9422
9423         /*
9424          * Prepare SGL and send FIS to LL layer.
9425          */
9426         satIOContext->reqType = agRequestType;       /* Save it */
9427
9428         status = sataLLIOStart( tiRoot,
9429                                 tiIORequest,
9430                                 tiDeviceHandle,
9431                                 tiScsiRequest,
9432                                 satIOContext);
9433
9434
9435         TI_DBG5(("satSendDiagnostic: send SAT_SMART_EXEUTE_OFF_LINE_IMMEDIATE case 3\n"));
9436         TI_DBG5(("satSendDiagnostic: Table 28 case 4\n"));
9437         return (status);
9438       }
9439       else
9440       {
9441         /* check condition */
9442         satSetSensePayload( pSense,
9443                             SCSI_SNSKEY_ILLEGAL_REQUEST,
9444                             0,
9445                             SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
9446                             satIOContext);
9447
9448         ostiInitiatorIOCompleted( tiRoot,
9449                                   tiIORequest,
9450                                   tiIOSuccess,
9451                                   SCSI_STAT_CHECK_CONDITION,
9452                                   satIOContext->pTiSenseData,
9453                                   satIOContext->interruptContext );
9454
9455         TI_DBG1(("satSendDiagnostic: case 4, no pending diagnostic in background\n"));
9456         TI_DBG5(("satSendDiagnostic: Table 28 case 4\n"));
9457         return tiSuccess;
9458       }
9459       break;
9460     case 5:
9461       /* issuing SMART EXECUTE OFF-LINE IMMEDIATE */
9462       fis->h.fisType        = 0x27;                   /* Reg host to device */
9463       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9464       fis->h.command        = SAT_SMART_EXEUTE_OFF_LINE_IMMEDIATE;/* 0x40 */
9465       fis->h.features       = 0xD4;                      /* FIS features NA       */
9466       fis->d.lbaLow         = 0x81;                      /* FIS LBA (7 :0 ) */
9467       fis->d.lbaMid         = 0x4F;                      /* FIS LBA (15:8 ) */
9468       fis->d.lbaHigh        = 0xC2;                      /* FIS LBA (23:16) */
9469       fis->d.lbaLowExp      = 0;
9470       fis->d.lbaMidExp      = 0;
9471       fis->d.lbaHighExp     = 0;
9472       fis->d.featuresExp    = 0;
9473       fis->d.sectorCount    = 0;                         /* FIS sector count (7:0) */
9474       fis->d.sectorCountExp = 0;
9475       fis->d.reserved4      = 0;
9476       fis->d.device         = 0;                         /* FIS DEV is discared in SATA */
9477       fis->d.control        = 0;                         /* FIS HOB bit clear */
9478       fis->d.reserved5      = 0;
9479
9480       agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9481
9482       /* Initialize CB for SATA completion.
9483        */
9484       satIOContext->satCompleteCB = &satSendDiagnosticCB;
9485
9486       /*
9487        * Prepare SGL and send FIS to LL layer.
9488        */
9489       satIOContext->reqType = agRequestType;       /* Save it */
9490
9491       status = sataLLIOStart( tiRoot,
9492                               tiIORequest,
9493                               tiDeviceHandle,
9494                               tiScsiRequest,
9495                               satIOContext);
9496
9497
9498       TI_DBG5(("satSendDiagnostic: return Table 28 case 5\n"));
9499       return (status);
9500     case 6:
9501       /* issuing SMART EXECUTE OFF-LINE IMMEDIATE */
9502       fis->h.fisType        = 0x27;                   /* Reg host to device */
9503       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9504       fis->h.command        = SAT_SMART_EXEUTE_OFF_LINE_IMMEDIATE;/* 0x40 */
9505       fis->h.features       = 0xD4;                      /* FIS features NA       */
9506       fis->d.lbaLow         = 0x82;                      /* FIS LBA (7 :0 ) */
9507       fis->d.lbaMid         = 0x4F;                      /* FIS LBA (15:8 ) */
9508       fis->d.lbaHigh        = 0xC2;                      /* FIS LBA (23:16) */
9509       fis->d.lbaLowExp      = 0;
9510       fis->d.lbaMidExp      = 0;
9511       fis->d.lbaHighExp     = 0;
9512       fis->d.featuresExp    = 0;
9513       fis->d.sectorCount    = 0;                         /* FIS sector count (7:0) */
9514       fis->d.sectorCountExp = 0;
9515       fis->d.reserved4      = 0;
9516       fis->d.device         = 0;                         /* FIS DEV is discared in SATA */
9517       fis->d.control        = 0;                         /* FIS HOB bit clear */
9518       fis->d.reserved5      = 0;
9519
9520       agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9521
9522       /* Initialize CB for SATA completion.
9523        */
9524       satIOContext->satCompleteCB = &satSendDiagnosticCB;
9525
9526       /*
9527        * Prepare SGL and send FIS to LL layer.
9528        */
9529       satIOContext->reqType = agRequestType;       /* Save it */
9530
9531       status = sataLLIOStart( tiRoot,
9532                               tiIORequest,
9533                               tiDeviceHandle,
9534                               tiScsiRequest,
9535                               satIOContext);
9536
9537
9538       TI_DBG5(("satSendDiagnostic: return Table 28 case 6\n"));
9539       return (status);
9540     case 0:
9541     case 3: /* fall through */
9542     case 7: /* fall through */
9543     default:
9544       break;
9545     }/* switch */
9546
9547     /* returns the results of default self-testing, which is good */
9548     ostiInitiatorIOCompleted( tiRoot,
9549                               tiIORequest,
9550                               tiIOSuccess,
9551                               SCSI_STAT_GOOD,
9552                               agNULL,
9553                               satIOContext->interruptContext );
9554
9555     TI_DBG5(("satSendDiagnostic: return Table 28 case 0,3,7 and default\n"));
9556     return tiSuccess;
9557   }
9558
9559
9560   ostiInitiatorIOCompleted( tiRoot,
9561                             tiIORequest,
9562                             tiIOSuccess,
9563                             SCSI_STAT_GOOD,
9564                             agNULL,
9565                             satIOContext->interruptContext );
9566
9567
9568   TI_DBG5(("satSendDiagnostic: return last\n"));
9569   return tiSuccess;
9570 }
9571
9572 /*****************************************************************************/
9573 /*! \brief SAT implementation for SCSI satSendDiagnostic_1.
9574  *
9575  *  SAT implementation for SCSI satSendDiagnostic_1.
9576  *  Sub function of satSendDiagnostic.
9577  *
9578  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
9579  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
9580  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
9581  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
9582  *  \param   satIOContext_t:   Pointer to the SAT IO Context
9583  *
9584  *  \return If command is started successfully
9585  *    - \e tiSuccess:     I/O request successfully initiated.
9586  *    - \e tiBusy:        No resources available, try again later.
9587  *    - \e tiIONoDevice:  Invalid device handle.
9588  *    - \e tiError:       Other errors.
9589  */
9590 /*****************************************************************************/
9591 GLOBAL bit32  satSendDiagnostic_1(
9592                    tiRoot_t                  *tiRoot,
9593                    tiIORequest_t             *tiIORequest,
9594                    tiDeviceHandle_t          *tiDeviceHandle,
9595                    tiScsiInitiatorRequest_t *tiScsiRequest,
9596                    satIOContext_t            *satIOContext)
9597 {
9598   /*
9599     SAT Rev9, Table29, p41
9600     send 2nd SAT_READ_VERIFY_SECTORS(_EXT)
9601   */
9602   bit32                     status;
9603   bit32                     agRequestType;
9604   satDeviceData_t           *pSatDevData;
9605   agsaFisRegHostToDevice_t  *fis;
9606
9607   TI_DBG5(("satSendDiagnostic_1 entry: tiDeviceHandle=%p tiIORequest=%p\n",
9608       tiDeviceHandle, tiIORequest));
9609
9610   pSatDevData       = satIOContext->pSatDevData;
9611   fis               = satIOContext->pFis;
9612
9613   /*
9614     sector count 1, LBA MAX
9615   */
9616   if (pSatDevData->sat48BitSupport == agTRUE)
9617   {
9618     /* sends READ VERIFY SECTOR(S) EXT*/
9619     fis->h.fisType        = 0x27;                   /* Reg host to device */
9620     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9621     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
9622     fis->h.features       = 0;                      /* FIS reserve */
9623     fis->d.lbaLow         = pSatDevData->satMaxLBA[7]; /* FIS LBA (7 :0 ) */
9624     fis->d.lbaMid         = pSatDevData->satMaxLBA[6]; /* FIS LBA (15:8 ) */
9625     fis->d.lbaHigh        = pSatDevData->satMaxLBA[5]; /* FIS LBA (23:16) */
9626     fis->d.lbaLowExp      = pSatDevData->satMaxLBA[4]; /* FIS LBA (31:24) */
9627     fis->d.lbaMidExp      = pSatDevData->satMaxLBA[3]; /* FIS LBA (39:32) */
9628     fis->d.lbaHighExp     = pSatDevData->satMaxLBA[2]; /* FIS LBA (47:40) */
9629     fis->d.featuresExp    = 0;                      /* FIS reserve */
9630     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
9631     fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
9632     fis->d.reserved4      = 0;
9633     fis->d.device         = 0x40;                   /* 01000000 */
9634     fis->d.control        = 0;                      /* FIS HOB bit clear */
9635     fis->d.reserved5      = 0;
9636
9637   }
9638   else
9639   {
9640     /* READ VERIFY SECTOR(S)*/
9641     fis->h.fisType        = 0x27;                   /* Reg host to device */
9642     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9643     fis->h.command        = SAT_READ_VERIFY_SECTORS;/* 0x40 */
9644     fis->h.features       = 0;                      /* FIS features NA       */
9645     fis->d.lbaLow         = pSatDevData->satMaxLBA[7]; /* FIS LBA (7 :0 ) */
9646     fis->d.lbaMid         = pSatDevData->satMaxLBA[6]; /* FIS LBA (15:8 ) */
9647     fis->d.lbaHigh        = pSatDevData->satMaxLBA[5]; /* FIS LBA (23:16) */
9648     fis->d.lbaLowExp      = 0;
9649     fis->d.lbaMidExp      = 0;
9650     fis->d.lbaHighExp     = 0;
9651     fis->d.featuresExp    = 0;
9652     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
9653     fis->d.sectorCountExp = 0;
9654     fis->d.reserved4      = 0;
9655     fis->d.device         = (bit8)((0x4 << 4) | (pSatDevData->satMaxLBA[4] & 0xF));
9656                             /* DEV and LBA 27:24 */
9657     fis->d.control        = 0;                      /* FIS HOB bit clear */
9658     fis->d.reserved5      = 0;
9659
9660   }
9661
9662   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9663
9664   /* Initialize CB for SATA completion.
9665    */
9666   satIOContext->satCompleteCB = &satSendDiagnosticCB;
9667
9668   /*
9669    * Prepare SGL and send FIS to LL layer.
9670    */
9671   satIOContext->reqType = agRequestType;       /* Save it */
9672
9673   status = sataLLIOStart( tiRoot,
9674                           tiIORequest,
9675                           tiDeviceHandle,
9676                           tiScsiRequest,
9677                           satIOContext);
9678
9679
9680   return status;
9681 }
9682
9683 /*****************************************************************************/
9684 /*! \brief SAT implementation for SCSI satSendDiagnostic_2.
9685  *
9686  *  SAT implementation for SCSI satSendDiagnostic_2.
9687  *  Sub function of satSendDiagnostic.
9688  *
9689  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
9690  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
9691  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
9692  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
9693  *  \param   satIOContext_t:   Pointer to the SAT IO Context
9694  *
9695  *  \return If command is started successfully
9696  *    - \e tiSuccess:     I/O request successfully initiated.
9697  *    - \e tiBusy:        No resources available, try again later.
9698  *    - \e tiIONoDevice:  Invalid device handle.
9699  *    - \e tiError:       Other errors.
9700  */
9701 /*****************************************************************************/
9702 GLOBAL bit32  satSendDiagnostic_2(
9703                    tiRoot_t                  *tiRoot,
9704                    tiIORequest_t             *tiIORequest,
9705                    tiDeviceHandle_t          *tiDeviceHandle,
9706                    tiScsiInitiatorRequest_t *tiScsiRequest,
9707                    satIOContext_t            *satIOContext)
9708 {
9709   /*
9710     SAT Rev9, Table29, p41
9711     send 3rd SAT_READ_VERIFY_SECTORS(_EXT)
9712   */
9713   bit32                     status;
9714   bit32                     agRequestType;
9715   satDeviceData_t           *pSatDevData;
9716   agsaFisRegHostToDevice_t  *fis;
9717
9718   TI_DBG5(("satSendDiagnostic_2 entry: tiDeviceHandle=%p tiIORequest=%p\n",
9719       tiDeviceHandle, tiIORequest));
9720
9721   pSatDevData       = satIOContext->pSatDevData;
9722   fis               = satIOContext->pFis;
9723
9724   /*
9725     sector count 1, LBA Random
9726   */
9727   if (pSatDevData->sat48BitSupport == agTRUE)
9728   {
9729     /* sends READ VERIFY SECTOR(S) EXT*/
9730     fis->h.fisType        = 0x27;                   /* Reg host to device */
9731     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9732     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
9733     fis->h.features       = 0;                      /* FIS reserve */
9734     fis->d.lbaLow         = 0x7F;                   /* FIS LBA (7 :0 ) */
9735     fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
9736     fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
9737     fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
9738     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
9739     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
9740     fis->d.featuresExp    = 0;                      /* FIS reserve */
9741     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
9742     fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
9743     fis->d.reserved4      = 0;
9744     fis->d.device         = 0x40;                   /* 01000000 */
9745     fis->d.control        = 0;                      /* FIS HOB bit clear */
9746     fis->d.reserved5      = 0;
9747
9748   }
9749   else
9750   {
9751     /* READ VERIFY SECTOR(S)*/
9752     fis->h.fisType        = 0x27;                   /* Reg host to device */
9753     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9754     fis->h.command        = SAT_READ_VERIFY_SECTORS;/* 0x40 */
9755     fis->h.features       = 0;                      /* FIS features NA       */
9756     fis->d.lbaLow         = 0x7F;                   /* FIS LBA (7 :0 ) */
9757     fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
9758     fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
9759     fis->d.lbaLowExp      = 0;
9760     fis->d.lbaMidExp      = 0;
9761     fis->d.lbaHighExp     = 0;
9762     fis->d.featuresExp    = 0;
9763     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
9764     fis->d.sectorCountExp = 0;
9765     fis->d.reserved4      = 0;
9766     fis->d.device         = 0x40;                   /* FIS LBA mode set 01000000 */
9767     fis->d.control        = 0;                      /* FIS HOB bit clear */
9768     fis->d.reserved5      = 0;
9769
9770   }
9771
9772   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9773
9774   /* Initialize CB for SATA completion.
9775    */
9776   satIOContext->satCompleteCB = &satSendDiagnosticCB;
9777
9778   /*
9779    * Prepare SGL and send FIS to LL layer.
9780    */
9781   satIOContext->reqType = agRequestType;       /* Save it */
9782
9783   status = sataLLIOStart( tiRoot,
9784                           tiIORequest,
9785                           tiDeviceHandle,
9786                           tiScsiRequest,
9787                           satIOContext);
9788
9789
9790   return status;
9791 }
9792 /*****************************************************************************/
9793 /*! \brief SAT implementation for SCSI satStartStopUnit.
9794  *
9795  *  SAT implementation for SCSI satStartStopUnit.
9796  *
9797  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
9798  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
9799  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
9800  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
9801  *  \param   satIOContext_t:   Pointer to the SAT IO Context
9802  *
9803  *  \return If command is started successfully
9804  *    - \e tiSuccess:     I/O request successfully initiated.
9805  *    - \e tiBusy:        No resources available, try again later.
9806  *    - \e tiIONoDevice:  Invalid device handle.
9807  *    - \e tiError:       Other errors.
9808  */
9809 /*****************************************************************************/
9810 GLOBAL bit32  satStartStopUnit(
9811                    tiRoot_t                  *tiRoot,
9812                    tiIORequest_t             *tiIORequest,
9813                    tiDeviceHandle_t          *tiDeviceHandle,
9814                    tiScsiInitiatorRequest_t *tiScsiRequest,
9815                    satIOContext_t            *satIOContext)
9816 {
9817   bit32                     status;
9818   bit32                     agRequestType;
9819   satDeviceData_t           *pSatDevData;
9820   scsiRspSense_t            *pSense;
9821   tiIniScsiCmnd_t           *scsiCmnd;
9822   agsaFisRegHostToDevice_t  *fis;
9823
9824   pSense        = satIOContext->pSense;
9825   pSatDevData   = satIOContext->pSatDevData;
9826   scsiCmnd      = &tiScsiRequest->scsiCmnd;
9827   fis           = satIOContext->pFis;
9828
9829   TI_DBG5(("satStartStopUnit:start\n"));
9830
9831   /* checking CONTROL */
9832   /* NACA == 1 or LINK == 1*/
9833   if ( (scsiCmnd->cdb[5] & SCSI_NACA_MASK) || (scsiCmnd->cdb[5] & SCSI_LINK_MASK) )
9834   {
9835     satSetSensePayload( pSense,
9836                         SCSI_SNSKEY_ILLEGAL_REQUEST,
9837                         0,
9838                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
9839                         satIOContext);
9840
9841     ostiInitiatorIOCompleted( tiRoot,
9842                               tiIORequest,
9843                               tiIOSuccess,
9844                               SCSI_STAT_CHECK_CONDITION,
9845                               satIOContext->pTiSenseData,
9846                               satIOContext->interruptContext );
9847
9848     TI_DBG1(("satStartStopUnit: return control\n"));
9849     return tiSuccess;
9850   }
9851
9852   /* Spec p55, Table 48 checking START and LOEJ bit */
9853   /* case 1 */
9854   if ( !(scsiCmnd->cdb[4] & SCSI_START_MASK) && !(scsiCmnd->cdb[4] & SCSI_LOEJ_MASK) )
9855   {
9856     if ( (scsiCmnd->cdb[1] & SCSI_IMMED_MASK) )
9857     {
9858       /* immed bit , SAT rev 8, 9.11.2.1 p 54*/
9859       ostiInitiatorIOCompleted( tiRoot,
9860                                 tiIORequest,
9861                                 tiIOSuccess,
9862                                 SCSI_STAT_GOOD,
9863                                 agNULL,
9864                                 satIOContext->interruptContext );
9865       TI_DBG5(("satStartStopUnit: return table48 case 1-1\n"));
9866       return tiSuccess;
9867     }
9868     /* sends FLUSH CACHE or FLUSH CACHE EXT */
9869     if (pSatDevData->sat48BitSupport == agTRUE)
9870     {
9871       /* FLUSH CACHE EXT */
9872       fis->h.fisType        = 0x27;                   /* Reg host to device */
9873       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9874
9875       fis->h.command        = SAT_FLUSH_CACHE_EXT;    /* 0xEA */
9876       fis->h.features       = 0;                      /* FIS reserve */
9877       fis->d.featuresExp    = 0;                      /* FIS reserve */
9878       fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
9879       fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
9880       fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
9881       fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
9882       fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
9883       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
9884       fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
9885       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
9886       fis->d.device         = 0;                      /* FIS DEV is discared in SATA */
9887       fis->d.control        = 0;                      /* FIS HOB bit clear */
9888       fis->d.reserved4      = 0;
9889       fis->d.reserved5      = 0;
9890
9891       agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9892     }
9893     else
9894     {
9895       /* FLUSH CACHE */
9896       fis->h.fisType        = 0x27;                   /* Reg host to device */
9897       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9898
9899       fis->h.command        = SAT_FLUSH_CACHE;        /* 0xE7 */
9900       fis->h.features       = 0;                      /* FIS features NA       */
9901       fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
9902       fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
9903       fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
9904       fis->d.lbaLowExp      = 0;
9905       fis->d.lbaMidExp      = 0;
9906       fis->d.lbaHighExp     = 0;
9907       fis->d.featuresExp    = 0;
9908       fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
9909       fis->d.sectorCountExp = 0;
9910       fis->d.device         = 0;                      /* FIS DEV is discared in SATA */
9911       fis->d.control        = 0;                      /* FIS HOB bit clear */
9912       fis->d.reserved4      = 0;
9913       fis->d.reserved5      = 0;
9914
9915       agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
9916     }
9917
9918     /* Initialize CB for SATA completion.
9919      */
9920     satIOContext->satCompleteCB = &satStartStopUnitCB;
9921
9922     /*
9923      * Prepare SGL and send FIS to LL layer.
9924      */
9925     satIOContext->reqType = agRequestType;       /* Save it */
9926
9927     status = sataLLIOStart( tiRoot,
9928                             tiIORequest,
9929                             tiDeviceHandle,
9930                             tiScsiRequest,
9931                             satIOContext);
9932
9933
9934     TI_DBG5(("satStartStopUnit: return table48 case 1\n"));
9935     return (status);
9936   }
9937   /* case 2 */
9938   else if ( (scsiCmnd->cdb[4] & SCSI_START_MASK) && !(scsiCmnd->cdb[4] & SCSI_LOEJ_MASK) )
9939   {
9940     /* immed bit , SAT rev 8, 9.11.2.1 p 54*/
9941     if ( (scsiCmnd->cdb[1] & SCSI_IMMED_MASK) )
9942     {
9943       ostiInitiatorIOCompleted( tiRoot,
9944                                 tiIORequest,
9945                                 tiIOSuccess,
9946                                 SCSI_STAT_GOOD,
9947                                 agNULL,
9948                                 satIOContext->interruptContext );
9949
9950       TI_DBG5(("satStartStopUnit: return table48 case 2 1\n"));
9951       return tiSuccess;
9952     }
9953     /*
9954       sends READ_VERIFY_SECTORS(_EXT)
9955       sector count 1, any LBA between zero to Maximum
9956     */
9957     if (pSatDevData->sat48BitSupport == agTRUE)
9958     {
9959       /* READ VERIFY SECTOR(S) EXT*/
9960       fis->h.fisType        = 0x27;                   /* Reg host to device */
9961       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9962
9963       fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
9964       fis->h.features       = 0;                      /* FIS reserve */
9965       fis->d.lbaLow         = 0x01;                   /* FIS LBA (7 :0 ) */
9966       fis->d.lbaMid         = 0x00;                   /* FIS LBA (15:8 ) */
9967       fis->d.lbaHigh        = 0x00;                   /* FIS LBA (23:16) */
9968       fis->d.lbaLowExp      = 0x00;                   /* FIS LBA (31:24) */
9969       fis->d.lbaMidExp      = 0x00;                   /* FIS LBA (39:32) */
9970       fis->d.lbaHighExp     = 0x00;                   /* FIS LBA (47:40) */
9971       fis->d.featuresExp    = 0;                      /* FIS reserve */
9972       fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
9973       fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
9974       fis->d.reserved4      = 0;
9975       fis->d.device         = 0x40;                   /* 01000000 */
9976       fis->d.control        = 0;                      /* FIS HOB bit clear */
9977       fis->d.reserved5      = 0;
9978
9979     }
9980     else
9981     {
9982       /* READ VERIFY SECTOR(S)*/
9983       fis->h.fisType        = 0x27;                   /* Reg host to device */
9984       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
9985
9986       fis->h.command        = SAT_READ_VERIFY_SECTORS;/* 0x40 */
9987       fis->h.features       = 0;                      /* FIS features NA       */
9988       fis->d.lbaLow         = 0x01;                      /* FIS LBA (7 :0 ) */
9989       fis->d.lbaMid         = 0x00;                      /* FIS LBA (15:8 ) */
9990       fis->d.lbaHigh        = 0x00;                      /* FIS LBA (23:16) */
9991       fis->d.lbaLowExp      = 0;
9992       fis->d.lbaMidExp      = 0;
9993       fis->d.lbaHighExp     = 0;
9994       fis->d.featuresExp    = 0;
9995       fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
9996       fis->d.sectorCountExp = 0;
9997       fis->d.reserved4      = 0;
9998       fis->d.device         = 0x40;                   /* 01000000 */
9999       fis->d.control        = 0;                      /* FIS HOB bit clear */
10000       fis->d.reserved5      = 0;
10001
10002     }
10003
10004     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
10005
10006     /* Initialize CB for SATA completion.
10007      */
10008     satIOContext->satCompleteCB = &satStartStopUnitCB;
10009
10010     /*
10011      * Prepare SGL and send FIS to LL layer.
10012      */
10013     satIOContext->reqType = agRequestType;       /* Save it */
10014
10015     status = sataLLIOStart( tiRoot,
10016                             tiIORequest,
10017                             tiDeviceHandle,
10018                             tiScsiRequest,
10019                             satIOContext);
10020
10021     TI_DBG5(("satStartStopUnit: return table48 case 2 2\n"));
10022     return status;
10023   }
10024   /* case 3 */
10025   else if ( !(scsiCmnd->cdb[4] & SCSI_START_MASK) && (scsiCmnd->cdb[4] & SCSI_LOEJ_MASK) )
10026   {
10027     if(pSatDevData->satRemovableMedia && pSatDevData->satRemovableMediaEnabled)
10028     {
10029       /* support for removal media */
10030       /* immed bit , SAT rev 8, 9.11.2.1 p 54*/
10031       if ( (scsiCmnd->cdb[1] & SCSI_IMMED_MASK) )
10032       {
10033         ostiInitiatorIOCompleted( tiRoot,
10034                                   tiIORequest,
10035                                   tiIOSuccess,
10036                                   SCSI_STAT_GOOD,
10037                                   agNULL,
10038                                   satIOContext->interruptContext );
10039
10040         TI_DBG5(("satStartStopUnit: return table48 case 3 1\n"));
10041         return tiSuccess;
10042       }
10043       /*
10044         sends MEDIA EJECT
10045       */
10046       /* Media Eject fis */
10047       fis->h.fisType        = 0x27;                   /* Reg host to device */
10048       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
10049
10050       fis->h.command        = SAT_MEDIA_EJECT;        /* 0xED */
10051       fis->h.features       = 0;                      /* FIS features NA       */
10052       fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
10053       fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
10054       fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
10055       fis->d.lbaLowExp      = 0;
10056       fis->d.lbaMidExp      = 0;
10057       fis->d.lbaHighExp     = 0;
10058       fis->d.featuresExp    = 0;
10059       /* sector count zero */
10060       fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
10061       fis->d.sectorCountExp = 0;
10062       fis->d.device         = 0;                      /* FIS DEV is discared in SATA */
10063       fis->d.control        = 0;                      /* FIS HOB bit clear */
10064       fis->d.reserved4      = 0;
10065       fis->d.reserved5      = 0;
10066
10067       agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
10068
10069       /* Initialize CB for SATA completion.
10070        */
10071       satIOContext->satCompleteCB = &satStartStopUnitCB;
10072
10073       /*
10074        * Prepare SGL and send FIS to LL layer.
10075        */
10076       satIOContext->reqType = agRequestType;       /* Save it */
10077
10078       status = sataLLIOStart( tiRoot,
10079                               tiIORequest,
10080                               tiDeviceHandle,
10081                               tiScsiRequest,
10082                               satIOContext);
10083
10084       return status;
10085     }
10086     else
10087     {
10088       /* no support for removal media */
10089       satSetSensePayload( pSense,
10090                           SCSI_SNSKEY_ILLEGAL_REQUEST,
10091                           0,
10092                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10093                           satIOContext);
10094
10095       ostiInitiatorIOCompleted( tiRoot,
10096                                 tiIORequest,
10097                                 tiIOSuccess,
10098                                 SCSI_STAT_CHECK_CONDITION,
10099                                 satIOContext->pTiSenseData,
10100                                 satIOContext->interruptContext );
10101
10102       TI_DBG5(("satStartStopUnit: return Table 29 case 3 2\n"));
10103       return tiSuccess;
10104     }
10105
10106   }
10107   /* case 4 */
10108   else /* ( (scsiCmnd->cdb[4] & SCSI_START_MASK) && (scsiCmnd->cdb[4] & SCSI_LOEJ_MASK) ) */
10109   {
10110     satSetSensePayload( pSense,
10111                         SCSI_SNSKEY_ILLEGAL_REQUEST,
10112                         0,
10113                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10114                         satIOContext);
10115
10116     ostiInitiatorIOCompleted( tiRoot,
10117                               tiIORequest,
10118                               tiIOSuccess,
10119                               SCSI_STAT_CHECK_CONDITION,
10120                               satIOContext->pTiSenseData,
10121                               satIOContext->interruptContext );
10122
10123     TI_DBG5(("satStartStopUnit: return Table 29 case 4\n"));
10124     return tiSuccess;
10125   }
10126
10127
10128 }
10129
10130
10131 /*****************************************************************************/
10132 /*! \brief SAT implementation for SCSI satStartStopUnit_1.
10133  *
10134  *  SAT implementation for SCSI satStartStopUnit_1.
10135  *  Sub function of satStartStopUnit
10136  *
10137  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
10138  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
10139  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
10140  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
10141  *  \param   satIOContext_t:   Pointer to the SAT IO Context
10142  *
10143  *  \return If command is started successfully
10144  *    - \e tiSuccess:     I/O request successfully initiated.
10145  *    - \e tiBusy:        No resources available, try again later.
10146  *    - \e tiIONoDevice:  Invalid device handle.
10147  *    - \e tiError:       Other errors.
10148  */
10149 /*****************************************************************************/
10150 GLOBAL bit32  satStartStopUnit_1(
10151                    tiRoot_t                  *tiRoot,
10152                    tiIORequest_t             *tiIORequest,
10153                    tiDeviceHandle_t          *tiDeviceHandle,
10154                    tiScsiInitiatorRequest_t *tiScsiRequest,
10155                    satIOContext_t            *satIOContext)
10156 {
10157   /*
10158     SAT Rev 8, Table 48, 9.11.3 p55
10159     sends STANDBY
10160   */
10161   bit32                     status;
10162   bit32                     agRequestType;
10163   agsaFisRegHostToDevice_t  *fis;
10164
10165   TI_DBG5(("satStartStopUnit_1 entry: tiDeviceHandle=%p tiIORequest=%p\n",
10166       tiDeviceHandle, tiIORequest));
10167
10168   fis               = satIOContext->pFis;
10169
10170   /* STANDBY */
10171   fis->h.fisType        = 0x27;                   /* Reg host to device */
10172   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
10173
10174   fis->h.command        = SAT_STANDBY;            /* 0xE2 */
10175   fis->h.features       = 0;                      /* FIS features NA       */
10176   fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
10177   fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
10178   fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
10179   fis->d.lbaLowExp      = 0;
10180   fis->d.lbaMidExp      = 0;
10181   fis->d.lbaHighExp     = 0;
10182   fis->d.featuresExp    = 0;
10183   fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
10184   fis->d.sectorCountExp = 0;
10185   fis->d.reserved4      = 0;
10186   fis->d.device         = 0;                      /* 0 */
10187   fis->d.control        = 0;                      /* FIS HOB bit clear */
10188   fis->d.reserved5      = 0;
10189
10190   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
10191
10192   /* Initialize CB for SATA completion.
10193    */
10194   satIOContext->satCompleteCB = &satStartStopUnitCB;
10195
10196   /*
10197    * Prepare SGL and send FIS to LL layer.
10198    */
10199   satIOContext->reqType = agRequestType;       /* Save it */
10200
10201   status = sataLLIOStart( tiRoot,
10202                           tiIORequest,
10203                           tiDeviceHandle,
10204                           tiScsiRequest,
10205                           satIOContext);
10206
10207   TI_DBG5(("satStartStopUnit_1 return status %d\n", status));
10208   return status;
10209 }
10210
10211 /*****************************************************************************/
10212 /*! \brief SAT implementation for SCSI satRead10_2.
10213  *
10214  *  SAT implementation for SCSI satRead10_2
10215  *  Sub function of satRead10
10216  *
10217  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
10218  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
10219  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
10220  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
10221  *  \param   satIOContext_t:   Pointer to the SAT IO Context
10222  *
10223  *  \return If command is started successfully
10224  *    - \e tiSuccess:     I/O request successfully initiated.
10225  *    - \e tiBusy:        No resources available, try again later.
10226  *    - \e tiIONoDevice:  Invalid device handle.
10227  *    - \e tiError:       Other errors.
10228  */
10229 /*****************************************************************************/
10230 GLOBAL bit32  satRead10_2(
10231                           tiRoot_t                  *tiRoot,
10232                           tiIORequest_t             *tiIORequest,
10233                           tiDeviceHandle_t          *tiDeviceHandle,
10234                           tiScsiInitiatorRequest_t *tiScsiRequest,
10235                           satIOContext_t            *satIOContext)
10236 {
10237   /*
10238     externally generated ATA cmd, there is corresponding scsi cmnd
10239     called by satStartStopUnit() or maybe satRead10()
10240    */
10241
10242   bit32                     status;
10243   bit32                     agRequestType;
10244   satDeviceData_t           *pSatDevData;
10245   agsaFisRegHostToDevice_t  *fis;
10246
10247   pSatDevData   = satIOContext->pSatDevData;
10248   fis           = satIOContext->pFis;
10249
10250   TI_DBG5(("satReadVerifySectorsNoChain: start\n"));
10251
10252   /* specifying ReadVerifySectors has no chain */
10253   pSatDevData->satVerifyState = 0xFFFFFFFF;
10254
10255   if (pSatDevData->sat48BitSupport == agTRUE)
10256   {
10257     /* READ VERIFY SECTOR(S) EXT*/
10258     fis->h.fisType        = 0x27;                   /* Reg host to device */
10259     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
10260     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
10261     fis->h.features       = 0;                      /* FIS reserve */
10262     fis->d.lbaLow         = 0x7F;                   /* FIS LBA (7 :0 ) */
10263     fis->d.lbaMid         = 0x4F;                   /* FIS LBA (15:8 ) */
10264     fis->d.lbaHigh        = 0x00;                   /* FIS LBA (23:16) */
10265     fis->d.lbaLowExp      = 0xF1;                   /* FIS LBA (31:24) */
10266     fis->d.lbaMidExp      = 0x5F;                   /* FIS LBA (39:32) */
10267     fis->d.lbaHighExp     = 0xFF;                   /* FIS LBA (47:40) */
10268     fis->d.featuresExp    = 0;                      /* FIS reserve */
10269     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
10270     fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
10271     fis->d.reserved4      = 0;
10272     fis->d.device         = 0x4E;                   /* 01001110 */
10273     fis->d.control        = 0;                      /* FIS HOB bit clear */
10274     fis->d.reserved5      = 0;
10275
10276     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
10277   }
10278   else
10279   {
10280     /* READ VERIFY SECTOR(S)*/
10281     fis->h.fisType        = 0x27;                   /* Reg host to device */
10282     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
10283     fis->h.command        = SAT_READ_VERIFY_SECTORS;/* 0x40 */
10284     fis->h.features       = 0;                      /* FIS features NA       */
10285     fis->d.lbaLow         = 0x7F;                      /* FIS LBA (7 :0 ) */
10286     fis->d.lbaMid         = 0x4F;                      /* FIS LBA (15:8 ) */
10287     fis->d.lbaHigh        = 0x00;                      /* FIS LBA (23:16) */
10288     fis->d.lbaLowExp      = 0;
10289     fis->d.lbaMidExp      = 0;
10290     fis->d.lbaHighExp     = 0;
10291     fis->d.featuresExp    = 0;
10292     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
10293     fis->d.sectorCountExp = 0;
10294     fis->d.reserved4      = 0;
10295     fis->d.device         = 0x4E;                   /* 01001110 */
10296     fis->d.control        = 0;                      /* FIS HOB bit clear */
10297     fis->d.reserved5      = 0;
10298
10299     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
10300   }
10301
10302   /* Initialize CB for SATA completion.
10303    */
10304   satIOContext->satCompleteCB = &satNonDataIOCB;
10305
10306   /*
10307    * Prepare SGL and send FIS to LL layer.
10308    */
10309   satIOContext->reqType = agRequestType;       /* Save it */
10310
10311   status = sataLLIOStart( tiRoot,
10312                           tiIORequest,
10313                           tiDeviceHandle,
10314                           tiScsiRequest,
10315                           satIOContext);
10316
10317   TI_DBG5(("satReadVerifySectorsNoChain: return last\n"));
10318
10319   return status;
10320 }
10321
10322
10323 /*****************************************************************************/
10324 /*! \brief SAT implementation for SCSI satWriteSame10.
10325  *
10326  *  SAT implementation for SCSI satWriteSame10.
10327  *
10328  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
10329  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
10330  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
10331  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
10332  *  \param   satIOContext_t:   Pointer to the SAT IO Context
10333  *
10334  *  \return If command is started successfully
10335  *    - \e tiSuccess:     I/O request successfully initiated.
10336  *    - \e tiBusy:        No resources available, try again later.
10337  *    - \e tiIONoDevice:  Invalid device handle.
10338  *    - \e tiError:       Other errors.
10339  */
10340 /*****************************************************************************/
10341 GLOBAL bit32  satWriteSame10(
10342                    tiRoot_t                  *tiRoot,
10343                    tiIORequest_t             *tiIORequest,
10344                    tiDeviceHandle_t          *tiDeviceHandle,
10345                    tiScsiInitiatorRequest_t *tiScsiRequest,
10346                    satIOContext_t            *satIOContext)
10347 {
10348   bit32                     status;
10349   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
10350   satDeviceData_t           *pSatDevData;
10351   scsiRspSense_t            *pSense;
10352   tiIniScsiCmnd_t           *scsiCmnd;
10353   agsaFisRegHostToDevice_t  *fis;
10354   bit32                     lba = 0;
10355   bit32                     tl = 0;
10356
10357   pSense        = satIOContext->pSense;
10358   pSatDevData   = satIOContext->pSatDevData;
10359   scsiCmnd      = &tiScsiRequest->scsiCmnd;
10360   fis           = satIOContext->pFis;
10361
10362   TI_DBG5(("satWriteSame10: start\n"));
10363
10364   /* checking CONTROL */
10365     /* NACA == 1 or LINK == 1*/
10366   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
10367   {
10368     satSetSensePayload( pSense,
10369                         SCSI_SNSKEY_ILLEGAL_REQUEST,
10370                         0,
10371                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10372                         satIOContext);
10373
10374     ostiInitiatorIOCompleted( tiRoot,
10375                               tiIORequest,
10376                               tiIOSuccess,
10377                               SCSI_STAT_CHECK_CONDITION,
10378                               satIOContext->pTiSenseData,
10379                               satIOContext->interruptContext );
10380
10381     TI_DBG1(("satWriteSame10: return control\n"));
10382     return tiSuccess;
10383   }
10384
10385
10386   /* checking LBDATA and PBDATA */
10387   /* case 1 */
10388   if ( !(scsiCmnd->cdb[1] & SCSI_WRITE_SAME_LBDATA_MASK) &&
10389        !(scsiCmnd->cdb[1] & SCSI_WRITE_SAME_PBDATA_MASK))
10390   {
10391     TI_DBG5(("satWriteSame10: case 1\n"));
10392     /* spec 9.26.2, Table 62, p64, case 1*/
10393     /*
10394       normal case
10395       just like write in 9.17.1
10396     */
10397
10398     if ( pSatDevData->sat48BitSupport != agTRUE )
10399     {
10400       /*
10401         writeSame10 but no support for 48 bit addressing
10402         -> problem in transfer length. Therefore, return check condition
10403       */
10404       satSetSensePayload( pSense,
10405                           SCSI_SNSKEY_ILLEGAL_REQUEST,
10406                           0,
10407                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10408                           satIOContext);
10409
10410       ostiInitiatorIOCompleted( tiRoot,
10411                                 tiIORequest,
10412                                 tiIOSuccess,
10413                                 SCSI_STAT_CHECK_CONDITION,
10414                                 satIOContext->pTiSenseData,
10415                                 satIOContext->interruptContext );
10416
10417       TI_DBG1(("satWriteSame10: return internal checking\n"));
10418       return tiSuccess;
10419     }
10420
10421     /* cdb10; computing LBA and transfer length */
10422     lba = (scsiCmnd->cdb[2] << (8*3)) + (scsiCmnd->cdb[3] << (8*2))
10423       + (scsiCmnd->cdb[4] << 8) + scsiCmnd->cdb[5];
10424     tl = (scsiCmnd->cdb[7] << 8) + scsiCmnd->cdb[8];
10425
10426
10427     /* Table 34, 9.1, p 46 */
10428     /*
10429       note: As of 2/10/2006, no support for DMA QUEUED
10430     */
10431
10432     /*
10433       Table 34, 9.1, p 46, b (footnote)
10434       When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
10435       return check condition
10436     */
10437     if (pSatDevData->satNCQ != agTRUE &&
10438         pSatDevData->sat48BitSupport != agTRUE
10439           )
10440     {
10441       if (lba > SAT_TR_LBA_LIMIT - 1) /* SAT_TR_LBA_LIMIT is 2^28, 0x10000000 */
10442       {
10443         satSetSensePayload( pSense,
10444                             SCSI_SNSKEY_ILLEGAL_REQUEST,
10445                             0,
10446                             SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
10447                             satIOContext);
10448
10449         ostiInitiatorIOCompleted( tiRoot,
10450                                   tiIORequest,
10451                                   tiIOSuccess,
10452                                   SCSI_STAT_CHECK_CONDITION,
10453                                   satIOContext->pTiSenseData,
10454                                   satIOContext->interruptContext );
10455
10456         TI_DBG1(("satWriteSame10: return LBA out of range\n"));
10457           return tiSuccess;
10458       }
10459     }
10460
10461     if (lba + tl <= SAT_TR_LBA_LIMIT)
10462     {
10463       if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
10464       {
10465         /* case 2 */
10466         /* WRITE DMA */
10467         /* can't fit the transfer length since WRITE DMA has 1 byte for sector count */
10468         TI_DBG5(("satWriteSame10: case 1-2 !!! error due to writeSame10\n"));
10469         satSetSensePayload( pSense,
10470                             SCSI_SNSKEY_ILLEGAL_REQUEST,
10471                             0,
10472                             SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10473                             satIOContext);
10474
10475         ostiInitiatorIOCompleted( tiRoot,
10476                                   tiIORequest,
10477                                   tiIOSuccess,
10478                                   SCSI_STAT_CHECK_CONDITION,
10479                                   satIOContext->pTiSenseData,
10480                                   satIOContext->interruptContext );
10481         return tiSuccess;
10482       }
10483       else
10484       {
10485         /* case 1 */
10486         /* WRITE MULTIPLE or WRITE SECTOR(S) */
10487         /* WRITE SECTORS is chosen for easier implemetation */
10488         /* can't fit the transfer length since WRITE DMA has 1 byte for sector count */
10489         TI_DBG5(("satWriteSame10: case 1-1 !!! error due to writesame10\n"));
10490         satSetSensePayload( pSense,
10491                             SCSI_SNSKEY_ILLEGAL_REQUEST,
10492                             0,
10493                             SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10494                             satIOContext);
10495
10496         ostiInitiatorIOCompleted( tiRoot,
10497                                   tiIORequest,
10498                                   tiIOSuccess,
10499                                   SCSI_STAT_CHECK_CONDITION,
10500                                   satIOContext->pTiSenseData,
10501                                   satIOContext->interruptContext );
10502         return tiSuccess;
10503       }
10504     } /* end of case 1 and 2 */
10505
10506     /* case 3 and 4 */
10507     if (pSatDevData->sat48BitSupport == agTRUE)
10508     {
10509       if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
10510       {
10511         /* case 3 */
10512         /* WRITE DMA EXT or WRITE DMA FUA EXT */
10513         /* WRITE DMA EXT is chosen since WRITE SAME does not have FUA bit */
10514         TI_DBG5(("satWriteSame10: case 1-3\n"));
10515         fis->h.fisType        = 0x27;                   /* Reg host to device */
10516         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
10517
10518         fis->h.command        = SAT_WRITE_DMA_EXT;          /* 0x35 */
10519
10520         fis->h.features       = 0;                      /* FIS reserve */
10521         fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
10522         fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
10523         fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
10524         fis->d.device         = 0x40;                   /* FIS LBA mode set */
10525         fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
10526         fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
10527         fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
10528         fis->d.featuresExp    = 0;                      /* FIS reserve */
10529         if (tl == 0)
10530         {
10531           /* error check
10532              ATA spec, p125, 6.17.29
10533              pSatDevData->satMaxUserAddrSectors should be 0x0FFFFFFF
10534              and allowed value is 0x0FFFFFFF - 1
10535           */
10536           if (pSatDevData->satMaxUserAddrSectors > 0x0FFFFFFF)
10537           {
10538             TI_DBG5(("satWriteSame10: case 3 !!! warning can't fit sectors\n"));
10539             satSetSensePayload( pSense,
10540                                 SCSI_SNSKEY_ILLEGAL_REQUEST,
10541                                 0,
10542                                 SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10543                                 satIOContext);
10544
10545             ostiInitiatorIOCompleted( tiRoot,
10546                                       tiIORequest,
10547                                       tiIOSuccess,
10548                                       SCSI_STAT_CHECK_CONDITION,
10549                                       satIOContext->pTiSenseData,
10550                                       satIOContext->interruptContext );
10551             return tiSuccess;
10552           }
10553         }
10554         /* one sector at a time */
10555         fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
10556         fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
10557         fis->d.reserved4      = 0;
10558         fis->d.control        = 0;                      /* FIS HOB bit clear */
10559         fis->d.reserved5      = 0;
10560
10561         agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
10562       }
10563       else
10564       {
10565         /* case 4 */
10566         /* WRITE MULTIPLE EXT or WRITE MULTIPLE FUA EXT or WRITE SECTOR(S) EXT */
10567         /* WRITE SECTORS EXT is chosen for easier implemetation */
10568         TI_DBG5(("satWriteSame10: case 1-4\n"));
10569         fis->h.fisType        = 0x27;                   /* Reg host to device */
10570         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
10571
10572         fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
10573         fis->h.features       = 0;                      /* FIS reserve */
10574         fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
10575         fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
10576         fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
10577         fis->d.device         = 0x40;                   /* FIS LBA mode set */
10578         fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
10579         fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
10580         fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
10581         fis->d.featuresExp    = 0;                      /* FIS reserve */
10582         if (tl == 0)
10583         {
10584           /* error check
10585              ATA spec, p125, 6.17.29
10586              pSatDevData->satMaxUserAddrSectors should be 0x0FFFFFFF
10587              and allowed value is 0x0FFFFFFF - 1
10588           */
10589           if (pSatDevData->satMaxUserAddrSectors > 0x0FFFFFFF)
10590           {
10591             TI_DBG5(("satWriteSame10: case 4 !!! warning can't fit sectors\n"));
10592             satSetSensePayload( pSense,
10593                                 SCSI_SNSKEY_ILLEGAL_REQUEST,
10594                                 0,
10595                                 SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10596                                 satIOContext);
10597
10598             ostiInitiatorIOCompleted( tiRoot,
10599                                       tiIORequest,
10600                                       tiIOSuccess,
10601                                       SCSI_STAT_CHECK_CONDITION,
10602                                       satIOContext->pTiSenseData,
10603                                       satIOContext->interruptContext );
10604             return tiSuccess;
10605           }
10606         }
10607         /* one sector at a time */
10608         fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
10609         fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
10610         fis->d.reserved4      = 0;
10611         fis->d.control        = 0;                      /* FIS HOB bit clear */
10612         fis->d.reserved5      = 0;
10613
10614         agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
10615       }
10616     }
10617
10618     /* case 5 */
10619     if (pSatDevData->satNCQ == agTRUE)
10620     {
10621       /* WRITE FPDMA QUEUED */
10622       if (pSatDevData->sat48BitSupport != agTRUE)
10623       {
10624         TI_DBG5(("satWriteSame10: case 1-5 !!! error NCQ but 28 bit address support \n"));
10625         satSetSensePayload( pSense,
10626                             SCSI_SNSKEY_ILLEGAL_REQUEST,
10627                             0,
10628                             SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10629                             satIOContext);
10630
10631         ostiInitiatorIOCompleted( tiRoot,
10632                                   tiIORequest,
10633                                   tiIOSuccess,
10634                                   SCSI_STAT_CHECK_CONDITION,
10635                                   satIOContext->pTiSenseData,
10636                                   satIOContext->interruptContext );
10637         return tiSuccess;
10638       }
10639       TI_DBG5(("satWriteSame10: case 1-5\n"));
10640
10641       /* Support 48-bit FPDMA addressing, use WRITE FPDMA QUEUE command */
10642
10643       fis->h.fisType        = 0x27;                   /* Reg host to device */
10644       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
10645       fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
10646
10647       if (tl == 0)
10648       {
10649         /* error check
10650            ATA spec, p125, 6.17.29
10651            pSatDevData->satMaxUserAddrSectors should be 0x0FFFFFFF
10652            and allowed value is 0x0FFFFFFF - 1
10653         */
10654         if (pSatDevData->satMaxUserAddrSectors > 0x0FFFFFFF)
10655         {
10656           TI_DBG5(("satWriteSame10: case 4 !!! warning can't fit sectors\n"));
10657           satSetSensePayload( pSense,
10658                               SCSI_SNSKEY_ILLEGAL_REQUEST,
10659                               0,
10660                               SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10661                               satIOContext);
10662
10663           ostiInitiatorIOCompleted( tiRoot,
10664                                     tiIORequest,
10665                                     tiIOSuccess,
10666                                     SCSI_STAT_CHECK_CONDITION,
10667                                     satIOContext->pTiSenseData,
10668                                     satIOContext->interruptContext );
10669           return tiSuccess;
10670         }
10671       }
10672       /* one sector at a time */
10673       fis->h.features       = 1;            /* FIS sector count (7:0) */
10674       fis->d.featuresExp    = 0;            /* FIS sector count (15:8) */
10675
10676
10677       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
10678       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
10679       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
10680
10681       /* NO FUA bit in the WRITE SAME 10 */
10682       fis->d.device       = 0x40;                     /* FIS FUA clear */
10683
10684       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
10685       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
10686       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
10687       fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
10688       fis->d.sectorCountExp = 0;
10689       fis->d.reserved4      = 0;
10690       fis->d.control        = 0;                      /* FIS HOB bit clear */
10691       fis->d.reserved5      = 0;
10692
10693       agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
10694     }
10695     /* Initialize CB for SATA completion.
10696      */
10697     satIOContext->satCompleteCB = &satWriteSame10CB;
10698
10699     /*
10700      * Prepare SGL and send FIS to LL layer.
10701      */
10702     satIOContext->reqType = agRequestType;       /* Save it */
10703
10704     status = sataLLIOStart( tiRoot,
10705                             tiIORequest,
10706                             tiDeviceHandle,
10707                             tiScsiRequest,
10708                             satIOContext);
10709     return (status);
10710
10711
10712   } /* end of case 1 */
10713   else if ( !(scsiCmnd->cdb[1] & SCSI_WRITE_SAME_LBDATA_MASK) &&
10714              (scsiCmnd->cdb[1] & SCSI_WRITE_SAME_PBDATA_MASK))
10715   {
10716     /* spec 9.26.2, Table 62, p64, case 2*/
10717     satSetSensePayload( pSense,
10718                         SCSI_SNSKEY_ILLEGAL_REQUEST,
10719                         0,
10720                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10721                         satIOContext);
10722
10723     ostiInitiatorIOCompleted( tiRoot,
10724                               tiIORequest,
10725                               tiIOSuccess,
10726                               SCSI_STAT_CHECK_CONDITION,
10727                               satIOContext->pTiSenseData,
10728                               satIOContext->interruptContext );
10729
10730     TI_DBG5(("satWriteSame10: return Table 62 case 2\n"));
10731     return tiSuccess;
10732   }
10733   else if ( (scsiCmnd->cdb[1] & SCSI_WRITE_SAME_LBDATA_MASK) &&
10734            !(scsiCmnd->cdb[1] & SCSI_WRITE_SAME_PBDATA_MASK))
10735   {
10736     TI_DBG5(("satWriteSame10: Table 62 case 3\n"));
10737
10738   }
10739   else /* ( (scsiCmnd->cdb[1] & SCSI_WRITE_SAME_LBDATA_MASK) &&
10740             (scsiCmnd->cdb[1] & SCSI_WRITE_SAME_PBDATA_MASK)) */
10741   {
10742
10743     /* spec 9.26.2, Table 62, p64, case 4*/
10744     satSetSensePayload( pSense,
10745                         SCSI_SNSKEY_ILLEGAL_REQUEST,
10746                         0,
10747                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
10748                         satIOContext);
10749
10750     ostiInitiatorIOCompleted( tiRoot,
10751                               tiIORequest,
10752                               tiIOSuccess,
10753                               SCSI_STAT_CHECK_CONDITION,
10754                               satIOContext->pTiSenseData,
10755                               satIOContext->interruptContext );
10756
10757     TI_DBG5(("satWriteSame10: return Table 62 case 4\n"));
10758     return tiSuccess;
10759   }
10760
10761
10762   return tiSuccess;
10763 }
10764
10765 /*****************************************************************************/
10766 /*! \brief SAT implementation for SCSI satWriteSame10_1.
10767  *
10768  *  SAT implementation for SCSI WRITESANE10 and send FIS request to LL layer.
10769  *  This is used when WRITESAME10 is divided into multiple ATA commands
10770  *
10771  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
10772  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
10773  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
10774  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
10775  *  \param   satIOContext_t:   Pointer to the SAT IO Context
10776  *  \param   lba:              LBA
10777  *
10778  *  \return If command is started successfully
10779  *    - \e tiSuccess:     I/O request successfully initiated.
10780  *    - \e tiBusy:        No resources available, try again later.
10781  *    - \e tiIONoDevice:  Invalid device handle.
10782  *    - \e tiError:       Other errors.
10783  */
10784 /*****************************************************************************/
10785 GLOBAL bit32  satWriteSame10_1(
10786                    tiRoot_t                  *tiRoot,
10787                    tiIORequest_t             *tiIORequest,
10788                    tiDeviceHandle_t          *tiDeviceHandle,
10789                    tiScsiInitiatorRequest_t *tiScsiRequest,
10790                    satIOContext_t            *satIOContext,
10791                    bit32                     lba
10792                    )
10793 {
10794   /*
10795     sends SAT_WRITE_DMA_EXT
10796   */
10797
10798   bit32                     status;
10799   bit32                     agRequestType;
10800   agsaFisRegHostToDevice_t  *fis;
10801   bit8                      lba1, lba2 ,lba3, lba4;
10802
10803   TI_DBG5(("satWriteSame10_1 entry: tiDeviceHandle=%p tiIORequest=%p\n",
10804            tiDeviceHandle, tiIORequest));
10805
10806   fis               = satIOContext->pFis;
10807
10808   /* MSB */
10809   lba1 = (bit8)((lba & 0xFF000000) >> (8*3));
10810   lba2 = (bit8)((lba & 0x00FF0000) >> (8*2));
10811   lba3 = (bit8)((lba & 0x0000FF00) >> (8*1));
10812   /* LSB */
10813   lba4 = (bit8)(lba & 0x000000FF);
10814
10815   /* SAT_WRITE_DMA_EXT */
10816   fis->h.fisType        = 0x27;                   /* Reg host to device */
10817   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
10818
10819   fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x35 */
10820
10821   fis->h.features       = 0;                      /* FIS reserve */
10822   fis->d.lbaLow         = lba4;                   /* FIS LBA (7 :0 ) */
10823   fis->d.lbaMid         = lba3;                   /* FIS LBA (15:8 ) */
10824   fis->d.lbaHigh        = lba2;                   /* FIS LBA (23:16) */
10825   fis->d.device         = 0x40;                   /* FIS LBA mode set */
10826   fis->d.lbaLowExp      = lba1;                   /* FIS LBA (31:24) */
10827   fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
10828   fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
10829   fis->d.featuresExp    = 0;                      /* FIS reserve */
10830   /* one sector at a time */
10831   fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
10832   fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
10833
10834   fis->d.reserved4      = 0;
10835   fis->d.control        = 0;                      /* FIS HOB bit clear */
10836   fis->d.reserved5      = 0;
10837
10838
10839   agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
10840
10841   /* Initialize CB for SATA completion.
10842    */
10843   satIOContext->satCompleteCB = &satWriteSame10CB;
10844
10845   /*
10846    * Prepare SGL and send FIS to LL layer.
10847    */
10848   satIOContext->reqType = agRequestType;       /* Save it */
10849
10850   status = sataLLIOStart( tiRoot,
10851                           tiIORequest,
10852                           tiDeviceHandle,
10853                           tiScsiRequest,
10854                           satIOContext);
10855
10856   TI_DBG5(("satWriteSame10_1 return status %d\n", status));
10857   return status;
10858 }
10859
10860 /*****************************************************************************/
10861 /*! \brief SAT implementation for SCSI satWriteSame10_2.
10862  *
10863  *  SAT implementation for SCSI WRITESANE10 and send FIS request to LL layer.
10864  *  This is used when WRITESAME10 is divided into multiple ATA commands
10865  *
10866  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
10867  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
10868  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
10869  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
10870  *  \param   satIOContext_t:   Pointer to the SAT IO Context
10871  *  \param   lba:              LBA
10872  *
10873  *  \return If command is started successfully
10874  *    - \e tiSuccess:     I/O request successfully initiated.
10875  *    - \e tiBusy:        No resources available, try again later.
10876  *    - \e tiIONoDevice:  Invalid device handle.
10877  *    - \e tiError:       Other errors.
10878  */
10879 /*****************************************************************************/
10880 GLOBAL bit32  satWriteSame10_2(
10881                    tiRoot_t                  *tiRoot,
10882                    tiIORequest_t             *tiIORequest,
10883                    tiDeviceHandle_t          *tiDeviceHandle,
10884                    tiScsiInitiatorRequest_t *tiScsiRequest,
10885                    satIOContext_t            *satIOContext,
10886                    bit32                     lba
10887                    )
10888 {
10889   /*
10890     sends SAT_WRITE_SECTORS_EXT
10891   */
10892
10893   bit32                     status;
10894   bit32                     agRequestType;
10895   agsaFisRegHostToDevice_t  *fis;
10896   bit8                      lba1, lba2 ,lba3, lba4;
10897
10898   TI_DBG5(("satWriteSame10_2 entry: tiDeviceHandle=%p tiIORequest=%p\n",
10899            tiDeviceHandle, tiIORequest));
10900
10901   fis               = satIOContext->pFis;
10902
10903   /* MSB */
10904   lba1 = (bit8)((lba & 0xFF000000) >> (8*3));
10905   lba2 = (bit8)((lba & 0x00FF0000) >> (8*2));
10906   lba3 = (bit8)((lba & 0x0000FF00) >> (8*1));
10907   /* LSB */
10908   lba4 = (bit8)(lba & 0x000000FF);
10909
10910
10911   /* SAT_WRITE_SECTORS_EXT */
10912   fis->h.fisType        = 0x27;                   /* Reg host to device */
10913   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
10914
10915   fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
10916   fis->h.features       = 0;                      /* FIS reserve */
10917   fis->d.lbaLow         = lba4;                   /* FIS LBA (7 :0 ) */
10918   fis->d.lbaMid         = lba3;                   /* FIS LBA (15:8 ) */
10919   fis->d.lbaHigh        = lba2;                   /* FIS LBA (23:16) */
10920   fis->d.device         = 0x40;                   /* FIS LBA mode set */
10921   fis->d.lbaLowExp      = lba1;                   /* FIS LBA (31:24) */
10922   fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
10923   fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
10924   fis->d.featuresExp    = 0;                      /* FIS reserve */
10925   /* one sector at a time */
10926   fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
10927   fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
10928
10929   fis->d.reserved4      = 0;
10930   fis->d.control        = 0;                      /* FIS HOB bit clear */
10931   fis->d.reserved5      = 0;
10932
10933
10934   agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
10935
10936   /* Initialize CB for SATA completion.
10937    */
10938   satIOContext->satCompleteCB = &satWriteSame10CB;
10939
10940   /*
10941    * Prepare SGL and send FIS to LL layer.
10942    */
10943   satIOContext->reqType = agRequestType;       /* Save it */
10944
10945   status = sataLLIOStart( tiRoot,
10946                           tiIORequest,
10947                           tiDeviceHandle,
10948                           tiScsiRequest,
10949                           satIOContext);
10950
10951   TI_DBG5(("satWriteSame10_2 return status %d\n", status));
10952   return status;
10953 }
10954
10955 /*****************************************************************************/
10956 /*! \brief SAT implementation for SCSI satWriteSame10_3.
10957  *
10958  *  SAT implementation for SCSI WRITESANE10 and send FIS request to LL layer.
10959  *  This is used when WRITESAME10 is divided into multiple ATA commands
10960  *
10961  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
10962  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
10963  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
10964  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
10965  *  \param   satIOContext_t:   Pointer to the SAT IO Context
10966  *  \param   lba:              LBA
10967  *
10968  *  \return If command is started successfully
10969  *    - \e tiSuccess:     I/O request successfully initiated.
10970  *    - \e tiBusy:        No resources available, try again later.
10971  *    - \e tiIONoDevice:  Invalid device handle.
10972  *    - \e tiError:       Other errors.
10973  */
10974 /*****************************************************************************/
10975 GLOBAL bit32  satWriteSame10_3(
10976                    tiRoot_t                  *tiRoot,
10977                    tiIORequest_t             *tiIORequest,
10978                    tiDeviceHandle_t          *tiDeviceHandle,
10979                    tiScsiInitiatorRequest_t *tiScsiRequest,
10980                    satIOContext_t            *satIOContext,
10981                    bit32                     lba
10982                    )
10983 {
10984   /*
10985     sends SAT_WRITE_FPDMA_QUEUED
10986   */
10987
10988   bit32                     status;
10989   bit32                     agRequestType;
10990   agsaFisRegHostToDevice_t  *fis;
10991   bit8                      lba1, lba2 ,lba3, lba4;
10992
10993   TI_DBG5(("satWriteSame10_3 entry: tiDeviceHandle=%p tiIORequest=%p\n",
10994            tiDeviceHandle, tiIORequest));
10995
10996   fis               = satIOContext->pFis;
10997
10998   /* MSB */
10999   lba1 = (bit8)((lba & 0xFF000000) >> (8*3));
11000   lba2 = (bit8)((lba & 0x00FF0000) >> (8*2));
11001   lba3 = (bit8)((lba & 0x0000FF00) >> (8*1));
11002   /* LSB */
11003   lba4 = (bit8)(lba & 0x000000FF);
11004
11005   /* SAT_WRITE_FPDMA_QUEUED */
11006   fis->h.fisType        = 0x27;                   /* Reg host to device */
11007   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
11008   fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
11009
11010
11011   /* one sector at a time */
11012   fis->h.features       = 1;                      /* FIS sector count (7:0) */
11013   fis->d.featuresExp    = 0;                      /* FIS sector count (15:8) */
11014
11015
11016   fis->d.lbaLow         = lba4;                   /* FIS LBA (7 :0 ) */
11017   fis->d.lbaMid         = lba3;                   /* FIS LBA (15:8 ) */
11018   fis->d.lbaHigh        = lba2;                   /* FIS LBA (23:16) */
11019
11020   /* NO FUA bit in the WRITE SAME 10 */
11021   fis->d.device         = 0x40;                   /* FIS FUA clear */
11022
11023   fis->d.lbaLowExp      = lba1;                   /* FIS LBA (31:24) */
11024   fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
11025   fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
11026   fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
11027   fis->d.sectorCountExp = 0;
11028   fis->d.reserved4      = 0;
11029   fis->d.control        = 0;                      /* FIS HOB bit clear */
11030   fis->d.reserved5      = 0;
11031
11032   agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
11033
11034   /* Initialize CB for SATA completion.
11035    */
11036   satIOContext->satCompleteCB = &satWriteSame10CB;
11037
11038   /*
11039    * Prepare SGL and send FIS to LL layer.
11040    */
11041   satIOContext->reqType = agRequestType;       /* Save it */
11042
11043   status = sataLLIOStart( tiRoot,
11044                           tiIORequest,
11045                           tiDeviceHandle,
11046                           tiScsiRequest,
11047                           satIOContext);
11048
11049   TI_DBG5(("satWriteSame10_2 return status %d\n", status));
11050   return status;
11051 }
11052 /*****************************************************************************/
11053 /*! \brief SAT implementation for SCSI satWriteSame16.
11054  *
11055  *  SAT implementation for SCSI satWriteSame16.
11056  *
11057  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
11058  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
11059  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
11060  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
11061  *  \param   satIOContext_t:   Pointer to the SAT IO Context
11062  *
11063  *  \return If command is started successfully
11064  *    - \e tiSuccess:     I/O request successfully initiated.
11065  *    - \e tiBusy:        No resources available, try again later.
11066  *    - \e tiIONoDevice:  Invalid device handle.
11067  *    - \e tiError:       Other errors.
11068  */
11069 /*****************************************************************************/
11070 GLOBAL bit32  satWriteSame16(
11071                    tiRoot_t                  *tiRoot,
11072                    tiIORequest_t             *tiIORequest,
11073                    tiDeviceHandle_t          *tiDeviceHandle,
11074                    tiScsiInitiatorRequest_t *tiScsiRequest,
11075                    satIOContext_t            *satIOContext)
11076 {
11077   scsiRspSense_t            *pSense;
11078
11079   pSense        = satIOContext->pSense;
11080
11081   TI_DBG5(("satWriteSame16:start\n"));
11082
11083
11084   satSetSensePayload( pSense,
11085                       SCSI_SNSKEY_NO_SENSE,
11086                       0,
11087                       SCSI_SNSCODE_NO_ADDITIONAL_INFO,
11088                       satIOContext);
11089
11090   ostiInitiatorIOCompleted( tiRoot,
11091                             tiIORequest, /* == &satIntIo->satOrgTiIORequest */
11092                             tiIOSuccess,
11093                             SCSI_STAT_CHECK_CONDITION,
11094                             satIOContext->pTiSenseData,
11095                             satIOContext->interruptContext );
11096   TI_DBG5(("satWriteSame16: return internal checking\n"));
11097   return tiSuccess;
11098 }
11099
11100 /*****************************************************************************/
11101 /*! \brief SAT implementation for SCSI satLogSense_1.
11102  *
11103  *  Part of SAT implementation for SCSI satLogSense.
11104  *
11105  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
11106  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
11107  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
11108  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
11109  *  \param   satIOContext_t:   Pointer to the SAT IO Context
11110  *
11111  *  \return If command is started successfully
11112  *    - \e tiSuccess:     I/O request successfully initiated.
11113  *    - \e tiBusy:        No resources available, try again later.
11114  *    - \e tiIONoDevice:  Invalid device handle.
11115  *    - \e tiError:       Other errors.
11116  */
11117 /*****************************************************************************/
11118 GLOBAL bit32  satLogSense_1(
11119                    tiRoot_t                  *tiRoot,
11120                    tiIORequest_t             *tiIORequest,
11121                    tiDeviceHandle_t          *tiDeviceHandle,
11122                    tiScsiInitiatorRequest_t *tiScsiRequest,
11123                    satIOContext_t            *satIOContext)
11124 {
11125   bit32                     status;
11126   bit32                     agRequestType;
11127   satDeviceData_t           *pSatDevData;
11128   agsaFisRegHostToDevice_t  *fis;
11129
11130   pSatDevData   = satIOContext->pSatDevData;
11131   fis           = satIOContext->pFis;
11132
11133   TI_DBG5(("satLogSense_1: start\n"));
11134
11135
11136   /* SAT Rev 8, 10.2.4 p74 */
11137   if ( pSatDevData->sat48BitSupport == agTRUE )
11138   {
11139     TI_DBG5(("satLogSense_1: case 2-1 sends READ LOG EXT\n"));
11140     /* sends READ LOG EXT */
11141     fis->h.fisType        = 0x27;                   /* Reg host to device */
11142     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
11143
11144     fis->h.command        = SAT_READ_LOG_EXT;       /* 0x2F */
11145     fis->h.features       = 0;                      /* FIS reserve */
11146     fis->d.lbaLow         = 0x07;                   /* 0x07 */
11147     fis->d.lbaMid         = 0;                      /*  */
11148     fis->d.lbaHigh        = 0;                      /*  */
11149     fis->d.device         = 0;                      /*  */
11150     fis->d.lbaLowExp      = 0;                      /*  */
11151     fis->d.lbaMidExp      = 0;                      /*  */
11152     fis->d.lbaHighExp     = 0;                      /*  */
11153     fis->d.featuresExp    = 0;                      /* FIS reserve */
11154     fis->d.sectorCount    = 0x01;                     /* 1 sector counts */
11155     fis->d.sectorCountExp = 0x00;                      /* 1 sector counts */
11156     fis->d.reserved4      = 0;
11157     fis->d.control        = 0;                      /* FIS HOB bit clear */
11158     fis->d.reserved5      = 0;
11159
11160     agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
11161
11162     /* Initialize CB for SATA completion.
11163      */
11164     satIOContext->satCompleteCB = &satLogSenseCB;
11165
11166     /*
11167      * Prepare SGL and send FIS to LL layer.
11168      */
11169     satIOContext->reqType = agRequestType;       /* Save it */
11170
11171     status = sataLLIOStart( tiRoot,
11172                             tiIORequest,
11173                             tiDeviceHandle,
11174                             tiScsiRequest,
11175                             satIOContext);
11176     return status;
11177
11178   }
11179   else
11180   {
11181     TI_DBG5(("satLogSense_1: case 2-2 sends SMART READ LOG\n"));
11182     /* sends SMART READ LOG */
11183     fis->h.fisType        = 0x27;                   /* Reg host to device */
11184     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
11185
11186     fis->h.command        = SAT_SMART_READ_LOG;     /* 0x2F */
11187     fis->h.features       = 0x00;                   /* 0xd5 */
11188     fis->d.lbaLow         = 0x06;                   /* 0x06 */
11189     fis->d.lbaMid         = 0x00;                   /* 0x4f */
11190     fis->d.lbaHigh        = 0x00;                   /* 0xc2 */
11191     fis->d.device         = 0;                      /*  */
11192     fis->d.lbaLowExp      = 0;                      /*  */
11193     fis->d.lbaMidExp      = 0;                      /*  */
11194     fis->d.lbaHighExp     = 0;                      /*  */
11195     fis->d.featuresExp    = 0;                      /* FIS reserve */
11196     fis->d.sectorCount    = 0x01;                      /*  */
11197     fis->d.sectorCountExp = 0x00;                      /*  */
11198     fis->d.reserved4      = 0;
11199     fis->d.control        = 0;                      /* FIS HOB bit clear */
11200     fis->d.reserved5      = 0;
11201
11202     agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
11203
11204     /* Initialize CB for SATA completion.
11205      */
11206     satIOContext->satCompleteCB = &satLogSenseCB;
11207
11208     /*
11209      * Prepare SGL and send FIS to LL layer.
11210      */
11211     satIOContext->reqType = agRequestType;       /* Save it */
11212
11213     status = sataLLIOStart( tiRoot,
11214                             tiIORequest,
11215                             tiDeviceHandle,
11216                             tiScsiRequest,
11217                             satIOContext);
11218     return status;
11219
11220   }
11221 }
11222
11223 /*****************************************************************************/
11224 /*! \brief SAT implementation for SCSI satSMARTEnable.
11225  *
11226  *  Part of SAT implementation for SCSI satLogSense.
11227  *
11228  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
11229  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
11230  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
11231  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
11232  *  \param   satIOContext_t:   Pointer to the SAT IO Context
11233  *
11234  *  \return If command is started successfully
11235  *    - \e tiSuccess:     I/O request successfully initiated.
11236  *    - \e tiBusy:        No resources available, try again later.
11237  *    - \e tiIONoDevice:  Invalid device handle.
11238  *    - \e tiError:       Other errors.
11239  */
11240 /*****************************************************************************/
11241 GLOBAL bit32  satSMARTEnable(
11242                    tiRoot_t                  *tiRoot,
11243                    tiIORequest_t             *tiIORequest,
11244                    tiDeviceHandle_t          *tiDeviceHandle,
11245                    tiScsiInitiatorRequest_t *tiScsiRequest,
11246                    satIOContext_t            *satIOContext)
11247 {
11248   bit32                     status;
11249   bit32                     agRequestType;
11250   agsaFisRegHostToDevice_t  *fis;
11251
11252   TI_DBG4(("satSMARTEnable entry: tiDeviceHandle=%p tiIORequest=%p\n",
11253       tiDeviceHandle, tiIORequest));
11254
11255   fis               = satIOContext->pFis;
11256
11257   /*
11258    * Send the SAT_SMART_ENABLE_OPERATIONS command.
11259    */
11260   fis->h.fisType        = 0x27;                   /* Reg host to device */
11261   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
11262
11263   fis->h.command        = SAT_SMART_ENABLE_OPERATIONS;   /* 0xB0 */
11264   fis->h.features       = 0xD8;
11265   fis->d.lbaLow         = 0;
11266   fis->d.lbaMid         = 0x4F;
11267   fis->d.lbaHigh        = 0xC2;
11268   fis->d.device         = 0;
11269   fis->d.lbaLowExp      = 0;
11270   fis->d.lbaMidExp      = 0;
11271   fis->d.lbaHighExp     = 0;
11272   fis->d.featuresExp    = 0;
11273   fis->d.sectorCount    = 0;
11274   fis->d.sectorCountExp = 0;
11275   fis->d.reserved4      = 0;
11276   fis->d.control        = 0;                      /* FIS HOB bit clear */
11277   fis->d.reserved5      = 0;
11278
11279   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
11280
11281   /* Initialize CB for SATA completion.
11282    */
11283   satIOContext->satCompleteCB = &satSMARTEnableCB;
11284
11285   /*
11286    * Prepare SGL and send FIS to LL layer.
11287    */
11288   satIOContext->reqType = agRequestType;       /* Save it */
11289
11290   status = sataLLIOStart( tiRoot,
11291                           tiIORequest,
11292                           tiDeviceHandle,
11293                           tiScsiRequest,
11294                           satIOContext);
11295
11296
11297   return status;
11298 }
11299
11300 /*****************************************************************************/
11301 /*! \brief SAT implementation for SCSI satLogSense_3.
11302  *
11303  *  Part of SAT implementation for SCSI satLogSense.
11304  *
11305  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
11306  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
11307  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
11308  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
11309  *  \param   satIOContext_t:   Pointer to the SAT IO Context
11310  *
11311  *  \return If command is started successfully
11312  *    - \e tiSuccess:     I/O request successfully initiated.
11313  *    - \e tiBusy:        No resources available, try again later.
11314  *    - \e tiIONoDevice:  Invalid device handle.
11315  *    - \e tiError:       Other errors.
11316  */
11317 /*****************************************************************************/
11318 GLOBAL bit32  satLogSense_3(
11319                    tiRoot_t                  *tiRoot,
11320                    tiIORequest_t             *tiIORequest,
11321                    tiDeviceHandle_t          *tiDeviceHandle,
11322                    tiScsiInitiatorRequest_t *tiScsiRequest,
11323                    satIOContext_t            *satIOContext)
11324 {
11325   bit32                     status;
11326   bit32                     agRequestType;
11327   agsaFisRegHostToDevice_t  *fis;
11328
11329   TI_DBG4(("satLogSense_3 entry: tiDeviceHandle=%p tiIORequest=%p\n",
11330       tiDeviceHandle, tiIORequest));
11331
11332   fis               = satIOContext->pFis;
11333   /* sends READ LOG EXT */
11334   fis->h.fisType        = 0x27;                   /* Reg host to device */
11335   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
11336
11337   fis->h.command        = SAT_SMART_READ_LOG;     /* 0x2F */
11338   fis->h.features       = 0xD5;                   /* 0xd5 */
11339   fis->d.lbaLow         = 0x06;                   /* 0x06 */
11340   fis->d.lbaMid         = 0x4F;                   /* 0x4f */
11341   fis->d.lbaHigh        = 0xC2;                   /* 0xc2 */
11342   fis->d.device         = 0;                      /*  */
11343   fis->d.lbaLowExp      = 0;                      /*  */
11344   fis->d.lbaMidExp      = 0;                      /*  */
11345   fis->d.lbaHighExp     = 0;                      /*  */
11346   fis->d.featuresExp    = 0;                      /* FIS reserve */
11347   fis->d.sectorCount    = 0x01;                     /* 1 sector counts */
11348   fis->d.sectorCountExp = 0x00;                      /* 1 sector counts */
11349   fis->d.reserved4      = 0;
11350   fis->d.control        = 0;                      /* FIS HOB bit clear */
11351   fis->d.reserved5      = 0;
11352
11353   agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
11354
11355   /* Initialize CB for SATA completion.
11356    */
11357   satIOContext->satCompleteCB = &satLogSenseCB;
11358
11359   /*
11360    * Prepare SGL and send FIS to LL layer.
11361    */
11362   satIOContext->reqType = agRequestType;       /* Save it */
11363
11364   status = sataLLIOStart( tiRoot,
11365                           tiIORequest,
11366                           tiDeviceHandle,
11367                           tiScsiRequest,
11368                           satIOContext);
11369   return status;
11370 }
11371
11372 /*****************************************************************************/
11373 /*! \brief SAT implementation for SCSI satLogSense_2.
11374  *
11375  *  Part of SAT implementation for SCSI satLogSense.
11376  *
11377  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
11378  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
11379  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
11380  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
11381  *  \param   satIOContext_t:   Pointer to the SAT IO Context
11382  *
11383  *  \return If command is started successfully
11384  *    - \e tiSuccess:     I/O request successfully initiated.
11385  *    - \e tiBusy:        No resources available, try again later.
11386  *    - \e tiIONoDevice:  Invalid device handle.
11387  *    - \e tiError:       Other errors.
11388  */
11389 /*****************************************************************************/
11390 GLOBAL bit32  satLogSense_2(
11391                    tiRoot_t                  *tiRoot,
11392                    tiIORequest_t             *tiIORequest,
11393                    tiDeviceHandle_t          *tiDeviceHandle,
11394                    tiScsiInitiatorRequest_t *tiScsiRequest,
11395                    satIOContext_t            *satIOContext)
11396 {
11397   bit32                     status;
11398   bit32                     agRequestType;
11399   agsaFisRegHostToDevice_t  *fis;
11400
11401   TI_DBG4(("satLogSense_2 entry: tiDeviceHandle=%p tiIORequest=%p\n",
11402       tiDeviceHandle, tiIORequest));
11403
11404   fis               = satIOContext->pFis;
11405   /* sends READ LOG EXT */
11406   fis->h.fisType        = 0x27;                   /* Reg host to device */
11407   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
11408
11409   fis->h.command        = SAT_READ_LOG_EXT;       /* 0x2F */
11410   fis->h.features       = 0;                      /* FIS reserve */
11411   fis->d.lbaLow         = 0x07;                   /* 0x07 */
11412   fis->d.lbaMid         = 0;                      /*  */
11413   fis->d.lbaHigh        = 0;                      /*  */
11414   fis->d.device         = 0;                      /*  */
11415   fis->d.lbaLowExp      = 0;                      /*  */
11416   fis->d.lbaMidExp      = 0;                      /*  */
11417   fis->d.lbaHighExp     = 0;                      /*  */
11418   fis->d.featuresExp    = 0;                      /* FIS reserve */
11419   fis->d.sectorCount    = 0x01;                     /* 1 sector counts */
11420   fis->d.sectorCountExp = 0x00;                      /* 1 sector counts */
11421   fis->d.reserved4      = 0;
11422   fis->d.control        = 0;                      /* FIS HOB bit clear */
11423   fis->d.reserved5      = 0;
11424
11425   agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
11426
11427   /* Initialize CB for SATA completion.
11428    */
11429   satIOContext->satCompleteCB = &satLogSenseCB;
11430
11431   /*
11432    * Prepare SGL and send FIS to LL layer.
11433    */
11434   satIOContext->reqType = agRequestType;       /* Save it */
11435
11436   status = sataLLIOStart( tiRoot,
11437                           tiIORequest,
11438                           tiDeviceHandle,
11439                           tiScsiRequest,
11440                           satIOContext);
11441   return status;
11442 }
11443
11444 /*****************************************************************************/
11445 /*! \brief SAT implementation for SCSI satLogSenseAllocate.
11446  *
11447  *  Part of SAT implementation for SCSI satLogSense.
11448  *
11449  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
11450  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
11451  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
11452  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
11453  *  \param   satIOContext_t:   Pointer to the SAT IO Context
11454  *  \param   payloadSize:      size of payload to be allocated.
11455  *  \param   flag:             flag value
11456  *
11457  *  \return If command is started successfully
11458  *    - \e tiSuccess:     I/O request successfully initiated.
11459  *    - \e tiBusy:        No resources available, try again later.
11460  *    - \e tiIONoDevice:  Invalid device handle.
11461  *    - \e tiError:       Other errors.
11462  *  \note
11463  *    - flag values: LOG_SENSE_0, LOG_SENSE_1, LOG_SENSE_2
11464  */
11465 /*****************************************************************************/
11466 GLOBAL bit32  satLogSenseAllocate(
11467                    tiRoot_t                  *tiRoot,
11468                    tiIORequest_t             *tiIORequest,
11469                    tiDeviceHandle_t          *tiDeviceHandle,
11470                    tiScsiInitiatorRequest_t *tiScsiRequest,
11471                    satIOContext_t            *satIOContext,
11472                    bit32                      payloadSize,
11473                    bit32                      flag
11474                    )
11475 {
11476   satDeviceData_t           *pSatDevData;
11477   tdIORequestBody_t         *tdIORequestBody;
11478   satInternalIo_t           *satIntIo = agNULL;
11479   satIOContext_t            *satIOContext2;
11480   bit32                     status;
11481
11482   TI_DBG4(("satLogSense_2 entry: tiDeviceHandle=%p tiIORequest=%p\n",
11483       tiDeviceHandle, tiIORequest));
11484
11485   pSatDevData       = satIOContext->pSatDevData;
11486
11487   /* create internal satIOContext */
11488   satIntIo = satAllocIntIoResource( tiRoot,
11489                                     tiIORequest, /* original request */
11490                                     pSatDevData,
11491                                     payloadSize,
11492                                     satIntIo);
11493
11494   if (satIntIo == agNULL)
11495   {
11496     /* memory allocation failure */
11497     satFreeIntIoResource( tiRoot,
11498                           pSatDevData,
11499                           satIntIo);
11500
11501     ostiInitiatorIOCompleted( tiRoot,
11502                               tiIORequest,
11503                               tiIOFailed,
11504                               tiDetailOtherError,
11505                               agNULL,
11506                               satIOContext->interruptContext );
11507
11508     TI_DBG4(("satLogSense_2: fail in allocation\n"));
11509     return tiSuccess;
11510   } /* end of memory allocation failure */
11511
11512   satIntIo->satOrgTiIORequest = tiIORequest;
11513   tdIORequestBody = (tdIORequestBody_t *)satIntIo->satIntRequestBody;
11514   satIOContext2 = &(tdIORequestBody->transport.SATA.satIOContext);
11515
11516   satIOContext2->pSatDevData   = pSatDevData;
11517   satIOContext2->pFis          = &(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev);
11518   satIOContext2->pScsiCmnd     = &(satIntIo->satIntTiScsiXchg.scsiCmnd);
11519   satIOContext2->pSense        = &(tdIORequestBody->transport.SATA.sensePayload);
11520   satIOContext2->pTiSenseData  = &(tdIORequestBody->transport.SATA.tiSenseData);
11521   satIOContext2->pTiSenseData->senseData = satIOContext2->pSense;
11522   satIOContext2->tiRequestBody = satIntIo->satIntRequestBody;
11523   satIOContext2->interruptContext = satIOContext->interruptContext;
11524   satIOContext2->satIntIoContext  = satIntIo;
11525   satIOContext2->ptiDeviceHandle = tiDeviceHandle;
11526   satIOContext2->satOrgIOContext = satIOContext;
11527
11528   if (flag == LOG_SENSE_0)
11529   {
11530     /* SAT_SMART_ENABLE_OPERATIONS */
11531     status = satSMARTEnable( tiRoot,
11532                          &(satIntIo->satIntTiIORequest),
11533                          tiDeviceHandle,
11534                          &(satIntIo->satIntTiScsiXchg),
11535                          satIOContext2);
11536   }
11537   else if (flag == LOG_SENSE_1)
11538   {
11539     /* SAT_READ_LOG_EXT */
11540     status = satLogSense_2( tiRoot,
11541                          &(satIntIo->satIntTiIORequest),
11542                          tiDeviceHandle,
11543                          &(satIntIo->satIntTiScsiXchg),
11544                          satIOContext2);
11545   }
11546   else
11547   {
11548     /* SAT_SMART_READ_LOG */
11549     /* SAT_READ_LOG_EXT */
11550     status = satLogSense_3( tiRoot,
11551                          &(satIntIo->satIntTiIORequest),
11552                          tiDeviceHandle,
11553                          &(satIntIo->satIntTiScsiXchg),
11554                          satIOContext2);
11555
11556   }
11557   if (status != tiSuccess)
11558   {
11559     satFreeIntIoResource( tiRoot,
11560                           pSatDevData,
11561                           satIntIo);
11562
11563     ostiInitiatorIOCompleted( tiRoot,
11564                               tiIORequest,
11565                               tiIOFailed,
11566                               tiDetailOtherError,
11567                               agNULL,
11568                               satIOContext->interruptContext );
11569     return tiSuccess;
11570   }
11571
11572
11573   return tiSuccess;
11574 }
11575
11576
11577 /*****************************************************************************/
11578 /*! \brief SAT implementation for SCSI satLogSense.
11579  *
11580  *  SAT implementation for SCSI satLogSense.
11581  *
11582  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
11583  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
11584  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
11585  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
11586  *  \param   satIOContext_t:   Pointer to the SAT IO Context
11587  *
11588  *  \return If command is started successfully
11589  *    - \e tiSuccess:     I/O request successfully initiated.
11590  *    - \e tiBusy:        No resources available, try again later.
11591  *    - \e tiIONoDevice:  Invalid device handle.
11592  *    - \e tiError:       Other errors.
11593  */
11594 /*****************************************************************************/
11595 GLOBAL bit32  satLogSense(
11596                    tiRoot_t                  *tiRoot,
11597                    tiIORequest_t             *tiIORequest,
11598                    tiDeviceHandle_t          *tiDeviceHandle,
11599                    tiScsiInitiatorRequest_t *tiScsiRequest,
11600                    satIOContext_t            *satIOContext)
11601 {
11602   bit32                     status;
11603   bit32                     agRequestType;
11604   satDeviceData_t           *pSatDevData;
11605   scsiRspSense_t            *pSense;
11606   tiIniScsiCmnd_t           *scsiCmnd;
11607   agsaFisRegHostToDevice_t  *fis;
11608   bit8                      *pLogPage;    /* Log Page data buffer */
11609   bit32                     flag = 0;
11610   bit16                     AllocLen = 0;       /* allocation length */
11611   bit8                      AllLogPages[8];
11612   bit16                     lenRead = 0;
11613
11614   pSense        = satIOContext->pSense;
11615   pSatDevData   = satIOContext->pSatDevData;
11616   scsiCmnd      = &tiScsiRequest->scsiCmnd;
11617   fis           = satIOContext->pFis;
11618   pLogPage      = (bit8 *) tiScsiRequest->sglVirtualAddr;
11619
11620   TI_DBG5(("satLogSense: start\n"));
11621
11622   osti_memset(&AllLogPages, 0, 8);
11623   /* checking CONTROL */
11624   /* NACA == 1 or LINK == 1*/
11625   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
11626   {
11627     satSetSensePayload( pSense,
11628                         SCSI_SNSKEY_ILLEGAL_REQUEST,
11629                         0,
11630                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
11631                         satIOContext);
11632
11633     ostiInitiatorIOCompleted( tiRoot,
11634                               tiIORequest,
11635                               tiIOSuccess,
11636                               SCSI_STAT_CHECK_CONDITION,
11637                               satIOContext->pTiSenseData,
11638                               satIOContext->interruptContext );
11639
11640     TI_DBG2(("satLogSense: return control\n"));
11641     return tiSuccess;
11642   }
11643
11644
11645   AllocLen = (bit8)((scsiCmnd->cdb[7] << 8) + scsiCmnd->cdb[8]);
11646
11647   /* checking PC (Page Control) */
11648   /* nothing */
11649
11650   /* special cases */
11651   if (AllocLen == 4)
11652   {
11653     TI_DBG1(("satLogSense: AllocLen is 4\n"));
11654     switch (scsiCmnd->cdb[2] & SCSI_LOG_SENSE_PAGE_CODE_MASK)
11655     {
11656       case LOGSENSE_SUPPORTED_LOG_PAGES:
11657         TI_DBG5(("satLogSense: case LOGSENSE_SUPPORTED_LOG_PAGES\n"));
11658
11659         /* SAT Rev 8, 10.2.5 p76 */
11660         if (pSatDevData->satSMARTFeatureSet == agTRUE)
11661         {
11662           /* add informational exception log */
11663           flag = 1;
11664           if (pSatDevData->satSMARTSelfTest == agTRUE)
11665           {
11666             /* add Self-Test results log page */
11667             flag = 2;
11668           }
11669         }
11670         else
11671         {
11672           /* only supported, no informational exception log, no  Self-Test results log page */
11673           flag = 0;
11674         }
11675         lenRead = 4;
11676         AllLogPages[0] = LOGSENSE_SUPPORTED_LOG_PAGES;          /* page code */
11677         AllLogPages[1] = 0;          /* reserved  */
11678         switch (flag)
11679         {
11680           case 0:
11681             /* only supported */
11682             AllLogPages[2] = 0;          /* page length */
11683             AllLogPages[3] = 1;          /* page length */
11684             break;
11685           case 1:
11686             /* supported and informational exception log */
11687             AllLogPages[2] = 0;          /* page length */
11688             AllLogPages[3] = 2;          /* page length */
11689             break;
11690           case 2:
11691             /* supported and informational exception log */
11692             AllLogPages[2] = 0;          /* page length */
11693             AllLogPages[3] = 3;          /* page length */
11694             break;
11695           default:
11696             TI_DBG1(("satLogSense: error unallowed flag value %d\n", flag));
11697             break;
11698         }
11699         osti_memcpy(pLogPage, &AllLogPages, lenRead);
11700         break;
11701       case LOGSENSE_SELFTEST_RESULTS_PAGE:
11702         TI_DBG5(("satLogSense: case LOGSENSE_SUPPORTED_LOG_PAGES\n"));
11703         lenRead = 4;
11704         AllLogPages[0] = LOGSENSE_SELFTEST_RESULTS_PAGE;          /* page code */
11705         AllLogPages[1] = 0;          /* reserved  */
11706         /* page length = SELFTEST_RESULTS_LOG_PAGE_LENGTH - 1 - 3 = 400 = 0x190 */
11707         AllLogPages[2] = 0x01;
11708         AllLogPages[3] = 0x90;       /* page length */
11709         osti_memcpy(pLogPage, &AllLogPages, lenRead);
11710
11711         break;
11712       case LOGSENSE_INFORMATION_EXCEPTIONS_PAGE:
11713         TI_DBG5(("satLogSense: case LOGSENSE_SUPPORTED_LOG_PAGES\n"));
11714         lenRead = 4;
11715         AllLogPages[0] = LOGSENSE_INFORMATION_EXCEPTIONS_PAGE;          /* page code */
11716         AllLogPages[1] = 0;          /* reserved  */
11717         AllLogPages[2] = 0;          /* page length */
11718         AllLogPages[3] = INFORMATION_EXCEPTIONS_LOG_PAGE_LENGTH - 1 - 3;       /* page length */
11719         osti_memcpy(pLogPage, &AllLogPages, lenRead);
11720         break;
11721       default:
11722         TI_DBG1(("satLogSense: default Page Code 0x%x\n", scsiCmnd->cdb[2] & SCSI_LOG_SENSE_PAGE_CODE_MASK));
11723         satSetSensePayload( pSense,
11724                             SCSI_SNSKEY_ILLEGAL_REQUEST,
11725                             0,
11726                             SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
11727                             satIOContext);
11728
11729         ostiInitiatorIOCompleted( tiRoot,
11730                                   tiIORequest,
11731                                   tiIOSuccess,
11732                                   SCSI_STAT_CHECK_CONDITION,
11733                                   satIOContext->pTiSenseData,
11734                                   satIOContext->interruptContext );
11735         return tiSuccess;
11736     }
11737     ostiInitiatorIOCompleted( tiRoot,
11738                                 tiIORequest,
11739                                 tiIOSuccess,
11740                                 SCSI_STAT_GOOD,
11741                                 agNULL,
11742                                 satIOContext->interruptContext);
11743     return tiSuccess;
11744
11745   } /* if */
11746
11747   /* SAT rev8 Table 11  p30*/
11748   /* checking Page Code */
11749   switch (scsiCmnd->cdb[2] & SCSI_LOG_SENSE_PAGE_CODE_MASK)
11750   {
11751     case LOGSENSE_SUPPORTED_LOG_PAGES:
11752       TI_DBG5(("satLogSense: case 1\n"));
11753
11754       /* SAT Rev 8, 10.2.5 p76 */
11755
11756       if (pSatDevData->satSMARTFeatureSet == agTRUE)
11757       {
11758         /* add informational exception log */
11759         flag = 1;
11760         if (pSatDevData->satSMARTSelfTest == agTRUE)
11761         {
11762           /* add Self-Test results log page */
11763           flag = 2;
11764         }
11765       }
11766       else
11767       {
11768         /* only supported, no informational exception log, no  Self-Test results log page */
11769         flag = 0;
11770       }
11771       AllLogPages[0] = 0;          /* page code */
11772       AllLogPages[1] = 0;          /* reserved  */
11773       switch (flag)
11774       {
11775       case 0:
11776         /* only supported */
11777         AllLogPages[2] = 0;          /* page length */
11778         AllLogPages[3] = 1;          /* page length */
11779         AllLogPages[4] = 0x00;       /* supported page list */
11780         lenRead = (bit8)(MIN(AllocLen, 5));
11781         break;
11782       case 1:
11783         /* supported and informational exception log */
11784         AllLogPages[2] = 0;          /* page length */
11785         AllLogPages[3] = 2;          /* page length */
11786         AllLogPages[4] = 0x00;       /* supported page list */
11787         AllLogPages[5] = 0x10;       /* supported page list */
11788         lenRead = (bit8)(MIN(AllocLen, 6));
11789         break;
11790       case 2:
11791         /* supported and informational exception log */
11792         AllLogPages[2] = 0;          /* page length */
11793         AllLogPages[3] = 3;          /* page length */
11794         AllLogPages[4] = 0x00;       /* supported page list */
11795         AllLogPages[5] = 0x10;       /* supported page list */
11796         AllLogPages[6] = 0x2F;       /* supported page list */
11797        lenRead = (bit8)(MIN(AllocLen, 7));
11798        break;
11799       default:
11800         TI_DBG1(("satLogSense: error unallowed flag value %d\n", flag));
11801         break;
11802       }
11803
11804       osti_memcpy(pLogPage, &AllLogPages, lenRead);
11805       /* comparing allocation length to Log Page byte size */
11806       /* SPC-4, 4.3.4.6, p28 */
11807       if (AllocLen > lenRead )
11808       {
11809         TI_DBG1(("satLogSense reporting underrun lenRead=0x%x AllocLen=0x%x tiIORequest=%p\n", lenRead, AllocLen, tiIORequest));
11810        ostiInitiatorIOCompleted( tiRoot,
11811                                   tiIORequest,
11812                                   tiIOUnderRun,
11813                                   AllocLen - lenRead,
11814                                   agNULL,
11815                                   satIOContext->interruptContext );
11816       }
11817       else
11818       {
11819         ostiInitiatorIOCompleted( tiRoot,
11820                                   tiIORequest,
11821                                   tiIOSuccess,
11822                                   SCSI_STAT_GOOD,
11823                                   agNULL,
11824                                   satIOContext->interruptContext);
11825       }
11826       break;
11827     case LOGSENSE_SELFTEST_RESULTS_PAGE:
11828       TI_DBG5(("satLogSense: case 2\n"));
11829       /* checking SMART self-test */
11830       if (pSatDevData->satSMARTSelfTest == agFALSE)
11831       {
11832         TI_DBG5(("satLogSense: case 2 no SMART Self Test\n"));
11833         satSetSensePayload( pSense,
11834                             SCSI_SNSKEY_ILLEGAL_REQUEST,
11835                             0,
11836                             SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
11837                             satIOContext);
11838
11839         ostiInitiatorIOCompleted( tiRoot,
11840                                   tiIORequest,
11841                                   tiIOSuccess,
11842                                   SCSI_STAT_CHECK_CONDITION,
11843                                   satIOContext->pTiSenseData,
11844                                   satIOContext->interruptContext );
11845       }
11846       else
11847       {
11848         /* if satSMARTEnabled is false, send SMART_ENABLE_OPERATIONS */
11849         if (pSatDevData->satSMARTEnabled == agFALSE)
11850         {
11851           TI_DBG5(("satLogSense: case 2 calling satSMARTEnable\n"));
11852           status = satLogSenseAllocate(tiRoot,
11853                                        tiIORequest,
11854                                        tiDeviceHandle,
11855                                        tiScsiRequest,
11856                                        satIOContext,
11857                                        0,
11858                                        LOG_SENSE_0
11859                                        );
11860
11861           return status;
11862
11863         }
11864         else
11865         {
11866         /* SAT Rev 8, 10.2.4 p74 */
11867         if ( pSatDevData->sat48BitSupport == agTRUE )
11868         {
11869           TI_DBG5(("satLogSense: case 2-1 sends READ LOG EXT\n"));
11870           status = satLogSenseAllocate(tiRoot,
11871                                        tiIORequest,
11872                                        tiDeviceHandle,
11873                                        tiScsiRequest,
11874                                        satIOContext,
11875                                        512,
11876                                        LOG_SENSE_1
11877                                        );
11878
11879           return status;
11880         }
11881         else
11882         {
11883           TI_DBG5(("satLogSense: case 2-2 sends SMART READ LOG\n"));
11884           status = satLogSenseAllocate(tiRoot,
11885                                        tiIORequest,
11886                                        tiDeviceHandle,
11887                                        tiScsiRequest,
11888                                        satIOContext,
11889                                        512,
11890                                        LOG_SENSE_2
11891                                        );
11892
11893           return status;
11894         }
11895       }
11896       }
11897       break;
11898     case LOGSENSE_INFORMATION_EXCEPTIONS_PAGE:
11899       TI_DBG5(("satLogSense: case 3\n"));
11900       /* checking SMART feature set */
11901       if (pSatDevData->satSMARTFeatureSet == agFALSE)
11902       {
11903         satSetSensePayload( pSense,
11904                             SCSI_SNSKEY_ILLEGAL_REQUEST,
11905                             0,
11906                             SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
11907                             satIOContext);
11908
11909         ostiInitiatorIOCompleted( tiRoot,
11910                                   tiIORequest,
11911                                   tiIOSuccess,
11912                                   SCSI_STAT_CHECK_CONDITION,
11913                                   satIOContext->pTiSenseData,
11914                                   satIOContext->interruptContext );
11915       }
11916       else
11917       {
11918         /* checking SMART feature enabled */
11919         if (pSatDevData->satSMARTEnabled == agFALSE)
11920         {
11921           satSetSensePayload( pSense,
11922                               SCSI_SNSKEY_ABORTED_COMMAND,
11923                               0,
11924                               SCSI_SNSCODE_ATA_DEVICE_FEATURE_NOT_ENABLED,
11925                               satIOContext);
11926
11927           ostiInitiatorIOCompleted( tiRoot,
11928                                     tiIORequest,
11929                                     tiIOSuccess,
11930                                     SCSI_STAT_CHECK_CONDITION,
11931                                     satIOContext->pTiSenseData,
11932                                     satIOContext->interruptContext );
11933         }
11934         else
11935         {
11936           /* SAT Rev 8, 10.2.3 p72 */
11937           TI_DBG5(("satLogSense: case 3 sends SMART RETURN STATUS\n"));
11938
11939           /* sends SMART RETURN STATUS */
11940           fis->h.fisType        = 0x27;                   /* Reg host to device */
11941           fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
11942
11943           fis->h.command        = SAT_SMART_RETURN_STATUS;/* 0xB0 */
11944           fis->h.features       = 0xDA;                   /* FIS features */
11945           fis->d.featuresExp    = 0;                      /* FIS reserve */
11946           fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
11947           fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
11948           fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
11949           fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
11950           fis->d.lbaMid         = 0x4F;                   /* FIS LBA (15:8 ) */
11951           fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
11952           fis->d.lbaHigh        = 0xC2;                   /* FIS LBA (23:16) */
11953           fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
11954           fis->d.device         = 0;                      /* FIS DEV is discared in SATA */
11955           fis->d.control        = 0;                      /* FIS HOB bit clear */
11956           fis->d.reserved4      = 0;
11957           fis->d.reserved5      = 0;
11958
11959           agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
11960           /* Initialize CB for SATA completion.
11961            */
11962           satIOContext->satCompleteCB = &satLogSenseCB;
11963
11964           /*
11965            * Prepare SGL and send FIS to LL layer.
11966            */
11967           satIOContext->reqType = agRequestType;       /* Save it */
11968
11969           status = sataLLIOStart( tiRoot,
11970                                   tiIORequest,
11971                                   tiDeviceHandle,
11972                                   tiScsiRequest,
11973                                   satIOContext);
11974
11975
11976           return status;
11977         }
11978       }
11979       break;
11980     default:
11981       TI_DBG1(("satLogSense: default Page Code 0x%x\n", scsiCmnd->cdb[2] & SCSI_LOG_SENSE_PAGE_CODE_MASK));
11982       satSetSensePayload( pSense,
11983                           SCSI_SNSKEY_ILLEGAL_REQUEST,
11984                           0,
11985                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
11986                           satIOContext);
11987
11988       ostiInitiatorIOCompleted( tiRoot,
11989                                 tiIORequest,
11990                                 tiIOSuccess,
11991                                 SCSI_STAT_CHECK_CONDITION,
11992                                 satIOContext->pTiSenseData,
11993                                 satIOContext->interruptContext );
11994
11995       break;
11996   } /* end switch */
11997
11998   return tiSuccess;
11999
12000
12001 }
12002
12003 /*****************************************************************************/
12004 /*! \brief SAT implementation for SCSI satModeSelect6.
12005  *
12006  *  SAT implementation for SCSI satModeSelect6.
12007  *
12008  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
12009  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
12010  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
12011  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
12012  *  \param   satIOContext_t:   Pointer to the SAT IO Context
12013  *
12014  *  \return If command is started successfully
12015  *    - \e tiSuccess:     I/O request successfully initiated.
12016  *    - \e tiBusy:        No resources available, try again later.
12017  *    - \e tiIONoDevice:  Invalid device handle.
12018  *    - \e tiError:       Other errors.
12019  */
12020 /*****************************************************************************/
12021 GLOBAL bit32  satModeSelect6(
12022                    tiRoot_t                  *tiRoot,
12023                    tiIORequest_t             *tiIORequest,
12024                    tiDeviceHandle_t          *tiDeviceHandle,
12025                    tiScsiInitiatorRequest_t *tiScsiRequest,
12026                    satIOContext_t            *satIOContext)
12027 {
12028   bit32                     status;
12029   bit32                     agRequestType;
12030   satDeviceData_t           *pSatDevData;
12031   scsiRspSense_t            *pSense;
12032   tiIniScsiCmnd_t           *scsiCmnd;
12033   agsaFisRegHostToDevice_t  *fis;
12034   bit8                      *pLogPage;    /* Log Page data buffer */
12035   bit32                     StartingIndex = 0;
12036   bit8                      PageCode = 0;
12037   bit32                     chkCnd = agFALSE;
12038
12039   pSense        = satIOContext->pSense;
12040   pSatDevData   = satIOContext->pSatDevData;
12041   scsiCmnd      = &tiScsiRequest->scsiCmnd;
12042   fis           = satIOContext->pFis;
12043   pLogPage      = (bit8 *) tiScsiRequest->sglVirtualAddr;
12044
12045   TI_DBG5(("satModeSelect6: start\n"));
12046
12047   /* checking CONTROL */
12048   /* NACA == 1 or LINK == 1*/
12049   if ( (scsiCmnd->cdb[5] & SCSI_NACA_MASK) || (scsiCmnd->cdb[5] & SCSI_LINK_MASK) )
12050   {
12051     satSetSensePayload( pSense,
12052                         SCSI_SNSKEY_ILLEGAL_REQUEST,
12053                         0,
12054                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
12055                         satIOContext);
12056
12057     ostiInitiatorIOCompleted( tiRoot,
12058                               tiIORequest,
12059                               tiIOSuccess,
12060                               SCSI_STAT_CHECK_CONDITION,
12061                               satIOContext->pTiSenseData,
12062                               satIOContext->interruptContext );
12063
12064     TI_DBG2(("satModeSelect6: return control\n"));
12065     return tiSuccess;
12066   }
12067
12068   /* checking PF bit */
12069   if ( !(scsiCmnd->cdb[1] & SCSI_MODE_SELECT6_PF_MASK))
12070   {
12071     satSetSensePayload( pSense,
12072                         SCSI_SNSKEY_ILLEGAL_REQUEST,
12073                         0,
12074                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
12075                         satIOContext);
12076
12077     ostiInitiatorIOCompleted( tiRoot,
12078                               tiIORequest,
12079                               tiIOSuccess,
12080                               SCSI_STAT_CHECK_CONDITION,
12081                               satIOContext->pTiSenseData,
12082                               satIOContext->interruptContext );
12083
12084     TI_DBG1(("satModeSelect6: PF bit check \n"));
12085     return tiSuccess;
12086
12087   }
12088
12089   /* checking Block Descriptor Length on Mode parameter header(6)*/
12090   if (pLogPage[3] == 8)
12091   {
12092     /* mode parameter block descriptor exists */
12093     PageCode = (bit8)(pLogPage[12] & 0x3F);   /* page code and index is 4 + 8 */
12094     StartingIndex = 12;
12095   }
12096   else if (pLogPage[3] == 0)
12097   {
12098     /* mode parameter block descriptor does not exist */
12099     PageCode = (bit8)(pLogPage[4] & 0x3F); /* page code and index is 4 + 0 */
12100     StartingIndex = 4;
12101     ostiInitiatorIOCompleted( tiRoot,
12102                               tiIORequest,
12103                               tiIOSuccess,
12104                               SCSI_STAT_GOOD,
12105                               agNULL,
12106                               satIOContext->interruptContext);
12107     return tiSuccess;
12108   }
12109   else
12110   {
12111     TI_DBG1(("satModeSelect6: return mode parameter block descriptor 0x%x\n", pLogPage[3]));
12112     /* no more than one mode parameter block descriptor shall be supported */
12113     satSetSensePayload( pSense,
12114                         SCSI_SNSKEY_NO_SENSE,
12115                         0,
12116                         SCSI_SNSCODE_NO_ADDITIONAL_INFO,
12117                         satIOContext);
12118
12119     ostiInitiatorIOCompleted( tiRoot,
12120                               tiIORequest,
12121                               tiIOSuccess,
12122                               SCSI_STAT_CHECK_CONDITION,
12123                               satIOContext->pTiSenseData,
12124                               satIOContext->interruptContext );
12125     return tiSuccess;
12126   }
12127
12128
12129
12130   switch (PageCode) /* page code */
12131   {
12132   case MODESELECT_CONTROL_PAGE:
12133     TI_DBG1(("satModeSelect6: Control mode page\n"));
12134     /*
12135       compare pLogPage to expected value (SAT Table 65, p67)
12136       If not match, return check condition
12137      */
12138     if ( pLogPage[StartingIndex+1] != 0x0A ||
12139          pLogPage[StartingIndex+2] != 0x02 ||
12140          (pSatDevData->satNCQ == agTRUE && pLogPage[StartingIndex+3] != 0x12) ||
12141          (pSatDevData->satNCQ == agFALSE && pLogPage[StartingIndex+3] != 0x02) ||
12142          (pLogPage[StartingIndex+4] & BIT3_MASK) != 0x00 || /* SWP bit */
12143          (pLogPage[StartingIndex+4] & BIT4_MASK) != 0x00 || /* UA_INTLCK_CTRL */
12144          (pLogPage[StartingIndex+4] & BIT5_MASK) != 0x00 || /* UA_INTLCK_CTRL */
12145
12146          (pLogPage[StartingIndex+5] & BIT0_MASK) != 0x00 || /* AUTOLOAD MODE */
12147          (pLogPage[StartingIndex+5] & BIT1_MASK) != 0x00 || /* AUTOLOAD MODE */
12148          (pLogPage[StartingIndex+5] & BIT2_MASK) != 0x00 || /* AUTOLOAD MODE */
12149          (pLogPage[StartingIndex+5] & BIT6_MASK) != 0x00 || /* TAS bit */
12150
12151          pLogPage[StartingIndex+8] != 0xFF ||
12152          pLogPage[StartingIndex+9] != 0xFF ||
12153          pLogPage[StartingIndex+10] != 0x00 ||
12154          pLogPage[StartingIndex+11] != 0x00
12155        )
12156     {
12157       chkCnd = agTRUE;
12158     }
12159     if (chkCnd == agTRUE)
12160     {
12161       satSetSensePayload( pSense,
12162                         SCSI_SNSKEY_ILLEGAL_REQUEST,
12163                         0,
12164                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
12165                         satIOContext);
12166
12167       ostiInitiatorIOCompleted( tiRoot,
12168                               tiIORequest,
12169                               tiIOSuccess,
12170                               SCSI_STAT_CHECK_CONDITION,
12171                               satIOContext->pTiSenseData,
12172                               satIOContext->interruptContext );
12173
12174       TI_DBG1(("satModeSelect10: unexpected values\n"));
12175     }
12176     else
12177     {
12178       ostiInitiatorIOCompleted( tiRoot,
12179                                 tiIORequest,
12180                                 tiIOSuccess,
12181                                 SCSI_STAT_GOOD,
12182                                 agNULL,
12183                                 satIOContext->interruptContext);
12184     }
12185     return tiSuccess;
12186     break;
12187   case MODESELECT_READ_WRITE_ERROR_RECOVERY_PAGE:
12188     TI_DBG1(("satModeSelect6: Read-Write Error Recovery mode page\n"));
12189
12190     if ( (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT6_AWRE_MASK) ||
12191          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT6_RC_MASK) ||
12192          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT6_EER_MASK) ||
12193          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT6_PER_MASK) ||
12194          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT6_DTE_MASK) ||
12195          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT6_DCR_MASK) ||
12196          (pLogPage[StartingIndex + 10]) ||
12197          (pLogPage[StartingIndex + 11])
12198          )
12199     {
12200       TI_DBG5(("satModeSelect6: return check condition \n"));
12201
12202       satSetSensePayload( pSense,
12203                           SCSI_SNSKEY_ILLEGAL_REQUEST,
12204                           0,
12205                           SCSI_SNSCODE_INVALID_FIELD_PARAMETER_LIST,
12206                           satIOContext);
12207
12208       ostiInitiatorIOCompleted( tiRoot,
12209                                 tiIORequest,
12210                                 tiIOSuccess,
12211                                 SCSI_STAT_CHECK_CONDITION,
12212                                 satIOContext->pTiSenseData,
12213                                 satIOContext->interruptContext );
12214       return tiSuccess;
12215     }
12216     else
12217     {
12218       TI_DBG5(("satModeSelect6: return GOOD \n"));
12219       ostiInitiatorIOCompleted( tiRoot,
12220                                 tiIORequest,
12221                                 tiIOSuccess,
12222                                 SCSI_STAT_GOOD,
12223                                 agNULL,
12224                                 satIOContext->interruptContext);
12225       return tiSuccess;
12226     }
12227
12228     break;
12229   case MODESELECT_CACHING:
12230     /* SAT rev8 Table67, p69*/
12231     TI_DBG5(("satModeSelect6: Caching mode page\n"));
12232     if ( (pLogPage[StartingIndex + 2] & 0xFB) || /* 1111 1011 */
12233          (pLogPage[StartingIndex + 3]) ||
12234          (pLogPage[StartingIndex + 4]) ||
12235          (pLogPage[StartingIndex + 5]) ||
12236          (pLogPage[StartingIndex + 6]) ||
12237          (pLogPage[StartingIndex + 7]) ||
12238          (pLogPage[StartingIndex + 8]) ||
12239          (pLogPage[StartingIndex + 9]) ||
12240          (pLogPage[StartingIndex + 10]) ||
12241          (pLogPage[StartingIndex + 11]) ||
12242
12243          (pLogPage[StartingIndex + 12] & 0xC1) || /* 1100 0001 */
12244          (pLogPage[StartingIndex + 13]) ||
12245          (pLogPage[StartingIndex + 14]) ||
12246          (pLogPage[StartingIndex + 15])
12247          )
12248     {
12249       TI_DBG1(("satModeSelect6: return check condition \n"));
12250
12251       satSetSensePayload( pSense,
12252                           SCSI_SNSKEY_ILLEGAL_REQUEST,
12253                           0,
12254                           SCSI_SNSCODE_INVALID_FIELD_PARAMETER_LIST,
12255                           satIOContext);
12256
12257       ostiInitiatorIOCompleted( tiRoot,
12258                                 tiIORequest,
12259                                 tiIOSuccess,
12260                                 SCSI_STAT_CHECK_CONDITION,
12261                                 satIOContext->pTiSenseData,
12262                                 satIOContext->interruptContext );
12263       return tiSuccess;
12264
12265     }
12266     else
12267     {
12268       /* sends ATA SET FEATURES based on WCE bit */
12269       if ( !(pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT6_WCE_MASK) )
12270       {
12271         TI_DBG5(("satModeSelect6: disable write cache\n"));
12272         /* sends SET FEATURES */
12273         fis->h.fisType        = 0x27;                   /* Reg host to device */
12274         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
12275
12276         fis->h.command        = SAT_SET_FEATURES;       /* 0xEF */
12277         fis->h.features       = 0x82;                   /* disable write cache */
12278         fis->d.lbaLow         = 0;                      /* */
12279         fis->d.lbaMid         = 0;                      /* */
12280         fis->d.lbaHigh        = 0;                      /* */
12281         fis->d.device         = 0;                      /* */
12282         fis->d.lbaLowExp      = 0;                      /* */
12283         fis->d.lbaMidExp      = 0;                      /* */
12284         fis->d.lbaHighExp     = 0;                      /* */
12285         fis->d.featuresExp    = 0;                      /* */
12286         fis->d.sectorCount    = 0;                      /* */
12287         fis->d.sectorCountExp = 0;                      /* */
12288         fis->d.reserved4      = 0;
12289         fis->d.control        = 0;                      /* FIS HOB bit clear */
12290         fis->d.reserved5      = 0;
12291
12292         agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
12293
12294         /* Initialize CB for SATA completion.
12295          */
12296         satIOContext->satCompleteCB = &satModeSelect6n10CB;
12297
12298         /*
12299          * Prepare SGL and send FIS to LL layer.
12300          */
12301         satIOContext->reqType = agRequestType;       /* Save it */
12302
12303         status = sataLLIOStart( tiRoot,
12304                                 tiIORequest,
12305                                 tiDeviceHandle,
12306                                 tiScsiRequest,
12307                                 satIOContext);
12308         return status;
12309       }
12310       else
12311       {
12312         TI_DBG5(("satModeSelect6: enable write cache\n"));
12313         /* sends SET FEATURES */
12314         fis->h.fisType        = 0x27;                   /* Reg host to device */
12315         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
12316
12317         fis->h.command        = SAT_SET_FEATURES;       /* 0xEF */
12318         fis->h.features       = 0x02;                   /* enable write cache */
12319         fis->d.lbaLow         = 0;                      /* */
12320         fis->d.lbaMid         = 0;                      /* */
12321         fis->d.lbaHigh        = 0;                      /* */
12322         fis->d.device         = 0;                      /* */
12323         fis->d.lbaLowExp      = 0;                      /* */
12324         fis->d.lbaMidExp      = 0;                      /* */
12325         fis->d.lbaHighExp     = 0;                      /* */
12326         fis->d.featuresExp    = 0;                      /* */
12327         fis->d.sectorCount    = 0;                      /* */
12328         fis->d.sectorCountExp = 0;                      /* */
12329         fis->d.reserved4      = 0;
12330         fis->d.control        = 0;                      /* FIS HOB bit clear */
12331         fis->d.reserved5      = 0;
12332
12333         agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
12334
12335         /* Initialize CB for SATA completion.
12336          */
12337         satIOContext->satCompleteCB = &satModeSelect6n10CB;
12338
12339         /*
12340          * Prepare SGL and send FIS to LL layer.
12341          */
12342         satIOContext->reqType = agRequestType;       /* Save it */
12343
12344         status = sataLLIOStart( tiRoot,
12345                                 tiIORequest,
12346                                 tiDeviceHandle,
12347                                 tiScsiRequest,
12348                                 satIOContext);
12349         return status;
12350
12351       }
12352     }
12353     break;
12354   case MODESELECT_INFORMATION_EXCEPTION_CONTROL_PAGE:
12355     TI_DBG5(("satModeSelect6: Informational Exception Control mode page\n"));
12356     if ( (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT6_PERF_MASK) ||
12357          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT6_TEST_MASK)
12358          )
12359     {
12360       TI_DBG1(("satModeSelect6: return check condition \n"));
12361
12362       satSetSensePayload( pSense,
12363                           SCSI_SNSKEY_ILLEGAL_REQUEST,
12364                           0,
12365                           SCSI_SNSCODE_INVALID_FIELD_PARAMETER_LIST,
12366                           satIOContext);
12367
12368       ostiInitiatorIOCompleted( tiRoot,
12369                                 tiIORequest,
12370                                 tiIOSuccess,
12371                                 SCSI_STAT_CHECK_CONDITION,
12372                                 satIOContext->pTiSenseData,
12373                                 satIOContext->interruptContext );
12374       return tiSuccess;
12375     }
12376     else
12377     {
12378       /* sends either ATA SMART ENABLE/DISABLE OPERATIONS based on DEXCPT bit */
12379       if ( !(pLogPage[StartingIndex + 2] & 0x08) )
12380       {
12381         TI_DBG5(("satModeSelect6: enable information exceptions reporting\n"));
12382         /* sends SMART ENABLE OPERATIONS */
12383         fis->h.fisType        = 0x27;                   /* Reg host to device */
12384         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
12385
12386         fis->h.command        = SAT_SMART_ENABLE_OPERATIONS;       /* 0xB0 */
12387         fis->h.features       = 0xD8;                   /* enable */
12388         fis->d.lbaLow         = 0;                      /* */
12389         fis->d.lbaMid         = 0x4F;                   /* 0x4F */
12390         fis->d.lbaHigh        = 0xC2;                   /* 0xC2 */
12391         fis->d.device         = 0;                      /* */
12392         fis->d.lbaLowExp      = 0;                      /* */
12393         fis->d.lbaMidExp      = 0;                      /* */
12394         fis->d.lbaHighExp     = 0;                      /* */
12395         fis->d.featuresExp    = 0;                      /* */
12396         fis->d.sectorCount    = 0;                      /* */
12397         fis->d.sectorCountExp = 0;                      /* */
12398         fis->d.reserved4      = 0;
12399         fis->d.control        = 0;                      /* FIS HOB bit clear */
12400         fis->d.reserved5      = 0;
12401
12402         agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
12403
12404         /* Initialize CB for SATA completion.
12405          */
12406         satIOContext->satCompleteCB = &satModeSelect6n10CB;
12407
12408         /*
12409          * Prepare SGL and send FIS to LL layer.
12410          */
12411         satIOContext->reqType = agRequestType;       /* Save it */
12412
12413         status = sataLLIOStart( tiRoot,
12414                                 tiIORequest,
12415                                 tiDeviceHandle,
12416                                 tiScsiRequest,
12417                                 satIOContext);
12418         return status;
12419       }
12420       else
12421       {
12422         TI_DBG5(("satModeSelect6: disable information exceptions reporting\n"));
12423         /* sends SMART DISABLE OPERATIONS */
12424         fis->h.fisType        = 0x27;                   /* Reg host to device */
12425         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
12426
12427         fis->h.command        = SAT_SMART_DISABLE_OPERATIONS;       /* 0xB0 */
12428         fis->h.features       = 0xD9;                   /* disable */
12429         fis->d.lbaLow         = 0;                      /* */
12430         fis->d.lbaMid         = 0x4F;                   /* 0x4F */
12431         fis->d.lbaHigh        = 0xC2;                   /* 0xC2 */
12432         fis->d.device         = 0;                      /* */
12433         fis->d.lbaLowExp      = 0;                      /* */
12434         fis->d.lbaMidExp      = 0;                      /* */
12435         fis->d.lbaHighExp     = 0;                      /* */
12436         fis->d.featuresExp    = 0;                      /* */
12437         fis->d.sectorCount    = 0;                      /* */
12438         fis->d.sectorCountExp = 0;                      /* */
12439         fis->d.reserved4      = 0;
12440         fis->d.control        = 0;                      /* FIS HOB bit clear */
12441         fis->d.reserved5      = 0;
12442
12443         agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
12444
12445         /* Initialize CB for SATA completion.
12446          */
12447         satIOContext->satCompleteCB = &satModeSelect6n10CB;
12448
12449         /*
12450          * Prepare SGL and send FIS to LL layer.
12451          */
12452         satIOContext->reqType = agRequestType;       /* Save it */
12453
12454         status = sataLLIOStart( tiRoot,
12455                                 tiIORequest,
12456                                 tiDeviceHandle,
12457                                 tiScsiRequest,
12458                                 satIOContext);
12459         return status;
12460
12461       }
12462     }
12463     break;
12464   default:
12465     TI_DBG1(("satModeSelect6: Error unknown page code 0x%x\n", pLogPage[12]));
12466     satSetSensePayload( pSense,
12467                         SCSI_SNSKEY_NO_SENSE,
12468                         0,
12469                         SCSI_SNSCODE_NO_ADDITIONAL_INFO,
12470                         satIOContext);
12471
12472     ostiInitiatorIOCompleted( tiRoot,
12473                               tiIORequest,
12474                               tiIOSuccess,
12475                               SCSI_STAT_CHECK_CONDITION,
12476                               satIOContext->pTiSenseData,
12477                               satIOContext->interruptContext );
12478     return tiSuccess;
12479   }
12480
12481 }
12482
12483 /*****************************************************************************/
12484 /*! \brief SAT implementation for SCSI satModeSelect6n10_1.
12485  *
12486  *  This function is part of implementation of ModeSelect6 and ModeSelect10.
12487  *  When ModeSelect6 or ModeSelect10 is coverted into multiple ATA commands,
12488  *  this function is used.
12489  *
12490  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
12491  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
12492  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
12493  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
12494  *  \param   satIOContext_t:   Pointer to the SAT IO Context
12495  *
12496  *  \return If command is started successfully
12497  *    - \e tiSuccess:     I/O request successfully initiated.
12498  *    - \e tiBusy:        No resources available, try again later.
12499  *    - \e tiIONoDevice:  Invalid device handle.
12500  *    - \e tiError:       Other errors.
12501  */
12502 /*****************************************************************************/
12503 GLOBAL bit32  satModeSelect6n10_1(
12504                    tiRoot_t                  *tiRoot,
12505                    tiIORequest_t             *tiIORequest,
12506                    tiDeviceHandle_t          *tiDeviceHandle,
12507                    tiScsiInitiatorRequest_t *tiScsiRequest,
12508                    satIOContext_t            *satIOContext)
12509 {
12510   /* sends either ATA SET FEATURES based on DRA bit */
12511   bit32                     status;
12512   bit32                     agRequestType;
12513   agsaFisRegHostToDevice_t  *fis;
12514   bit8                      *pLogPage;    /* Log Page data buffer */
12515   bit32                     StartingIndex = 0;
12516
12517   fis           = satIOContext->pFis;
12518   pLogPage      = (bit8 *) tiScsiRequest->sglVirtualAddr;
12519   TI_DBG5(("satModeSelect6_1: start\n"));
12520   /* checking Block Descriptor Length on Mode parameter header(6)*/
12521   if (pLogPage[3] == 8)
12522   {
12523     /* mode parameter block descriptor exists */
12524     StartingIndex = 12;
12525   }
12526   else
12527   {
12528     /* mode parameter block descriptor does not exist */
12529     StartingIndex = 4;
12530   }
12531
12532   /* sends ATA SET FEATURES based on DRA bit */
12533   if ( !(pLogPage[StartingIndex + 12] & SCSI_MODE_SELECT6_DRA_MASK) )
12534   {
12535     TI_DBG5(("satModeSelect6_1: enable read look-ahead feature\n"));
12536     /* sends SET FEATURES */
12537     fis->h.fisType        = 0x27;                   /* Reg host to device */
12538     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
12539
12540     fis->h.command        = SAT_SET_FEATURES;       /* 0xEF */
12541     fis->h.features       = 0xAA;                   /* enable read look-ahead */
12542     fis->d.lbaLow         = 0;                      /* */
12543     fis->d.lbaMid         = 0;                      /* */
12544     fis->d.lbaHigh        = 0;                      /* */
12545     fis->d.device         = 0;                      /* */
12546     fis->d.lbaLowExp      = 0;                      /* */
12547     fis->d.lbaMidExp      = 0;                      /* */
12548     fis->d.lbaHighExp     = 0;                      /* */
12549     fis->d.featuresExp    = 0;                      /* */
12550     fis->d.sectorCount    = 0;                      /* */
12551     fis->d.sectorCountExp = 0;                      /* */
12552     fis->d.reserved4      = 0;
12553     fis->d.control        = 0;                      /* FIS HOB bit clear */
12554     fis->d.reserved5      = 0;
12555
12556     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
12557
12558     /* Initialize CB for SATA completion.
12559      */
12560     satIOContext->satCompleteCB = &satModeSelect6n10CB;
12561
12562     /*
12563      * Prepare SGL and send FIS to LL layer.
12564      */
12565     satIOContext->reqType = agRequestType;       /* Save it */
12566
12567     status = sataLLIOStart( tiRoot,
12568                             tiIORequest,
12569                             tiDeviceHandle,
12570                             tiScsiRequest,
12571                             satIOContext);
12572     return status;
12573   }
12574   else
12575   {
12576     TI_DBG5(("satModeSelect6_1: disable read look-ahead feature\n"));
12577         /* sends SET FEATURES */
12578     fis->h.fisType        = 0x27;                   /* Reg host to device */
12579     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
12580
12581     fis->h.command        = SAT_SET_FEATURES;       /* 0xEF */
12582     fis->h.features       = 0x55;                   /* disable read look-ahead */
12583     fis->d.lbaLow         = 0;                      /* */
12584     fis->d.lbaMid         = 0;                      /* */
12585     fis->d.lbaHigh        = 0;                      /* */
12586     fis->d.device         = 0;                      /* */
12587     fis->d.lbaLowExp      = 0;                      /* */
12588     fis->d.lbaMidExp      = 0;                      /* */
12589     fis->d.lbaHighExp     = 0;                      /* */
12590     fis->d.featuresExp    = 0;                      /* */
12591     fis->d.sectorCount    = 0;                      /* */
12592     fis->d.sectorCountExp = 0;                      /* */
12593     fis->d.reserved4      = 0;
12594     fis->d.control        = 0;                      /* FIS HOB bit clear */
12595     fis->d.reserved5      = 0;
12596
12597     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
12598
12599     /* Initialize CB for SATA completion.
12600      */
12601     satIOContext->satCompleteCB = &satModeSelect6n10CB;
12602
12603     /*
12604      * Prepare SGL and send FIS to LL layer.
12605      */
12606     satIOContext->reqType = agRequestType;       /* Save it */
12607
12608     status = sataLLIOStart( tiRoot,
12609                             tiIORequest,
12610                             tiDeviceHandle,
12611                             tiScsiRequest,
12612                             satIOContext);
12613     return status;
12614   }
12615
12616 }
12617
12618
12619 /*****************************************************************************/
12620 /*! \brief SAT implementation for SCSI satModeSelect10.
12621  *
12622  *  SAT implementation for SCSI satModeSelect10.
12623  *
12624  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
12625  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
12626  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
12627  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
12628  *  \param   satIOContext_t:   Pointer to the SAT IO Context
12629  *
12630  *  \return If command is started successfully
12631  *    - \e tiSuccess:     I/O request successfully initiated.
12632  *    - \e tiBusy:        No resources available, try again later.
12633  *    - \e tiIONoDevice:  Invalid device handle.
12634  *    - \e tiError:       Other errors.
12635  */
12636 /*****************************************************************************/
12637 GLOBAL bit32  satModeSelect10(
12638                    tiRoot_t                  *tiRoot,
12639                    tiIORequest_t             *tiIORequest,
12640                    tiDeviceHandle_t          *tiDeviceHandle,
12641                    tiScsiInitiatorRequest_t *tiScsiRequest,
12642                    satIOContext_t            *satIOContext)
12643 {
12644   bit32                     status;
12645   bit32                     agRequestType;
12646   satDeviceData_t           *pSatDevData;
12647   scsiRspSense_t            *pSense;
12648   tiIniScsiCmnd_t           *scsiCmnd;
12649   agsaFisRegHostToDevice_t  *fis;
12650   bit8                      *pLogPage;    /* Log Page data buffer */
12651   bit16                     BlkDescLen = 0;     /* Block Descriptor Length */
12652   bit32                     StartingIndex = 0;
12653   bit8                      PageCode = 0;
12654   bit32                     chkCnd = agFALSE;
12655
12656   pSense        = satIOContext->pSense;
12657   pSatDevData   = satIOContext->pSatDevData;
12658   scsiCmnd      = &tiScsiRequest->scsiCmnd;
12659   fis           = satIOContext->pFis;
12660   pLogPage      = (bit8 *) tiScsiRequest->sglVirtualAddr;
12661
12662   TI_DBG5(("satModeSelect10: start\n"));
12663
12664   /* checking CONTROL */
12665   /* NACA == 1 or LINK == 1*/
12666   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
12667   {
12668     satSetSensePayload( pSense,
12669                         SCSI_SNSKEY_ILLEGAL_REQUEST,
12670                         0,
12671                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
12672                         satIOContext);
12673
12674     ostiInitiatorIOCompleted( tiRoot,
12675                               tiIORequest,
12676                               tiIOSuccess,
12677                               SCSI_STAT_CHECK_CONDITION,
12678                               satIOContext->pTiSenseData,
12679                               satIOContext->interruptContext );
12680
12681     TI_DBG2(("satModeSelect10: return control\n"));
12682     return tiSuccess;
12683   }
12684
12685   /* checking PF bit */
12686   if ( !(scsiCmnd->cdb[1] & SCSI_MODE_SELECT10_PF_MASK))
12687   {
12688     satSetSensePayload( pSense,
12689                         SCSI_SNSKEY_ILLEGAL_REQUEST,
12690                         0,
12691                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
12692                         satIOContext);
12693
12694     ostiInitiatorIOCompleted( tiRoot,
12695                               tiIORequest,
12696                               tiIOSuccess,
12697                               SCSI_STAT_CHECK_CONDITION,
12698                               satIOContext->pTiSenseData,
12699                               satIOContext->interruptContext );
12700
12701     TI_DBG1(("satModeSelect10: PF bit check \n"));
12702     return tiSuccess;
12703
12704   }
12705
12706   BlkDescLen = (bit8)((pLogPage[6] << 8) + pLogPage[7]);
12707
12708   /* checking Block Descriptor Length on Mode parameter header(10) and LONGLBA bit*/
12709   if ( (BlkDescLen == 8) && !(pLogPage[4] & SCSI_MODE_SELECT10_LONGLBA_MASK) )
12710   {
12711     /* mode parameter block descriptor exists and length is 8 byte */
12712     PageCode = (bit8)(pLogPage[16] & 0x3F);   /* page code and index is 8 + 8 */
12713     StartingIndex = 16;
12714   }
12715   else if ( (BlkDescLen == 16) && (pLogPage[4] & SCSI_MODE_SELECT10_LONGLBA_MASK) )
12716   {
12717     /* mode parameter block descriptor exists and length is 16 byte */
12718     PageCode = (bit8)(pLogPage[24] & 0x3F);   /* page code and index is 8 + 16 */
12719     StartingIndex = 24;
12720   }
12721   else if (BlkDescLen == 0)
12722   {
12723     /*
12724       mode parameter block descriptor does not exist
12725       */
12726     PageCode = (bit8)(pLogPage[8] & 0x3F); /* page code and index is 8 + 0 */
12727     StartingIndex = 8;
12728     ostiInitiatorIOCompleted( tiRoot,
12729                               tiIORequest,
12730                               tiIOSuccess,
12731                               SCSI_STAT_GOOD,
12732                               agNULL,
12733                               satIOContext->interruptContext);
12734     return tiSuccess;
12735   }
12736   else
12737   {
12738     TI_DBG1(("satModeSelect10: return mode parameter block descriptor 0x%x\n",  BlkDescLen));
12739     /* no more than one mode parameter block descriptor shall be supported */
12740     satSetSensePayload( pSense,
12741                         SCSI_SNSKEY_NO_SENSE,
12742                         0,
12743                         SCSI_SNSCODE_NO_ADDITIONAL_INFO,
12744                         satIOContext);
12745
12746     ostiInitiatorIOCompleted( tiRoot,
12747                               tiIORequest,
12748                               tiIOSuccess,
12749                               SCSI_STAT_CHECK_CONDITION,
12750                               satIOContext->pTiSenseData,
12751                               satIOContext->interruptContext );
12752     return tiSuccess;
12753   }
12754   /*
12755     for debugging only
12756   */
12757   if (StartingIndex == 8)
12758   {
12759     tdhexdump("startingindex 8", (bit8 *)pLogPage, 8);
12760   }
12761   else if(StartingIndex == 16)
12762   {
12763     if (PageCode == MODESELECT_CACHING)
12764     {
12765       tdhexdump("startingindex 16", (bit8 *)pLogPage, 16+20);
12766     }
12767     else
12768     {
12769       tdhexdump("startingindex 16", (bit8 *)pLogPage, 16+12);
12770     }
12771   }
12772   else
12773   {
12774     if (PageCode == MODESELECT_CACHING)
12775     {
12776       tdhexdump("startingindex 24", (bit8 *)pLogPage, 24+20);
12777     }
12778     else
12779     {
12780       tdhexdump("startingindex 24", (bit8 *)pLogPage, 24+12);
12781     }
12782   }
12783   switch (PageCode) /* page code */
12784   {
12785   case MODESELECT_CONTROL_PAGE:
12786     TI_DBG5(("satModeSelect10: Control mode page\n"));
12787     /*
12788       compare pLogPage to expected value (SAT Table 65, p67)
12789       If not match, return check condition
12790      */
12791     if ( pLogPage[StartingIndex+1] != 0x0A ||
12792          pLogPage[StartingIndex+2] != 0x02 ||
12793          (pSatDevData->satNCQ == agTRUE && pLogPage[StartingIndex+3] != 0x12) ||
12794          (pSatDevData->satNCQ == agFALSE && pLogPage[StartingIndex+3] != 0x02) ||
12795          (pLogPage[StartingIndex+4] & BIT3_MASK) != 0x00 || /* SWP bit */
12796          (pLogPage[StartingIndex+4] & BIT4_MASK) != 0x00 || /* UA_INTLCK_CTRL */
12797          (pLogPage[StartingIndex+4] & BIT5_MASK) != 0x00 || /* UA_INTLCK_CTRL */
12798
12799          (pLogPage[StartingIndex+5] & BIT0_MASK) != 0x00 || /* AUTOLOAD MODE */
12800          (pLogPage[StartingIndex+5] & BIT1_MASK) != 0x00 || /* AUTOLOAD MODE */
12801          (pLogPage[StartingIndex+5] & BIT2_MASK) != 0x00 || /* AUTOLOAD MODE */
12802          (pLogPage[StartingIndex+5] & BIT6_MASK) != 0x00 || /* TAS bit */
12803
12804          pLogPage[StartingIndex+8] != 0xFF ||
12805          pLogPage[StartingIndex+9] != 0xFF ||
12806          pLogPage[StartingIndex+10] != 0x00 ||
12807          pLogPage[StartingIndex+11] != 0x00
12808        )
12809     {
12810       chkCnd = agTRUE;
12811     }
12812     if (chkCnd == agTRUE)
12813     {
12814       satSetSensePayload( pSense,
12815                         SCSI_SNSKEY_ILLEGAL_REQUEST,
12816                         0,
12817                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
12818                         satIOContext);
12819
12820       ostiInitiatorIOCompleted( tiRoot,
12821                               tiIORequest,
12822                               tiIOSuccess,
12823                               SCSI_STAT_CHECK_CONDITION,
12824                               satIOContext->pTiSenseData,
12825                               satIOContext->interruptContext );
12826
12827       TI_DBG1(("satModeSelect10: unexpected values\n"));
12828     }
12829     else
12830     {
12831       ostiInitiatorIOCompleted( tiRoot,
12832                               tiIORequest,
12833                               tiIOSuccess,
12834                               SCSI_STAT_GOOD,
12835                               agNULL,
12836                               satIOContext->interruptContext);
12837     }
12838     return tiSuccess;
12839     break;
12840   case MODESELECT_READ_WRITE_ERROR_RECOVERY_PAGE:
12841     TI_DBG5(("satModeSelect10: Read-Write Error Recovery mode page\n"));
12842     if ( (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT10_AWRE_MASK) ||
12843          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT10_RC_MASK) ||
12844          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT10_EER_MASK) ||
12845          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT10_PER_MASK) ||
12846          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT10_DTE_MASK) ||
12847          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT10_DCR_MASK) ||
12848          (pLogPage[StartingIndex + 10]) ||
12849          (pLogPage[StartingIndex + 11])
12850          )
12851     {
12852       TI_DBG1(("satModeSelect10: return check condition \n"));
12853
12854       satSetSensePayload( pSense,
12855                           SCSI_SNSKEY_ILLEGAL_REQUEST,
12856                           0,
12857                           SCSI_SNSCODE_INVALID_FIELD_PARAMETER_LIST,
12858                           satIOContext);
12859
12860       ostiInitiatorIOCompleted( tiRoot,
12861                                 tiIORequest,
12862                                 tiIOSuccess,
12863                                 SCSI_STAT_CHECK_CONDITION,
12864                                 satIOContext->pTiSenseData,
12865                                 satIOContext->interruptContext );
12866       return tiSuccess;
12867     }
12868     else
12869     {
12870       TI_DBG2(("satModeSelect10: return GOOD \n"));
12871       ostiInitiatorIOCompleted( tiRoot,
12872                                 tiIORequest,
12873                                 tiIOSuccess,
12874                                 SCSI_STAT_GOOD,
12875                                 agNULL,
12876                                 satIOContext->interruptContext);
12877       return tiSuccess;
12878     }
12879
12880     break;
12881   case MODESELECT_CACHING:
12882     /* SAT rev8 Table67, p69*/
12883     TI_DBG5(("satModeSelect10: Caching mode page\n"));
12884     if ( (pLogPage[StartingIndex + 2] & 0xFB) || /* 1111 1011 */
12885          (pLogPage[StartingIndex + 3]) ||
12886          (pLogPage[StartingIndex + 4]) ||
12887          (pLogPage[StartingIndex + 5]) ||
12888          (pLogPage[StartingIndex + 6]) ||
12889          (pLogPage[StartingIndex + 7]) ||
12890          (pLogPage[StartingIndex + 8]) ||
12891          (pLogPage[StartingIndex + 9]) ||
12892          (pLogPage[StartingIndex + 10]) ||
12893          (pLogPage[StartingIndex + 11]) ||
12894
12895          (pLogPage[StartingIndex + 12] & 0xC1) || /* 1100 0001 */
12896          (pLogPage[StartingIndex + 13]) ||
12897          (pLogPage[StartingIndex + 14]) ||
12898          (pLogPage[StartingIndex + 15])
12899          )
12900     {
12901       TI_DBG1(("satModeSelect10: return check condition \n"));
12902
12903       satSetSensePayload( pSense,
12904                           SCSI_SNSKEY_ILLEGAL_REQUEST,
12905                           0,
12906                           SCSI_SNSCODE_INVALID_FIELD_PARAMETER_LIST,
12907                           satIOContext);
12908
12909       ostiInitiatorIOCompleted( tiRoot,
12910                                 tiIORequest,
12911                                 tiIOSuccess,
12912                                 SCSI_STAT_CHECK_CONDITION,
12913                                 satIOContext->pTiSenseData,
12914                                 satIOContext->interruptContext );
12915       return tiSuccess;
12916
12917     }
12918     else
12919     {
12920       /* sends ATA SET FEATURES based on WCE bit */
12921       if ( !(pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT10_WCE_MASK) )
12922       {
12923         TI_DBG5(("satModeSelect10: disable write cache\n"));
12924         /* sends SET FEATURES */
12925         fis->h.fisType        = 0x27;                   /* Reg host to device */
12926         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
12927
12928         fis->h.command        = SAT_SET_FEATURES;       /* 0xEF */
12929         fis->h.features       = 0x82;                   /* disable write cache */
12930         fis->d.lbaLow         = 0;                      /* */
12931         fis->d.lbaMid         = 0;                      /* */
12932         fis->d.lbaHigh        = 0;                      /* */
12933         fis->d.device         = 0;                      /* */
12934         fis->d.lbaLowExp      = 0;                      /* */
12935         fis->d.lbaMidExp      = 0;                      /* */
12936         fis->d.lbaHighExp     = 0;                      /* */
12937         fis->d.featuresExp    = 0;                      /* */
12938         fis->d.sectorCount    = 0;                      /* */
12939         fis->d.sectorCountExp = 0;                      /* */
12940         fis->d.reserved4      = 0;
12941         fis->d.control        = 0;                      /* FIS HOB bit clear */
12942         fis->d.reserved5      = 0;
12943
12944         agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
12945
12946         /* Initialize CB for SATA completion.
12947          */
12948         satIOContext->satCompleteCB = &satModeSelect6n10CB;
12949
12950         /*
12951          * Prepare SGL and send FIS to LL layer.
12952          */
12953         satIOContext->reqType = agRequestType;       /* Save it */
12954
12955         status = sataLLIOStart( tiRoot,
12956                                 tiIORequest,
12957                                 tiDeviceHandle,
12958                                 tiScsiRequest,
12959                                 satIOContext);
12960         return status;
12961       }
12962       else
12963       {
12964         TI_DBG5(("satModeSelect10: enable write cache\n"));
12965         /* sends SET FEATURES */
12966         fis->h.fisType        = 0x27;                   /* Reg host to device */
12967         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
12968
12969         fis->h.command        = SAT_SET_FEATURES;       /* 0xEF */
12970         fis->h.features       = 0x02;                   /* enable write cache */
12971         fis->d.lbaLow         = 0;                      /* */
12972         fis->d.lbaMid         = 0;                      /* */
12973         fis->d.lbaHigh        = 0;                      /* */
12974         fis->d.device         = 0;                      /* */
12975         fis->d.lbaLowExp      = 0;                      /* */
12976         fis->d.lbaMidExp      = 0;                      /* */
12977         fis->d.lbaHighExp     = 0;                      /* */
12978         fis->d.featuresExp    = 0;                      /* */
12979         fis->d.sectorCount    = 0;                      /* */
12980         fis->d.sectorCountExp = 0;                      /* */
12981         fis->d.reserved4      = 0;
12982         fis->d.control        = 0;                      /* FIS HOB bit clear */
12983         fis->d.reserved5      = 0;
12984
12985         agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
12986
12987         /* Initialize CB for SATA completion.
12988          */
12989         satIOContext->satCompleteCB = &satModeSelect6n10CB;
12990
12991         /*
12992          * Prepare SGL and send FIS to LL layer.
12993          */
12994         satIOContext->reqType = agRequestType;       /* Save it */
12995
12996         status = sataLLIOStart( tiRoot,
12997                                 tiIORequest,
12998                                 tiDeviceHandle,
12999                                 tiScsiRequest,
13000                                 satIOContext);
13001         return status;
13002
13003       }
13004     }
13005     break;
13006   case MODESELECT_INFORMATION_EXCEPTION_CONTROL_PAGE:
13007     TI_DBG5(("satModeSelect10: Informational Exception Control mode page\n"));
13008
13009     if ( (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT10_PERF_MASK) ||
13010          (pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT10_TEST_MASK)
13011          )
13012     {
13013       TI_DBG1(("satModeSelect10: return check condition \n"));
13014
13015       satSetSensePayload( pSense,
13016                           SCSI_SNSKEY_ILLEGAL_REQUEST,
13017                           0,
13018                           SCSI_SNSCODE_INVALID_FIELD_PARAMETER_LIST,
13019                           satIOContext);
13020
13021       ostiInitiatorIOCompleted( tiRoot,
13022                                 tiIORequest,
13023                                 tiIOSuccess,
13024                                 SCSI_STAT_CHECK_CONDITION,
13025                                 satIOContext->pTiSenseData,
13026                                 satIOContext->interruptContext );
13027       return tiSuccess;
13028     }
13029     else
13030     {
13031       /* sends either ATA SMART ENABLE/DISABLE OPERATIONS based on DEXCPT bit */
13032       if ( !(pLogPage[StartingIndex + 2] & SCSI_MODE_SELECT10_DEXCPT_MASK) )
13033       {
13034         TI_DBG5(("satModeSelect10: enable information exceptions reporting\n"));
13035         /* sends SMART ENABLE OPERATIONS */
13036         fis->h.fisType        = 0x27;                   /* Reg host to device */
13037         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
13038
13039         fis->h.command        = SAT_SMART_ENABLE_OPERATIONS;       /* 0xB0 */
13040         fis->h.features       = 0xD8;                   /* enable */
13041         fis->d.lbaLow         = 0;                      /* */
13042         fis->d.lbaMid         = 0x4F;                   /* 0x4F */
13043         fis->d.lbaHigh        = 0xC2;                   /* 0xC2 */
13044         fis->d.device         = 0;                      /* */
13045         fis->d.lbaLowExp      = 0;                      /* */
13046         fis->d.lbaMidExp      = 0;                      /* */
13047         fis->d.lbaHighExp     = 0;                      /* */
13048         fis->d.featuresExp    = 0;                      /* */
13049         fis->d.sectorCount    = 0;                      /* */
13050         fis->d.sectorCountExp = 0;                      /* */
13051         fis->d.reserved4      = 0;
13052         fis->d.control        = 0;                      /* FIS HOB bit clear */
13053         fis->d.reserved5      = 0;
13054
13055         agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
13056
13057         /* Initialize CB for SATA completion.
13058          */
13059         satIOContext->satCompleteCB = &satModeSelect6n10CB;
13060
13061         /*
13062          * Prepare SGL and send FIS to LL layer.
13063          */
13064         satIOContext->reqType = agRequestType;       /* Save it */
13065
13066         status = sataLLIOStart( tiRoot,
13067                                 tiIORequest,
13068                                 tiDeviceHandle,
13069                                 tiScsiRequest,
13070                                 satIOContext);
13071         return status;
13072       }
13073       else
13074       {
13075         TI_DBG5(("satModeSelect10: disable information exceptions reporting\n"));
13076         /* sends SMART DISABLE OPERATIONS */
13077         fis->h.fisType        = 0x27;                   /* Reg host to device */
13078         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
13079
13080         fis->h.command        = SAT_SMART_DISABLE_OPERATIONS;       /* 0xB0 */
13081         fis->h.features       = 0xD9;                   /* disable */
13082         fis->d.lbaLow         = 0;                      /* */
13083         fis->d.lbaMid         = 0x4F;                   /* 0x4F */
13084         fis->d.lbaHigh        = 0xC2;                   /* 0xC2 */
13085         fis->d.device         = 0;                      /* */
13086         fis->d.lbaLowExp      = 0;                      /* */
13087         fis->d.lbaMidExp      = 0;                      /* */
13088         fis->d.lbaHighExp     = 0;                      /* */
13089         fis->d.featuresExp    = 0;                      /* */
13090         fis->d.sectorCount    = 0;                      /* */
13091         fis->d.sectorCountExp = 0;                      /* */
13092         fis->d.reserved4      = 0;
13093         fis->d.control        = 0;                      /* FIS HOB bit clear */
13094         fis->d.reserved5      = 0;
13095
13096         agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
13097
13098         /* Initialize CB for SATA completion.
13099          */
13100         satIOContext->satCompleteCB = &satModeSelect6n10CB;
13101
13102         /*
13103          * Prepare SGL and send FIS to LL layer.
13104          */
13105         satIOContext->reqType = agRequestType;       /* Save it */
13106
13107         status = sataLLIOStart( tiRoot,
13108                                 tiIORequest,
13109                                 tiDeviceHandle,
13110                                 tiScsiRequest,
13111                                 satIOContext);
13112         return status;
13113
13114       }
13115     }
13116     break;
13117   default:
13118     TI_DBG1(("satModeSelect10: Error unknown page code 0x%x\n", pLogPage[12]));
13119     satSetSensePayload( pSense,
13120                         SCSI_SNSKEY_NO_SENSE,
13121                         0,
13122                         SCSI_SNSCODE_NO_ADDITIONAL_INFO,
13123                         satIOContext);
13124
13125     ostiInitiatorIOCompleted( tiRoot,
13126                               tiIORequest,
13127                               tiIOSuccess,
13128                               SCSI_STAT_CHECK_CONDITION,
13129                               satIOContext->pTiSenseData,
13130                               satIOContext->interruptContext );
13131     return tiSuccess;
13132   }
13133
13134 }
13135
13136
13137 /*****************************************************************************/
13138 /*! \brief SAT implementation for SCSI satSynchronizeCache10.
13139  *
13140  *  SAT implementation for SCSI satSynchronizeCache10.
13141  *
13142  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
13143  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
13144  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
13145  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
13146  *  \param   satIOContext_t:   Pointer to the SAT IO Context
13147  *
13148  *  \return If command is started successfully
13149  *    - \e tiSuccess:     I/O request successfully initiated.
13150  *    - \e tiBusy:        No resources available, try again later.
13151  *    - \e tiIONoDevice:  Invalid device handle.
13152  *    - \e tiError:       Other errors.
13153  */
13154 /*****************************************************************************/
13155 GLOBAL bit32  satSynchronizeCache10(
13156                    tiRoot_t                  *tiRoot,
13157                    tiIORequest_t             *tiIORequest,
13158                    tiDeviceHandle_t          *tiDeviceHandle,
13159                    tiScsiInitiatorRequest_t *tiScsiRequest,
13160                    satIOContext_t            *satIOContext)
13161 {
13162   bit32                     status;
13163   bit32                     agRequestType;
13164   satDeviceData_t           *pSatDevData;
13165   scsiRspSense_t            *pSense;
13166   tiIniScsiCmnd_t           *scsiCmnd;
13167   agsaFisRegHostToDevice_t  *fis;
13168
13169   pSense        = satIOContext->pSense;
13170   pSatDevData   = satIOContext->pSatDevData;
13171   scsiCmnd      = &tiScsiRequest->scsiCmnd;
13172   fis           = satIOContext->pFis;
13173
13174   TI_DBG5(("satSynchronizeCache10: start\n"));
13175
13176   /* checking CONTROL */
13177   /* NACA == 1 or LINK == 1*/
13178   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
13179   {
13180     satSetSensePayload( pSense,
13181                         SCSI_SNSKEY_ILLEGAL_REQUEST,
13182                         0,
13183                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
13184                         satIOContext);
13185
13186     ostiInitiatorIOCompleted( tiRoot,
13187                               tiIORequest,
13188                               tiIOSuccess,
13189                               SCSI_STAT_CHECK_CONDITION,
13190                               satIOContext->pTiSenseData,
13191                               satIOContext->interruptContext );
13192
13193     TI_DBG2(("satSynchronizeCache10: return control\n"));
13194     return tiSuccess;
13195   }
13196
13197   /* checking IMMED bit */
13198   if (scsiCmnd->cdb[1] & SCSI_SYNC_CACHE_IMMED_MASK)
13199   {
13200     TI_DBG1(("satSynchronizeCache10: GOOD status due to IMMED bit\n"));
13201
13202     /* return GOOD status first here */
13203     ostiInitiatorIOCompleted( tiRoot,
13204                               tiIORequest,
13205                               tiIOSuccess,
13206                               SCSI_STAT_GOOD,
13207                               agNULL,
13208                               satIOContext->interruptContext);
13209   }
13210
13211   /* sends FLUSH CACHE or FLUSH CACHE EXT */
13212   if (pSatDevData->sat48BitSupport == agTRUE)
13213   {
13214     TI_DBG5(("satSynchronizeCache10: sends FLUSH CACHE EXT\n"));
13215     /* FLUSH CACHE EXT */
13216     fis->h.fisType        = 0x27;                   /* Reg host to device */
13217     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
13218
13219     fis->h.command        = SAT_FLUSH_CACHE_EXT;    /* 0xEA */
13220     fis->h.features       = 0;                      /* FIS reserve */
13221     fis->d.featuresExp    = 0;                      /* FIS reserve */
13222     fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
13223     fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
13224     fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
13225     fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
13226     fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
13227     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
13228     fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
13229     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
13230     fis->d.device         = 0;                      /* FIS DEV is discared in SATA */
13231     fis->d.control        = 0;                      /* FIS HOB bit clear */
13232     fis->d.reserved4      = 0;
13233     fis->d.reserved5      = 0;
13234
13235   }
13236   else
13237   {
13238     TI_DBG5(("satSynchronizeCache10: sends FLUSH CACHE\n"));
13239     /* FLUSH CACHE */
13240     fis->h.fisType        = 0x27;                   /* Reg host to device */
13241     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
13242
13243     fis->h.command        = SAT_FLUSH_CACHE;        /* 0xE7 */
13244     fis->h.features       = 0;                      /* FIS features NA       */
13245     fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
13246     fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
13247     fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
13248     fis->d.lbaLowExp      = 0;
13249     fis->d.lbaMidExp      = 0;
13250     fis->d.lbaHighExp     = 0;
13251     fis->d.featuresExp    = 0;
13252     fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
13253     fis->d.sectorCountExp = 0;
13254     fis->d.device         = 0;                      /* FIS DEV is discared in SATA */
13255     fis->d.control        = 0;                      /* FIS HOB bit clear */
13256     fis->d.reserved4      = 0;
13257     fis->d.reserved5      = 0;
13258
13259   }
13260
13261   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
13262
13263   /* Initialize CB for SATA completion.
13264    */
13265   satIOContext->satCompleteCB = &satSynchronizeCache10n16CB;
13266
13267   /*
13268    * Prepare SGL and send FIS to LL layer.
13269    */
13270   satIOContext->reqType = agRequestType;       /* Save it */
13271
13272   status = sataLLIOStart( tiRoot,
13273                           tiIORequest,
13274                           tiDeviceHandle,
13275                           tiScsiRequest,
13276                           satIOContext);
13277
13278
13279   return (status);
13280 }
13281
13282 /*****************************************************************************/
13283 /*! \brief SAT implementation for SCSI satSynchronizeCache16.
13284  *
13285  *  SAT implementation for SCSI satSynchronizeCache16.
13286  *
13287  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
13288  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
13289  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
13290  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
13291  *  \param   satIOContext_t:   Pointer to the SAT IO Context
13292  *
13293  *  \return If command is started successfully
13294  *    - \e tiSuccess:     I/O request successfully initiated.
13295  *    - \e tiBusy:        No resources available, try again later.
13296  *    - \e tiIONoDevice:  Invalid device handle.
13297  *    - \e tiError:       Other errors.
13298  */
13299 /*****************************************************************************/
13300 GLOBAL bit32  satSynchronizeCache16(
13301                    tiRoot_t                  *tiRoot,
13302                    tiIORequest_t             *tiIORequest,
13303                    tiDeviceHandle_t          *tiDeviceHandle,
13304                    tiScsiInitiatorRequest_t *tiScsiRequest,
13305                    satIOContext_t            *satIOContext)
13306 {
13307   bit32                     status;
13308   bit32                     agRequestType;
13309   satDeviceData_t           *pSatDevData;
13310   scsiRspSense_t            *pSense;
13311   tiIniScsiCmnd_t           *scsiCmnd;
13312   agsaFisRegHostToDevice_t  *fis;
13313
13314   pSense        = satIOContext->pSense;
13315   pSatDevData   = satIOContext->pSatDevData;
13316   scsiCmnd      = &tiScsiRequest->scsiCmnd;
13317   fis           = satIOContext->pFis;
13318
13319   TI_DBG5(("satSynchronizeCache16: start\n"));
13320
13321   /* checking CONTROL */
13322   /* NACA == 1 or LINK == 1*/
13323   if ( (scsiCmnd->cdb[15] & SCSI_NACA_MASK) || (scsiCmnd->cdb[15] & SCSI_LINK_MASK) )
13324   {
13325     satSetSensePayload( pSense,
13326                         SCSI_SNSKEY_ILLEGAL_REQUEST,
13327                         0,
13328                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
13329                         satIOContext);
13330
13331     ostiInitiatorIOCompleted( tiRoot,
13332                               tiIORequest,
13333                               tiIOSuccess,
13334                               SCSI_STAT_CHECK_CONDITION,
13335                               satIOContext->pTiSenseData,
13336                               satIOContext->interruptContext );
13337
13338     TI_DBG1(("satSynchronizeCache16: return control\n"));
13339     return tiSuccess;
13340   }
13341
13342
13343   /* checking IMMED bit */
13344   if (scsiCmnd->cdb[1] & SCSI_SYNC_CACHE_IMMED_MASK)
13345   {
13346     TI_DBG1(("satSynchronizeCache16: GOOD status due to IMMED bit\n"));
13347
13348     /* return GOOD status first here */
13349     ostiInitiatorIOCompleted( tiRoot,
13350                               tiIORequest,
13351                               tiIOSuccess,
13352                               SCSI_STAT_GOOD,
13353                               agNULL,
13354                               satIOContext->interruptContext);
13355   }
13356
13357   /* sends FLUSH CACHE or FLUSH CACHE EXT */
13358   if (pSatDevData->sat48BitSupport == agTRUE)
13359   {
13360     TI_DBG5(("satSynchronizeCache16: sends FLUSH CACHE EXT\n"));
13361     /* FLUSH CACHE EXT */
13362     fis->h.fisType        = 0x27;                   /* Reg host to device */
13363     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
13364
13365     fis->h.command        = SAT_FLUSH_CACHE_EXT;    /* 0xEA */
13366     fis->h.features       = 0;                      /* FIS reserve */
13367     fis->d.featuresExp    = 0;                      /* FIS reserve */
13368     fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
13369     fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
13370     fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
13371     fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
13372     fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
13373     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
13374     fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
13375     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
13376     fis->d.device         = 0;                      /* FIS DEV is discared in SATA */
13377     fis->d.control        = 0;                      /* FIS HOB bit clear */
13378     fis->d.reserved4      = 0;
13379     fis->d.reserved5      = 0;
13380
13381   }
13382   else
13383   {
13384     TI_DBG5(("satSynchronizeCache16: sends FLUSH CACHE\n"));
13385     /* FLUSH CACHE */
13386     fis->h.fisType        = 0x27;                   /* Reg host to device */
13387     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
13388
13389     fis->h.command        = SAT_FLUSH_CACHE;        /* 0xE7 */
13390     fis->h.features       = 0;                      /* FIS features NA       */
13391     fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
13392     fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
13393     fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
13394     fis->d.lbaLowExp      = 0;
13395     fis->d.lbaMidExp      = 0;
13396     fis->d.lbaHighExp     = 0;
13397     fis->d.featuresExp    = 0;
13398     fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
13399     fis->d.sectorCountExp = 0;
13400     fis->d.device         = 0;                      /* FIS DEV is discared in SATA */
13401     fis->d.control        = 0;                      /* FIS HOB bit clear */
13402     fis->d.reserved4      = 0;
13403     fis->d.reserved5      = 0;
13404
13405   }
13406
13407   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
13408
13409   /* Initialize CB for SATA completion.
13410    */
13411   satIOContext->satCompleteCB = &satSynchronizeCache10n16CB;
13412
13413   /*
13414    * Prepare SGL and send FIS to LL layer.
13415    */
13416   satIOContext->reqType = agRequestType;       /* Save it */
13417
13418   status = sataLLIOStart( tiRoot,
13419                           tiIORequest,
13420                           tiDeviceHandle,
13421                           tiScsiRequest,
13422                           satIOContext);
13423
13424
13425   return (status);
13426 }
13427
13428
13429 /*****************************************************************************/
13430 /*! \brief SAT implementation for SCSI satWriteAndVerify10.
13431  *
13432  *  SAT implementation for SCSI satWriteAndVerify10.
13433  *
13434  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
13435  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
13436  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
13437  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
13438  *  \param   satIOContext_t:   Pointer to the SAT IO Context
13439  *
13440  *  \return If command is started successfully
13441  *    - \e tiSuccess:     I/O request successfully initiated.
13442  *    - \e tiBusy:        No resources available, try again later.
13443  *    - \e tiIONoDevice:  Invalid device handle.
13444  *    - \e tiError:       Other errors.
13445  */
13446 /*****************************************************************************/
13447 GLOBAL bit32  satWriteAndVerify10(
13448                    tiRoot_t                  *tiRoot,
13449                    tiIORequest_t             *tiIORequest,
13450                    tiDeviceHandle_t          *tiDeviceHandle,
13451                    tiScsiInitiatorRequest_t *tiScsiRequest,
13452                    satIOContext_t            *satIOContext)
13453 {
13454   /*
13455     combination of write10 and verify10
13456   */
13457
13458   bit32                     status;
13459   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
13460   satDeviceData_t           *pSatDevData;
13461   scsiRspSense_t            *pSense;
13462   tiIniScsiCmnd_t           *scsiCmnd;
13463   agsaFisRegHostToDevice_t  *fis;
13464   bit32                     lba = 0;
13465   bit32                     tl = 0;
13466   bit32                     LoopNum = 1;
13467   bit8                      LBA[4];
13468   bit8                      TL[4];
13469   bit32                     rangeChk = agFALSE; /* lba and tl range check */
13470
13471   pSense        = satIOContext->pSense;
13472   pSatDevData   = satIOContext->pSatDevData;
13473   scsiCmnd      = &tiScsiRequest->scsiCmnd;
13474   fis           = satIOContext->pFis;
13475
13476   TI_DBG5(("satWriteAndVerify10: start\n"));
13477
13478
13479   /* checking BYTCHK bit */
13480   if (scsiCmnd->cdb[1] & SCSI_WRITE_N_VERIFY_BYTCHK_MASK)
13481   {
13482     satSetSensePayload( pSense,
13483                         SCSI_SNSKEY_ILLEGAL_REQUEST,
13484                         0,
13485                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
13486                         satIOContext);
13487
13488     ostiInitiatorIOCompleted( tiRoot,
13489                               tiIORequest,
13490                               tiIOSuccess,
13491                               SCSI_STAT_CHECK_CONDITION,
13492                               satIOContext->pTiSenseData,
13493                               satIOContext->interruptContext );
13494
13495     TI_DBG1(("satWriteAndVerify10: BYTCHK bit checking \n"));
13496     return tiSuccess;
13497   }
13498
13499
13500   /* checking CONTROL */
13501   /* NACA == 1 or LINK == 1*/
13502   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
13503   {
13504     satSetSensePayload( pSense,
13505                         SCSI_SNSKEY_ILLEGAL_REQUEST,
13506                         0,
13507                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
13508                         satIOContext);
13509
13510     ostiInitiatorIOCompleted( tiRoot,
13511                               tiIORequest,
13512                               tiIOSuccess,
13513                               SCSI_STAT_CHECK_CONDITION,
13514                               satIOContext->pTiSenseData,
13515                               satIOContext->interruptContext );
13516
13517     TI_DBG1(("satWriteAndVerify10: return control\n"));
13518     return tiSuccess;
13519   }
13520
13521   osti_memset(LBA, 0, sizeof(LBA));
13522   osti_memset(TL, 0, sizeof(TL));
13523
13524   /* do not use memcpy due to indexing in LBA and TL */
13525   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
13526   LBA[1] = scsiCmnd->cdb[3];
13527   LBA[2] = scsiCmnd->cdb[4];
13528   LBA[3] = scsiCmnd->cdb[5];  /* LSB */
13529
13530   TL[0] = 0;
13531   TL[1] = 0;
13532   TL[2] = scsiCmnd->cdb[7];  /* MSB */
13533   TL[3] = scsiCmnd->cdb[8];  /* LSB */
13534
13535   rangeChk = satAddNComparebit32(LBA, TL);
13536
13537   /* cbd10; computing LBA and transfer length */
13538   lba = (scsiCmnd->cdb[2] << (8*3)) + (scsiCmnd->cdb[3] << (8*2))
13539     + (scsiCmnd->cdb[4] << 8) + scsiCmnd->cdb[5];
13540   tl = (scsiCmnd->cdb[7] << 8) + scsiCmnd->cdb[8];
13541
13542
13543   /* Table 34, 9.1, p 46 */
13544   /*
13545     note: As of 2/10/2006, no support for DMA QUEUED
13546    */
13547
13548   /*
13549     Table 34, 9.1, p 46, b
13550     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
13551     return check condition
13552   */
13553   if (pSatDevData->satNCQ != agTRUE &&
13554       pSatDevData->sat48BitSupport != agTRUE
13555       )
13556   {
13557     if (lba > SAT_TR_LBA_LIMIT - 1)
13558     {
13559       satSetSensePayload( pSense,
13560                           SCSI_SNSKEY_ILLEGAL_REQUEST,
13561                           0,
13562                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
13563                           satIOContext);
13564
13565       ostiInitiatorIOCompleted( tiRoot,
13566                                 tiIORequest,
13567                                 tiIOSuccess,
13568                                 SCSI_STAT_CHECK_CONDITION,
13569                                 satIOContext->pTiSenseData,
13570                                 satIOContext->interruptContext );
13571
13572     TI_DBG1(("satWriteAndVerify10: return LBA out of range\n"));
13573     return tiSuccess;
13574     }
13575
13576     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
13577     {
13578       TI_DBG1(("satWrite10: return LBA+TL out of range, not EXT\n"));
13579       satSetSensePayload( pSense,
13580                           SCSI_SNSKEY_ILLEGAL_REQUEST,
13581                           0,
13582                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
13583                           satIOContext);
13584
13585       ostiInitiatorIOCompleted( tiRoot,
13586                                 tiIORequest,
13587                                 tiIOSuccess,
13588                                 SCSI_STAT_CHECK_CONDITION,
13589                                 satIOContext->pTiSenseData,
13590                                 satIOContext->interruptContext );
13591
13592     return tiSuccess;
13593     }
13594   }
13595
13596
13597   /* case 1 and 2 */
13598   if (!rangeChk) //  if (lba + tl <= SAT_TR_LBA_LIMIT)
13599   {
13600     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
13601     {
13602       /* case 2 */
13603       /* WRITE DMA*/
13604       /* can't fit the transfer length */
13605       TI_DBG5(("satWriteAndVerify10: case 2 !!!\n"));
13606       fis->h.fisType        = 0x27;                   /* Reg host to device */
13607       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
13608       fis->h.command        = SAT_WRITE_DMA;          /* 0xCA */
13609       fis->h.features       = 0;                      /* FIS reserve */
13610       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
13611       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
13612       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
13613
13614       /* FIS LBA mode set LBA (27:24) */
13615       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));
13616
13617       fis->d.lbaLowExp      = 0;
13618       fis->d.lbaMidExp      = 0;
13619       fis->d.lbaHighExp     = 0;
13620       fis->d.featuresExp    = 0;
13621       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
13622       fis->d.sectorCountExp = 0;
13623       fis->d.reserved4      = 0;
13624       fis->d.control        = 0;                      /* FIS HOB bit clear */
13625       fis->d.reserved5      = 0;
13626
13627       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
13628       satIOContext->ATACmd = SAT_WRITE_DMA;
13629     }
13630     else
13631     {
13632       /* case 1 */
13633       /* WRITE MULTIPLE or WRITE SECTOR(S) */
13634       /* WRITE SECTORS for easier implemetation */
13635       /* can't fit the transfer length */
13636       TI_DBG5(("satWriteAndVerify10: case 1 !!!\n"));
13637       fis->h.fisType        = 0x27;                   /* Reg host to device */
13638       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
13639       fis->h.command        = SAT_WRITE_SECTORS;      /* 0x30 */
13640       fis->h.features       = 0;                      /* FIS reserve */
13641       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
13642       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
13643       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
13644
13645       /* FIS LBA mode set LBA (27:24) */
13646       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));
13647
13648       fis->d.lbaLowExp      = 0;
13649       fis->d.lbaMidExp      = 0;
13650       fis->d.lbaHighExp     = 0;
13651       fis->d.featuresExp    = 0;
13652       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
13653       fis->d.sectorCountExp = 0;
13654       fis->d.reserved4      = 0;
13655       fis->d.control        = 0;                      /* FIS HOB bit clear */
13656       fis->d.reserved5      = 0;
13657
13658       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
13659       satIOContext->ATACmd = SAT_WRITE_SECTORS;
13660
13661     }
13662   }
13663
13664   /* case 3 and 4 */
13665   if (pSatDevData->sat48BitSupport == agTRUE)
13666   {
13667     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
13668     {
13669       /* case 3 */
13670       /* WRITE DMA EXT or WRITE DMA FUA EXT */
13671       TI_DBG5(("satWriteAndVerify10: case 3\n"));
13672       fis->h.fisType        = 0x27;                   /* Reg host to device */
13673       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
13674
13675       /* SAT_WRITE_DMA_FUA_EXT is optional and we don't support it */
13676       fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x35 */
13677
13678       fis->h.features       = 0;                      /* FIS reserve */
13679       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
13680       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
13681       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
13682       fis->d.device         = 0x40;                   /* FIS LBA mode set */
13683       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
13684       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
13685       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
13686       fis->d.featuresExp    = 0;                      /* FIS reserve */
13687       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
13688       fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
13689       fis->d.reserved4      = 0;
13690       fis->d.control        = 0;                      /* FIS HOB bit clear */
13691       fis->d.reserved5      = 0;
13692
13693       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
13694       satIOContext->ATACmd = SAT_WRITE_DMA_EXT;
13695     }
13696     else
13697     {
13698       /* case 4 */
13699       /* WRITE MULTIPLE EXT or WRITE MULTIPLE FUA EXT or WRITE SECTOR(S) EXT */
13700       /* WRITE SECTORS EXT for easier implemetation */
13701       TI_DBG5(("satWriteAndVerify10: case 4\n"));
13702       fis->h.fisType        = 0x27;                   /* Reg host to device */
13703       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
13704       fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
13705
13706       fis->h.features       = 0;                      /* FIS reserve */
13707       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
13708       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
13709       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
13710       fis->d.device         = 0x40;                   /* FIS LBA mode set */
13711       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
13712       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
13713       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
13714       fis->d.featuresExp    = 0;                      /* FIS reserve */
13715       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
13716       fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
13717       fis->d.reserved4      = 0;
13718       fis->d.control        = 0;                      /* FIS HOB bit clear */
13719       fis->d.reserved5      = 0;
13720
13721       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
13722       satIOContext->ATACmd = SAT_WRITE_SECTORS_EXT;
13723     }
13724   }
13725   /* case 5 */
13726   if (pSatDevData->satNCQ == agTRUE)
13727   {
13728     /* WRITE FPDMA QUEUED */
13729     if (pSatDevData->sat48BitSupport != agTRUE)
13730     {
13731       TI_DBG5(("satWriteAndVerify10: case 5 !!! error NCQ but 28 bit address support \n"));
13732       satSetSensePayload( pSense,
13733                           SCSI_SNSKEY_ILLEGAL_REQUEST,
13734                           0,
13735                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
13736                           satIOContext);
13737
13738       ostiInitiatorIOCompleted( tiRoot,
13739                                 tiIORequest,
13740                                 tiIOSuccess,
13741                                 SCSI_STAT_CHECK_CONDITION,
13742                                 satIOContext->pTiSenseData,
13743                                 satIOContext->interruptContext );
13744       return tiSuccess;
13745     }
13746     TI_DBG5(("satWriteAndVerify10: case 5\n"));
13747
13748     /* Support 48-bit FPDMA addressing, use WRITE FPDMA QUEUE command */
13749
13750     fis->h.fisType        = 0x27;                   /* Reg host to device */
13751     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
13752     fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
13753     fis->h.features       = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
13754     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
13755     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
13756     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
13757
13758     /* Check FUA bit */
13759     if (scsiCmnd->cdb[1] & SCSI_WRITE_N_VERIFY10_FUA_MASK)
13760       fis->d.device       = 0xC0;                   /* FIS FUA set */
13761     else
13762       fis->d.device       = 0x40;                   /* FIS FUA clear */
13763
13764     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
13765     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
13766     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
13767     fis->d.featuresExp    = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
13768     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
13769     fis->d.sectorCountExp = 0;
13770     fis->d.reserved4      = 0;
13771     fis->d.control        = 0;                      /* FIS HOB bit clear */
13772     fis->d.reserved5      = 0;
13773
13774     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
13775     satIOContext->ATACmd = SAT_WRITE_FPDMA_QUEUED;
13776   }
13777
13778   satIOContext->currentLBA = lba;
13779   satIOContext->OrgTL = tl;
13780
13781   /*
13782     computing number of loop and remainder for tl
13783     0xFF in case not ext
13784     0xFFFF in case EXT
13785   */
13786   if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
13787   {
13788     LoopNum = satComputeLoopNum(tl, 0xFF);
13789   }
13790   else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
13791            fis->h.command == SAT_WRITE_DMA_EXT     ||
13792            fis->h.command == SAT_WRITE_DMA_FUA_EXT
13793            )
13794   {
13795     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
13796     LoopNum = satComputeLoopNum(tl, 0xFFFF);
13797   }
13798   else
13799   {
13800     /* SAT_WRITE_FPDMA_QUEUED */
13801     LoopNum = satComputeLoopNum(tl, 0xFFFF);
13802   }
13803
13804   satIOContext->LoopNum = LoopNum;
13805
13806
13807   if (LoopNum == 1)
13808   {
13809     TI_DBG5(("satWriteAndVerify10: NON CHAINED data\n"));
13810     /* Initialize CB for SATA completion.
13811      */
13812     satIOContext->satCompleteCB = &satNonChainedWriteNVerifyCB;
13813   }
13814   else
13815   {
13816     TI_DBG1(("satWriteAndVerify10: CHAINED data\n"));
13817     /* re-setting tl */
13818     if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
13819     {
13820        fis->d.sectorCount    = 0xFF;
13821     }
13822     else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
13823              fis->h.command == SAT_WRITE_DMA_EXT ||
13824              fis->h.command == SAT_WRITE_DMA_FUA_EXT
13825              )
13826     {
13827       fis->d.sectorCount    = 0xFF;
13828       fis->d.sectorCountExp = 0xFF;
13829     }
13830     else
13831     {
13832       /* SAT_WRITE_FPDMA_QUEUED */
13833       fis->h.features       = 0xFF;
13834       fis->d.featuresExp    = 0xFF;
13835     }
13836
13837     /* Initialize CB for SATA completion.
13838      */
13839     satIOContext->satCompleteCB = &satChainedWriteNVerifyCB;
13840   }
13841
13842
13843   /*
13844    * Prepare SGL and send FIS to LL layer.
13845    */
13846   satIOContext->reqType = agRequestType;       /* Save it */
13847
13848   status = sataLLIOStart( tiRoot,
13849                           tiIORequest,
13850                           tiDeviceHandle,
13851                           tiScsiRequest,
13852                           satIOContext);
13853   return (status);
13854
13855 }
13856
13857
13858
13859
13860
13861
13862 #ifdef REMOVED
13863 GLOBAL bit32  satWriteAndVerify10(
13864                    tiRoot_t                  *tiRoot,
13865                    tiIORequest_t             *tiIORequest,
13866                    tiDeviceHandle_t          *tiDeviceHandle,
13867                    tiScsiInitiatorRequest_t *tiScsiRequest,
13868                    satIOContext_t            *satIOContext)
13869 {
13870   /*
13871     combination of write10 and verify10
13872   */
13873
13874   bit32                     status;
13875   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
13876   satDeviceData_t           *pSatDevData;
13877   scsiRspSense_t            *pSense;
13878   tiIniScsiCmnd_t           *scsiCmnd;
13879   agsaFisRegHostToDevice_t  *fis;
13880   bit32                     lba = 0;
13881   bit32                     tl = 0;
13882
13883   pSense        = satIOContext->pSense;
13884   pSatDevData   = satIOContext->pSatDevData;
13885   scsiCmnd      = &tiScsiRequest->scsiCmnd;
13886   fis           = satIOContext->pFis;
13887
13888   TI_DBG5(("satWriteAndVerify10: start\n"));
13889
13890
13891   /* checking BYTCHK bit */
13892   if (scsiCmnd->cdb[1] & SCSI_WRITE_N_VERIFY_BYTCHK_MASK)
13893   {
13894     satSetSensePayload( pSense,
13895                         SCSI_SNSKEY_ILLEGAL_REQUEST,
13896                         0,
13897                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
13898                         satIOContext);
13899
13900     ostiInitiatorIOCompleted( tiRoot,
13901                               tiIORequest,
13902                               tiIOSuccess,
13903                               SCSI_STAT_CHECK_CONDITION,
13904                               satIOContext->pTiSenseData,
13905                               satIOContext->interruptContext );
13906
13907     TI_DBG1(("satWriteAndVerify10: BYTCHK bit checking \n"));
13908     return tiSuccess;
13909   }
13910
13911
13912   /* checking CONTROL */
13913   /* NACA == 1 or LINK == 1*/
13914   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
13915   {
13916     satSetSensePayload( pSense,
13917                         SCSI_SNSKEY_ILLEGAL_REQUEST,
13918                         0,
13919                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
13920                         satIOContext);
13921
13922     ostiInitiatorIOCompleted( tiRoot,
13923                               tiIORequest,
13924                               tiIOSuccess,
13925                               SCSI_STAT_CHECK_CONDITION,
13926                               satIOContext->pTiSenseData,
13927                               satIOContext->interruptContext );
13928
13929     TI_DBG2(("satWriteAndVerify10: return control\n"));
13930     return tiSuccess;
13931   }
13932
13933   /* let's do write10 */
13934   if ( pSatDevData->sat48BitSupport != agTRUE )
13935   {
13936     /*
13937       writeandverify10 but no support for 48 bit addressing -> problem in transfer
13938       length(sector count)
13939     */
13940     satSetSensePayload( pSense,
13941                         SCSI_SNSKEY_ILLEGAL_REQUEST,
13942                         0,
13943                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
13944                         satIOContext);
13945
13946     ostiInitiatorIOCompleted( tiRoot,
13947                               tiIORequest,
13948                               tiIOSuccess,
13949                               SCSI_STAT_CHECK_CONDITION,
13950                               satIOContext->pTiSenseData,
13951                               satIOContext->interruptContext );
13952
13953     TI_DBG1(("satWriteAndVerify10: return internal checking\n"));
13954     return tiSuccess;
13955   }
13956
13957   /* cbd10; computing LBA and transfer length */
13958   lba = (scsiCmnd->cdb[2] << (8*3)) + (scsiCmnd->cdb[3] << (8*2))
13959     + (scsiCmnd->cdb[4] << 8) + scsiCmnd->cdb[5];
13960   tl = (scsiCmnd->cdb[7] << 8) + scsiCmnd->cdb[8];
13961
13962
13963   /* Table 34, 9.1, p 46 */
13964   /*
13965     note: As of 2/10/2006, no support for DMA QUEUED
13966    */
13967
13968   /*
13969     Table 34, 9.1, p 46, b
13970     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
13971     return check condition
13972   */
13973   if (pSatDevData->satNCQ != agTRUE &&
13974       pSatDevData->sat48BitSupport != agTRUE
13975       )
13976   {
13977     if (lba > SAT_TR_LBA_LIMIT - 1)
13978     {
13979       satSetSensePayload( pSense,
13980                           SCSI_SNSKEY_ILLEGAL_REQUEST,
13981                           0,
13982                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
13983                           satIOContext);
13984
13985       ostiInitiatorIOCompleted( tiRoot,
13986                                 tiIORequest,
13987                                 tiIOSuccess,
13988                                 SCSI_STAT_CHECK_CONDITION,
13989                                 satIOContext->pTiSenseData,
13990                                 satIOContext->interruptContext );
13991
13992     TI_DBG1(("satWriteAndVerify10: return LBA out of range\n"));
13993     return tiSuccess;
13994     }
13995   }
13996
13997
13998   /* case 1 and 2 */
13999   if (lba + tl <= SAT_TR_LBA_LIMIT)
14000   {
14001     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
14002     {
14003       /* case 2 */
14004       /* WRITE DMA*/
14005       /* can't fit the transfer length */
14006       TI_DBG5(("satWriteAndVerify10: case 2 !!!\n"));
14007       fis->h.fisType        = 0x27;                   /* Reg host to device */
14008       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
14009       fis->h.command        = SAT_WRITE_DMA;          /* 0xCA */
14010       fis->h.features       = 0;                      /* FIS reserve */
14011       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14012       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14013       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14014
14015       /* FIS LBA mode set LBA (27:24) */
14016       fis->d.device         = (0x4 << 4) | (scsiCmnd->cdb[2] & 0xF);
14017
14018       fis->d.lbaLowExp      = 0;
14019       fis->d.lbaMidExp      = 0;
14020       fis->d.lbaHighExp     = 0;
14021       fis->d.featuresExp    = 0;
14022       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
14023       fis->d.sectorCountExp = 0;
14024       fis->d.reserved4      = 0;
14025       fis->d.control        = 0;                      /* FIS HOB bit clear */
14026       fis->d.reserved5      = 0;
14027
14028       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
14029       satIOContext->ATACmd = SAT_WRITE_DMA;
14030     }
14031     else
14032     {
14033       /* case 1 */
14034       /* WRITE MULTIPLE or WRITE SECTOR(S) */
14035       /* WRITE SECTORS for easier implemetation */
14036       /* can't fit the transfer length */
14037       TI_DBG5(("satWriteAndVerify10: case 1 !!!\n"));
14038       fis->h.fisType        = 0x27;                   /* Reg host to device */
14039       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
14040       fis->h.command        = SAT_WRITE_SECTORS;      /* 0x30 */
14041       fis->h.features       = 0;                      /* FIS reserve */
14042       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14043       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14044       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14045
14046       /* FIS LBA mode set LBA (27:24) */
14047       fis->d.device         = (0x4 << 4) | (scsiCmnd->cdb[2] & 0xF);
14048
14049       fis->d.lbaLowExp      = 0;
14050       fis->d.lbaMidExp      = 0;
14051       fis->d.lbaHighExp     = 0;
14052       fis->d.featuresExp    = 0;
14053       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
14054       fis->d.sectorCountExp = 0;
14055       fis->d.reserved4      = 0;
14056       fis->d.control        = 0;                      /* FIS HOB bit clear */
14057       fis->d.reserved5      = 0;
14058
14059       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
14060       satIOContext->ATACmd = SAT_WRITE_SECTORS;
14061
14062     }
14063   }
14064
14065   /* case 3 and 4 */
14066   if (pSatDevData->sat48BitSupport == agTRUE)
14067   {
14068     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
14069     {
14070       /* case 3 */
14071       /* WRITE DMA EXT or WRITE DMA FUA EXT */
14072       TI_DBG5(("satWriteAndVerify10: case 3\n"));
14073       fis->h.fisType        = 0x27;                   /* Reg host to device */
14074       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
14075
14076       /* SAT_WRITE_DMA_FUA_EXT is optional and we don't support it */
14077       fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x35 */
14078
14079       fis->h.features       = 0;                      /* FIS reserve */
14080       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14081       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14082       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14083       fis->d.device         = 0x40;                   /* FIS LBA mode set */
14084       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
14085       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
14086       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
14087       fis->d.featuresExp    = 0;                      /* FIS reserve */
14088       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
14089       fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
14090       fis->d.reserved4      = 0;
14091       fis->d.control        = 0;                      /* FIS HOB bit clear */
14092       fis->d.reserved5      = 0;
14093
14094       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
14095     }
14096     else
14097     {
14098       /* case 4 */
14099       /* WRITE MULTIPLE EXT or WRITE MULTIPLE FUA EXT or WRITE SECTOR(S) EXT */
14100       /* WRITE SECTORS EXT for easier implemetation */
14101       TI_DBG5(("satWriteAndVerify10: case 4\n"));
14102       fis->h.fisType        = 0x27;                   /* Reg host to device */
14103       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
14104       fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
14105
14106       fis->h.features       = 0;                      /* FIS reserve */
14107       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14108       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14109       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14110       fis->d.device         = 0x40;                   /* FIS LBA mode set */
14111       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
14112       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
14113       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
14114       fis->d.featuresExp    = 0;                      /* FIS reserve */
14115       fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
14116       fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
14117       fis->d.reserved4      = 0;
14118       fis->d.control        = 0;                      /* FIS HOB bit clear */
14119       fis->d.reserved5      = 0;
14120
14121       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
14122     }
14123   }
14124   /* case 5 */
14125   if (pSatDevData->satNCQ == agTRUE)
14126   {
14127     /* WRITE FPDMA QUEUED */
14128     if (pSatDevData->sat48BitSupport != agTRUE)
14129     {
14130       TI_DBG5(("satWriteAndVerify10: case 5 !!! error NCQ but 28 bit address support \n"));
14131       satSetSensePayload( pSense,
14132                           SCSI_SNSKEY_ILLEGAL_REQUEST,
14133                           0,
14134                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
14135                           satIOContext);
14136
14137       ostiInitiatorIOCompleted( tiRoot,
14138                                 tiIORequest,
14139                                 tiIOSuccess,
14140                                 SCSI_STAT_CHECK_CONDITION,
14141                                 satIOContext->pTiSenseData,
14142                                 satIOContext->interruptContext );
14143       return tiSuccess;
14144     }
14145     TI_DBG5(("satWriteAndVerify10: case 5\n"));
14146
14147     /* Support 48-bit FPDMA addressing, use WRITE FPDMA QUEUE command */
14148
14149     fis->h.fisType        = 0x27;                   /* Reg host to device */
14150     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
14151     fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
14152     fis->h.features       = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
14153     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14154     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14155     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14156
14157     /* Check FUA bit */
14158     if (scsiCmnd->cdb[1] & SCSI_WRITE_N_VERIFY10_FUA_MASK)
14159       fis->d.device       = 0xC0;                   /* FIS FUA set */
14160     else
14161       fis->d.device       = 0x40;                   /* FIS FUA clear */
14162
14163     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
14164     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
14165     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
14166     fis->d.featuresExp    = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
14167     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
14168     fis->d.sectorCountExp = 0;
14169     fis->d.reserved4      = 0;
14170     fis->d.control        = 0;                      /* FIS HOB bit clear */
14171     fis->d.reserved5      = 0;
14172
14173     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
14174   }
14175
14176   /* Initialize CB for SATA completion.
14177    */
14178   satIOContext->satCompleteCB = &satWriteAndVerify10CB;
14179
14180   /*
14181    * Prepare SGL and send FIS to LL layer.
14182    */
14183   satIOContext->reqType = agRequestType;       /* Save it */
14184
14185   status = sataLLIOStart( tiRoot,
14186                           tiIORequest,
14187                           tiDeviceHandle,
14188                           tiScsiRequest,
14189                           satIOContext);
14190   return (status);
14191
14192 }
14193 #endif /* REMOVED */
14194
14195 #ifdef REMOVED
14196 /*****************************************************************************/
14197 /*! \brief SAT implementation for SCSI satWriteAndVerify10_1.
14198  *
14199  *  SAT implementation for SCSI satWriteAndVerify10_1.
14200  *  Sub function of satWriteAndVerify10
14201  *
14202  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
14203  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
14204  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
14205  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
14206  *  \param   satIOContext_t:   Pointer to the SAT IO Context
14207  *
14208  *  \return If command is started successfully
14209  *    - \e tiSuccess:     I/O request successfully initiated.
14210  *    - \e tiBusy:        No resources available, try again later.
14211  *    - \e tiIONoDevice:  Invalid device handle.
14212  *    - \e tiError:       Other errors.
14213  */
14214 /*****************************************************************************/
14215 GLOBAL bit32  satWriteAndVerify10_1(
14216                    tiRoot_t                  *tiRoot,
14217                    tiIORequest_t             *tiIORequest,
14218                    tiDeviceHandle_t          *tiDeviceHandle,
14219                    tiScsiInitiatorRequest_t *tiScsiRequest,
14220                    satIOContext_t            *satIOContext)
14221 {
14222   bit32                     status;
14223   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
14224   satDeviceData_t           *pSatDevData;
14225   scsiRspSense_t            *pSense;
14226   tiIniScsiCmnd_t           *scsiCmnd;
14227   agsaFisRegHostToDevice_t  *fis;
14228
14229   pSense        = satIOContext->pSense;
14230   pSatDevData   = satIOContext->pSatDevData;
14231   scsiCmnd      = &tiScsiRequest->scsiCmnd;
14232   fis           = satIOContext->pFis;
14233
14234   TI_DBG5(("satWriteAndVerify10_1: start\n"));
14235
14236   if (pSatDevData->sat48BitSupport == agTRUE)
14237   {
14238     fis->h.fisType        = 0x27;                   /* Reg host to device */
14239     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
14240
14241     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
14242     fis->h.features       = 0;                      /* FIS reserve */
14243     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14244     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14245     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14246     fis->d.device         = 0x40;                   /* FIS LBA mode set 01000000 */
14247     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
14248     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
14249     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
14250     fis->d.featuresExp    = 0;                      /* FIS reserve */
14251     fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
14252     fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
14253
14254     fis->d.reserved4      = 0;
14255     fis->d.control        = 0;                      /* FIS HOB bit clear */
14256     fis->d.reserved5      = 0;
14257
14258     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
14259
14260     /* Initialize CB for SATA completion.
14261      */
14262     satIOContext->satCompleteCB = &satWriteAndVerify10CB;
14263
14264     /*
14265      * Prepare SGL and send FIS to LL layer.
14266      */
14267     satIOContext->reqType = agRequestType;       /* Save it */
14268
14269     status = sataLLIOStart( tiRoot,
14270                             tiIORequest,
14271                             tiDeviceHandle,
14272                             tiScsiRequest,
14273                             satIOContext);
14274
14275
14276     TI_DBG1(("satWriteAndVerify10_1: return status %d\n", status));
14277     return (status);
14278   }
14279   else
14280   {
14281     /* can't fit in SAT_READ_VERIFY_SECTORS becasue of Sector Count and LBA */
14282     TI_DBG1(("satWriteAndVerify10_1: can't fit in SAT_READ_VERIFY_SECTORS\n"));
14283     return tiError;
14284   }
14285
14286
14287   return tiSuccess;
14288 }
14289 #endif /* REMOVED */
14290
14291 /*****************************************************************************/
14292 /*! \brief SAT implementation for SCSI satWriteAndVerify12.
14293  *
14294  *  SAT implementation for SCSI satWriteAndVerify12.
14295  *
14296  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
14297  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
14298  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
14299  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
14300  *  \param   satIOContext_t:   Pointer to the SAT IO Context
14301  *
14302  *  \return If command is started successfully
14303  *    - \e tiSuccess:     I/O request successfully initiated.
14304  *    - \e tiBusy:        No resources available, try again later.
14305  *    - \e tiIONoDevice:  Invalid device handle.
14306  *    - \e tiError:       Other errors.
14307  */
14308 /*****************************************************************************/
14309 GLOBAL bit32  satWriteAndVerify12(
14310                    tiRoot_t                  *tiRoot,
14311                    tiIORequest_t             *tiIORequest,
14312                    tiDeviceHandle_t          *tiDeviceHandle,
14313                    tiScsiInitiatorRequest_t *tiScsiRequest,
14314                    satIOContext_t            *satIOContext)
14315 {
14316   /*
14317     combination of write12 and verify12
14318     temp: since write12 is not support (due to internal checking), no support
14319   */
14320   bit32                     status;
14321   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
14322   satDeviceData_t           *pSatDevData;
14323   scsiRspSense_t            *pSense;
14324   tiIniScsiCmnd_t           *scsiCmnd;
14325   agsaFisRegHostToDevice_t  *fis;
14326   bit32                     lba = 0;
14327   bit32                     tl = 0;
14328   bit32                     LoopNum = 1;
14329   bit8                      LBA[4];
14330   bit8                      TL[4];
14331   bit32                     rangeChk = agFALSE; /* lba and tl range check */
14332
14333   pSense        = satIOContext->pSense;
14334   pSatDevData   = satIOContext->pSatDevData;
14335   scsiCmnd      = &tiScsiRequest->scsiCmnd;
14336   fis           = satIOContext->pFis;
14337
14338   TI_DBG5(("satWriteAndVerify12: start\n"));
14339
14340   /* checking BYTCHK bit */
14341   if (scsiCmnd->cdb[1] & SCSI_WRITE_N_VERIFY_BYTCHK_MASK)
14342   {
14343     satSetSensePayload( pSense,
14344                         SCSI_SNSKEY_ILLEGAL_REQUEST,
14345                         0,
14346                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
14347                         satIOContext);
14348
14349     ostiInitiatorIOCompleted( tiRoot,
14350                               tiIORequest,
14351                               tiIOSuccess,
14352                               SCSI_STAT_CHECK_CONDITION,
14353                               satIOContext->pTiSenseData,
14354                               satIOContext->interruptContext );
14355
14356     TI_DBG1(("satWriteAndVerify12: BYTCHK bit checking \n"));
14357     return tiSuccess;
14358   }
14359
14360   /* checking CONTROL */
14361   /* NACA == 1 or LINK == 1*/
14362   if ( (scsiCmnd->cdb[11] & SCSI_NACA_MASK) || (scsiCmnd->cdb[11] & SCSI_LINK_MASK) )
14363   {
14364     satSetSensePayload( pSense,
14365                         SCSI_SNSKEY_ILLEGAL_REQUEST,
14366                         0,
14367                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
14368                         satIOContext);
14369
14370     ostiInitiatorIOCompleted( tiRoot,
14371                               tiIORequest,
14372                               tiIOSuccess,
14373                               SCSI_STAT_CHECK_CONDITION,
14374                               satIOContext->pTiSenseData,
14375                               satIOContext->interruptContext );
14376
14377     TI_DBG2(("satWriteAndVerify12: return control\n"));
14378     return tiSuccess;
14379   }
14380
14381   osti_memset(LBA, 0, sizeof(LBA));
14382   osti_memset(TL, 0, sizeof(TL));
14383
14384   /* do not use memcpy due to indexing in LBA and TL */
14385   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
14386   LBA[1] = scsiCmnd->cdb[3];
14387   LBA[2] = scsiCmnd->cdb[4];
14388   LBA[3] = scsiCmnd->cdb[5];  /* LSB */
14389
14390   TL[0] = scsiCmnd->cdb[6];   /* MSB */
14391   TL[1] = scsiCmnd->cdb[7];
14392   TL[2] = scsiCmnd->cdb[7];
14393   TL[3] = scsiCmnd->cdb[8];   /* LSB */
14394
14395   rangeChk = satAddNComparebit32(LBA, TL);
14396
14397   lba = satComputeCDB12LBA(satIOContext);
14398   tl = satComputeCDB12TL(satIOContext);
14399
14400
14401   /* Table 34, 9.1, p 46 */
14402   /*
14403     note: As of 2/10/2006, no support for DMA QUEUED
14404    */
14405
14406   /*
14407     Table 34, 9.1, p 46, b
14408     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
14409     return check condition
14410   */
14411   if (pSatDevData->satNCQ != agTRUE &&
14412       pSatDevData->sat48BitSupport != agTRUE
14413       )
14414   {
14415     if (lba > SAT_TR_LBA_LIMIT - 1)
14416     {
14417       satSetSensePayload( pSense,
14418                           SCSI_SNSKEY_ILLEGAL_REQUEST,
14419                           0,
14420                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
14421                           satIOContext);
14422
14423       ostiInitiatorIOCompleted( tiRoot,
14424                                 tiIORequest,
14425                                 tiIOSuccess,
14426                                 SCSI_STAT_CHECK_CONDITION,
14427                                 satIOContext->pTiSenseData,
14428                                 satIOContext->interruptContext );
14429
14430     TI_DBG1(("satWriteAndVerify12: return LBA out of range, not EXT\n"));
14431     return tiSuccess;
14432     }
14433
14434     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
14435     {
14436       TI_DBG1(("satWriteAndVerify12: return LBA+TL out of range, not EXT\n"));
14437       satSetSensePayload( pSense,
14438                           SCSI_SNSKEY_ILLEGAL_REQUEST,
14439                           0,
14440                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
14441                           satIOContext);
14442
14443       ostiInitiatorIOCompleted( tiRoot,
14444                                 tiIORequest,
14445                                 tiIOSuccess,
14446                                 SCSI_STAT_CHECK_CONDITION,
14447                                 satIOContext->pTiSenseData,
14448                                 satIOContext->interruptContext );
14449
14450     return tiSuccess;
14451     }
14452   }
14453
14454   /* case 1 and 2 */
14455   if (!rangeChk) //  if (lba + tl <= SAT_TR_LBA_LIMIT)
14456   {
14457     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
14458     {
14459       /* case 2 */
14460       /* WRITE DMA*/
14461       /* In case that we can't fit the transfer length, we loop */
14462       TI_DBG5(("satWriteAndVerify12: case 2\n"));
14463       fis->h.fisType        = 0x27;                   /* Reg host to device */
14464       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
14465       fis->h.command        = SAT_WRITE_DMA;          /* 0xCA */
14466       fis->h.features       = 0;                      /* FIS reserve */
14467       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14468       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14469       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14470
14471       /* FIS LBA mode set LBA (27:24) */
14472       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));
14473
14474       fis->d.lbaLowExp      = 0;
14475       fis->d.lbaMidExp      = 0;
14476       fis->d.lbaHighExp     = 0;
14477       fis->d.featuresExp    = 0;
14478       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
14479       fis->d.sectorCountExp = 0;
14480       fis->d.reserved4      = 0;
14481       fis->d.control        = 0;                      /* FIS HOB bit clear */
14482       fis->d.reserved5      = 0;
14483
14484       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
14485       satIOContext->ATACmd = SAT_WRITE_DMA;
14486     }
14487     else
14488     {
14489       /* case 1 */
14490       /* WRITE MULTIPLE or WRITE SECTOR(S) */
14491       /* WRITE SECTORS for easier implemetation */
14492       /* In case that we can't fit the transfer length, we loop */
14493       TI_DBG5(("satWriteAndVerify12: case 1\n"));
14494       fis->h.fisType        = 0x27;                   /* Reg host to device */
14495       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
14496       fis->h.command        = SAT_WRITE_SECTORS;      /* 0x30 */
14497       fis->h.features       = 0;                      /* FIS reserve */
14498       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14499       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14500       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14501
14502       /* FIS LBA mode set LBA (27:24) */
14503       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));
14504
14505       fis->d.lbaLowExp      = 0;
14506       fis->d.lbaMidExp      = 0;
14507       fis->d.lbaHighExp     = 0;
14508       fis->d.featuresExp    = 0;
14509       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
14510       fis->d.sectorCountExp = 0;
14511       fis->d.reserved4      = 0;
14512       fis->d.control        = 0;                      /* FIS HOB bit clear */
14513       fis->d.reserved5      = 0;
14514
14515       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
14516       satIOContext->ATACmd = SAT_WRITE_SECTORS;
14517     }
14518   }
14519
14520   /* case 3 and 4 */
14521   if (pSatDevData->sat48BitSupport == agTRUE)
14522   {
14523     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
14524     {
14525       /* case 3 */
14526       /* WRITE DMA EXT or WRITE DMA FUA EXT */
14527       TI_DBG5(("satWriteAndVerify12: case 3\n"));
14528       fis->h.fisType        = 0x27;                   /* Reg host to device */
14529       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
14530
14531       /* SAT_WRITE_DMA_FUA_EXT is optional and we don't support it */
14532       fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x35 */
14533
14534       fis->h.features       = 0;                      /* FIS reserve */
14535       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14536       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14537       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14538       fis->d.device         = 0x40;                   /* FIS LBA mode set */
14539       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
14540       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
14541       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
14542       fis->d.featuresExp    = 0;                      /* FIS reserve */
14543       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
14544       fis->d.sectorCountExp = scsiCmnd->cdb[8];       /* FIS sector count (15:8) */
14545       fis->d.reserved4      = 0;
14546       fis->d.control        = 0;                      /* FIS HOB bit clear */
14547       fis->d.reserved5      = 0;
14548
14549       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
14550       satIOContext->ATACmd = SAT_WRITE_DMA_EXT;
14551     }
14552     else
14553     {
14554       /* case 4 */
14555       /* WRITE MULTIPLE EXT or WRITE MULTIPLE FUA EXT or WRITE SECTOR(S) EXT */
14556       /* WRITE SECTORS EXT for easier implemetation */
14557       TI_DBG5(("satWriteAndVerify12: case 4\n"));
14558       fis->h.fisType        = 0x27;                   /* Reg host to device */
14559       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
14560       fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
14561
14562       fis->h.features       = 0;                      /* FIS reserve */
14563       fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14564       fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14565       fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14566       fis->d.device         = 0x40;                   /* FIS LBA mode set */
14567       fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
14568       fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
14569       fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
14570       fis->d.featuresExp    = 0;                      /* FIS reserve */
14571       fis->d.sectorCount    = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
14572       fis->d.sectorCountExp = scsiCmnd->cdb[8];       /* FIS sector count (15:8) */
14573       fis->d.reserved4      = 0;
14574       fis->d.control        = 0;                      /* FIS HOB bit clear */
14575       fis->d.reserved5      = 0;
14576
14577       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
14578       satIOContext->ATACmd = SAT_WRITE_SECTORS_EXT;
14579     }
14580   }
14581
14582   /* case 5 */
14583   if (pSatDevData->satNCQ == agTRUE)
14584   {
14585     /* WRITE FPDMA QUEUED */
14586     if (pSatDevData->sat48BitSupport != agTRUE)
14587     {
14588       TI_DBG5(("satWriteAndVerify12: case 5 !!! error NCQ but 28 bit address support \n"));
14589        satSetSensePayload( pSense,
14590                           SCSI_SNSKEY_ILLEGAL_REQUEST,
14591                           0,
14592                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
14593                           satIOContext);
14594
14595       ostiInitiatorIOCompleted( tiRoot,
14596                                 tiIORequest,
14597                                 tiIOSuccess,
14598                                 SCSI_STAT_CHECK_CONDITION,
14599                                 satIOContext->pTiSenseData,
14600                                 satIOContext->interruptContext );
14601       return tiSuccess;
14602     }
14603     TI_DBG6(("satWriteAndVerify12: case 5\n"));
14604
14605     /* Support 48-bit FPDMA addressing, use WRITE FPDMA QUEUE command */
14606
14607     fis->h.fisType        = 0x27;                   /* Reg host to device */
14608     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
14609     fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
14610     fis->h.features       = scsiCmnd->cdb[9];       /* FIS sector count (7:0) */
14611     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14612     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14613     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14614
14615     /* Check FUA bit */
14616     if (scsiCmnd->cdb[1] & SCSI_WRITE12_FUA_MASK)
14617       fis->d.device       = 0xC0;                   /* FIS FUA set */
14618     else
14619       fis->d.device       = 0x40;                   /* FIS FUA clear */
14620
14621     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
14622     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
14623     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
14624     fis->d.featuresExp    = scsiCmnd->cdb[8];       /* FIS sector count (15:8) */
14625     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
14626     fis->d.sectorCountExp = 0;
14627     fis->d.reserved4      = 0;
14628     fis->d.control        = 0;                      /* FIS HOB bit clear */
14629     fis->d.reserved5      = 0;
14630
14631     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
14632     satIOContext->ATACmd = SAT_WRITE_FPDMA_QUEUED;
14633   }
14634
14635   satIOContext->currentLBA = lba;
14636 //  satIOContext->OrgLBA = lba;
14637   satIOContext->OrgTL = tl;
14638
14639   /*
14640     computing number of loop and remainder for tl
14641     0xFF in case not ext
14642     0xFFFF in case EXT
14643   */
14644   if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
14645   {
14646     LoopNum = satComputeLoopNum(tl, 0xFF);
14647   }
14648   else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
14649            fis->h.command == SAT_WRITE_DMA_EXT     ||
14650            fis->h.command == SAT_WRITE_DMA_FUA_EXT
14651            )
14652   {
14653     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
14654     LoopNum = satComputeLoopNum(tl, 0xFFFF);
14655   }
14656   else
14657   {
14658     /* SAT_WRITE_FPDMA_QUEUEDK */
14659     LoopNum = satComputeLoopNum(tl, 0xFFFF);
14660   }
14661
14662   satIOContext->LoopNum = LoopNum;
14663   satIOContext->LoopNum2 = LoopNum;
14664
14665
14666   if (LoopNum == 1)
14667   {
14668     TI_DBG5(("satWriteAndVerify12: NON CHAINED data\n"));
14669     /* Initialize CB for SATA completion.
14670      */
14671     satIOContext->satCompleteCB = &satNonChainedWriteNVerifyCB;
14672   }
14673   else
14674   {
14675     TI_DBG1(("satWriteAndVerify12: CHAINED data\n"));
14676     /* re-setting tl */
14677     if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
14678     {
14679        fis->d.sectorCount    = 0xFF;
14680     }
14681     else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
14682              fis->h.command == SAT_WRITE_DMA_EXT ||
14683              fis->h.command == SAT_WRITE_DMA_FUA_EXT
14684              )
14685     {
14686       fis->d.sectorCount    = 0xFF;
14687       fis->d.sectorCountExp = 0xFF;
14688     }
14689     else
14690     {
14691       /* SAT_WRITE_FPDMA_QUEUED */
14692       fis->h.features       = 0xFF;
14693       fis->d.featuresExp    = 0xFF;
14694     }
14695
14696     /* Initialize CB for SATA completion.
14697      */
14698     satIOContext->satCompleteCB = &satChainedWriteNVerifyCB;
14699   }
14700
14701
14702   /*
14703    * Prepare SGL and send FIS to LL layer.
14704    */
14705   satIOContext->reqType = agRequestType;       /* Save it */
14706
14707   status = sataLLIOStart( tiRoot,
14708                           tiIORequest,
14709                           tiDeviceHandle,
14710                           tiScsiRequest,
14711                           satIOContext);
14712   return (status);
14713 }
14714
14715 GLOBAL bit32  satNonChainedWriteNVerify_Verify(
14716                    tiRoot_t                  *tiRoot,
14717                    tiIORequest_t             *tiIORequest,
14718                    tiDeviceHandle_t          *tiDeviceHandle,
14719                    tiScsiInitiatorRequest_t *tiScsiRequest,
14720                    satIOContext_t            *satIOContext)
14721 {
14722   bit32                     status;
14723   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
14724   satDeviceData_t           *pSatDevData;
14725   tiIniScsiCmnd_t           *scsiCmnd;
14726   agsaFisRegHostToDevice_t  *fis;
14727
14728   pSatDevData   = satIOContext->pSatDevData;
14729   scsiCmnd      = &tiScsiRequest->scsiCmnd;
14730   fis           = satIOContext->pFis;
14731
14732   TI_DBG5(("satNonChainedWriteNVerify_Verify: start\n"));
14733
14734   if (pSatDevData->sat48BitSupport == agTRUE)
14735   {
14736     fis->h.fisType        = 0x27;                   /* Reg host to device */
14737     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
14738
14739     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
14740     fis->h.features       = 0;                      /* FIS reserve */
14741     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
14742     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
14743     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
14744     fis->d.device         = 0x40;                   /* FIS LBA mode set 01000000 */
14745     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
14746     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
14747     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
14748     fis->d.featuresExp    = 0;                      /* FIS reserve */
14749     fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
14750     fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
14751
14752     fis->d.reserved4      = 0;
14753     fis->d.control        = 0;                      /* FIS HOB bit clear */
14754     fis->d.reserved5      = 0;
14755
14756     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
14757
14758     /* Initialize CB for SATA completion.
14759      */
14760     satIOContext->satCompleteCB = &satNonChainedWriteNVerifyCB;
14761
14762     /*
14763      * Prepare SGL and send FIS to LL layer.
14764      */
14765     satIOContext->reqType = agRequestType;       /* Save it */
14766
14767     status = sataLLIOStart( tiRoot,
14768                             tiIORequest,
14769                             tiDeviceHandle,
14770                             tiScsiRequest,
14771                             satIOContext);
14772
14773
14774     TI_DBG1(("satNonChainedWriteNVerify_Verify: return status %d\n", status));
14775     return (status);
14776   }
14777   else
14778   {
14779     /* can't fit in SAT_READ_VERIFY_SECTORS becasue of Sector Count and LBA */
14780     TI_DBG1(("satNonChainedWriteNVerify_Verify: can't fit in SAT_READ_VERIFY_SECTORS\n"));
14781     return tiError;
14782   }
14783
14784 }
14785
14786 GLOBAL bit32  satChainedWriteNVerify_Write(
14787                    tiRoot_t                  *tiRoot,
14788                    tiIORequest_t             *tiIORequest,
14789                    tiDeviceHandle_t          *tiDeviceHandle,
14790                    tiScsiInitiatorRequest_t *tiScsiRequest,
14791                    satIOContext_t            *satIOContext)
14792 {
14793   /*
14794     Assumption: error check on lba and tl has been done in satWrite*()
14795     lba = lba + tl;
14796   */
14797   bit32                     status;
14798   satIOContext_t            *satOrgIOContext = agNULL;
14799   tiIniScsiCmnd_t           *scsiCmnd;
14800   agsaFisRegHostToDevice_t  *fis;
14801   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
14802   bit32                     lba = 0;
14803   bit32                     DenomTL = 0xFF;
14804   bit32                     Remainder = 0;
14805   bit8                      LBA[4]; /* 0 MSB, 3 LSB */
14806
14807   TI_DBG1(("satChainedWriteNVerify_Write: start\n"));
14808
14809   fis             = satIOContext->pFis;
14810   satOrgIOContext = satIOContext->satOrgIOContext;
14811   scsiCmnd        = satOrgIOContext->pScsiCmnd;
14812
14813   osti_memset(LBA,0, sizeof(LBA));
14814
14815   switch (satOrgIOContext->ATACmd)
14816   {
14817   case SAT_WRITE_DMA:
14818     DenomTL = 0xFF;
14819     break;
14820   case SAT_WRITE_SECTORS:
14821     DenomTL = 0xFF;
14822     break;
14823   case SAT_WRITE_DMA_EXT:
14824     DenomTL = 0xFFFF;
14825     break;
14826   case SAT_WRITE_DMA_FUA_EXT:
14827     DenomTL = 0xFFFF;
14828     break;
14829   case SAT_WRITE_SECTORS_EXT:
14830     DenomTL = 0xFFFF;
14831     break;
14832   case SAT_WRITE_FPDMA_QUEUED:
14833     DenomTL = 0xFFFF;
14834     break;
14835   default:
14836     TI_DBG1(("satChainedWriteNVerify_Write: error incorrect ata command 0x%x\n", satIOContext->ATACmd));
14837     return tiError;
14838     break;
14839   }
14840
14841   Remainder = satOrgIOContext->OrgTL % DenomTL;
14842   satOrgIOContext->currentLBA = satOrgIOContext->currentLBA + DenomTL;
14843   lba = satOrgIOContext->currentLBA;
14844
14845   LBA[0] = (bit8)((lba & 0xF000) >> (8 * 3)); /* MSB */
14846   LBA[1] = (bit8)((lba & 0xF00) >> (8 * 2));
14847   LBA[2] = (bit8)((lba & 0xF0) >> 8);
14848   LBA[3] = (bit8)(lba & 0xF);               /* LSB */
14849
14850   switch (satOrgIOContext->ATACmd)
14851   {
14852   case SAT_WRITE_DMA:
14853     fis->h.fisType        = 0x27;                   /* Reg host to device */
14854     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
14855     fis->h.command        = SAT_WRITE_DMA;          /* 0xCA */
14856     fis->h.features       = 0;                      /* FIS reserve */
14857     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
14858     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
14859     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
14860
14861     /* FIS LBA mode set LBA (27:24) */
14862     fis->d.device         = (bit8)((0x4 << 4) | (LBA[0] & 0xF));
14863
14864     fis->d.lbaLowExp      = 0;
14865     fis->d.lbaMidExp      = 0;
14866     fis->d.lbaHighExp     = 0;
14867     fis->d.featuresExp    = 0;
14868     if (satOrgIOContext->LoopNum == 1)
14869     {
14870       /* last loop */
14871       fis->d.sectorCount    = (bit8)Remainder;             /* FIS sector count (7:0) */
14872     }
14873     else
14874     {
14875       fis->d.sectorCount    = 0xFF;                   /* FIS sector count (7:0) */
14876     }
14877     fis->d.sectorCountExp = 0;
14878     fis->d.reserved4      = 0;
14879     fis->d.control        = 0;                      /* FIS HOB bit clear */
14880     fis->d.reserved5      = 0;
14881
14882     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
14883
14884     break;
14885   case SAT_WRITE_SECTORS:
14886     fis->h.fisType        = 0x27;                   /* Reg host to device */
14887     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
14888     fis->h.command        = SAT_WRITE_SECTORS;      /* 0x30 */
14889     fis->h.features       = 0;                      /* FIS reserve */
14890     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
14891     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
14892     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
14893
14894     /* FIS LBA mode set LBA (27:24) */
14895     fis->d.device         = (bit8)((0x4 << 4) | (LBA[0] & 0xF));
14896
14897     fis->d.lbaLowExp      = 0;
14898     fis->d.lbaMidExp      = 0;
14899     fis->d.lbaHighExp     = 0;
14900     fis->d.featuresExp    = 0;
14901     if (satOrgIOContext->LoopNum == 1)
14902     {
14903       /* last loop */
14904       fis->d.sectorCount    = (bit8)Remainder;            /* FIS sector count (7:0) */
14905     }
14906     else
14907     {
14908       fis->d.sectorCount    = 0xFF;                 /* FIS sector count (7:0) */
14909     }
14910     fis->d.sectorCountExp = 0;
14911     fis->d.reserved4      = 0;
14912     fis->d.control        = 0;                      /* FIS HOB bit clear */
14913     fis->d.reserved5      = 0;
14914
14915     agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
14916
14917     break;
14918   case SAT_WRITE_DMA_EXT:
14919     fis->h.fisType        = 0x27;                   /* Reg host to device */
14920     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
14921     fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x3D */
14922     fis->h.features       = 0;                      /* FIS reserve */
14923     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
14924     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
14925     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
14926     fis->d.device         = 0x40;                   /* FIS LBA mode set */
14927     fis->d.lbaLowExp      = LBA[0];                 /* FIS LBA (31:24) */
14928     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
14929     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
14930     fis->d.featuresExp    = 0;                      /* FIS reserve */
14931     if (satOrgIOContext->LoopNum == 1)
14932     {
14933       /* last loop */
14934       fis->d.sectorCount    = (bit8)(Remainder & 0xFF);       /* FIS sector count (7:0) */
14935       fis->d.sectorCountExp = (bit8)((Remainder & 0xFF00) >> 8);       /* FIS sector count (15:8) */
14936     }
14937     else
14938     {
14939       fis->d.sectorCount    = 0xFF;                  /* FIS sector count (7:0) */
14940       fis->d.sectorCountExp = 0xFF;                  /* FIS sector count (15:8) */
14941     }
14942     fis->d.reserved4      = 0;
14943     fis->d.control        = 0;                       /* FIS HOB bit clear */
14944     fis->d.reserved5      = 0;
14945
14946     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
14947
14948     break;
14949   case SAT_WRITE_SECTORS_EXT:
14950     fis->h.fisType        = 0x27;                   /* Reg host to device */
14951     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
14952     fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
14953
14954     fis->h.features       = 0;                      /* FIS reserve */
14955     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
14956     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
14957     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
14958     fis->d.device         = 0x40;                   /* FIS LBA mode set */
14959     fis->d.lbaLowExp      = LBA[0];                 /* FIS LBA (31:24) */
14960     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
14961     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
14962     fis->d.featuresExp    = 0;                      /* FIS reserve */
14963     if (satOrgIOContext->LoopNum == 1)
14964     {
14965       /* last loop */
14966       fis->d.sectorCount    = (bit8)(Remainder & 0xFF);     /* FIS sector count (7:0) */
14967       fis->d.sectorCountExp = (bit8)((Remainder & 0xFF00) >> 8);   /* FIS sector count (15:8) */
14968     }
14969     else
14970     {
14971       fis->d.sectorCount    = 0xFF;                 /* FIS sector count (7:0) */
14972       fis->d.sectorCountExp = 0xFF;                 /* FIS sector count (15:8) */
14973     }
14974     fis->d.reserved4      = 0;
14975     fis->d.control        = 0;                      /* FIS HOB bit clear */
14976     fis->d.reserved5      = 0;
14977
14978     agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
14979
14980     break;
14981   case SAT_WRITE_FPDMA_QUEUED:
14982     fis->h.fisType        = 0x27;                   /* Reg host to device */
14983     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
14984     fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
14985     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
14986     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
14987     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
14988
14989     /* Check FUA bit */
14990     if (scsiCmnd->cdb[1] & SCSI_WRITE10_FUA_MASK)
14991       fis->d.device       = 0xC0;                   /* FIS FUA set */
14992     else
14993       fis->d.device       = 0x40;                   /* FIS FUA clear */
14994
14995     fis->d.lbaLowExp      = LBA[0];;                /* FIS LBA (31:24) */
14996     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
14997     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
14998     if (satOrgIOContext->LoopNum == 1)
14999     {
15000       /* last loop */
15001       fis->h.features       = (bit8)(Remainder & 0xFF);     /* FIS sector count (7:0) */
15002       fis->d.featuresExp    = (bit8)((Remainder & 0xFF00) >> 8);       /* FIS sector count (15:8) */
15003     }
15004     else
15005     {
15006       fis->h.features       = 0xFF;                 /* FIS sector count (7:0) */
15007       fis->d.featuresExp    = 0xFF;                 /* FIS sector count (15:8) */
15008     }
15009     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
15010     fis->d.sectorCountExp = 0;
15011     fis->d.reserved4      = 0;
15012     fis->d.control        = 0;                      /* FIS HOB bit clear */
15013     fis->d.reserved5      = 0;
15014
15015     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
15016     break;
15017
15018   default:
15019     TI_DBG1(("satChainedWriteNVerify_Write: error incorrect ata command 0x%x\n", satIOContext->ATACmd));
15020     return tiError;
15021     break;
15022   }
15023
15024   /* Initialize CB for SATA completion.
15025    */
15026   /* chained data */
15027   satIOContext->satCompleteCB = &satChainedWriteNVerifyCB;
15028
15029
15030   /*
15031    * Prepare SGL and send FIS to LL layer.
15032    */
15033   satIOContext->reqType = agRequestType;       /* Save it */
15034
15035   status = sataLLIOStart( tiRoot,
15036                           tiIORequest,
15037                           tiDeviceHandle,
15038                           tiScsiRequest,
15039                           satIOContext);
15040
15041   TI_DBG5(("satChainedWriteNVerify_Write: return\n"));
15042   return (status);
15043
15044 }
15045
15046 /*
15047   similar to write12 and verify10;
15048   this will be similar to verify12
15049   */
15050 GLOBAL bit32  satChainedWriteNVerify_Start_Verify(
15051                    tiRoot_t                  *tiRoot,
15052                    tiIORequest_t             *tiIORequest,
15053                    tiDeviceHandle_t          *tiDeviceHandle,
15054                    tiScsiInitiatorRequest_t *tiScsiRequest,
15055                    satIOContext_t            *satIOContext)
15056 {
15057   /*
15058     deal with transfer length; others have been handled previously at this point;
15059     no LBA check; no range check;
15060   */
15061   bit32                     status;
15062   bit32                     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
15063   satDeviceData_t           *pSatDevData;
15064   tiIniScsiCmnd_t           *scsiCmnd;
15065   agsaFisRegHostToDevice_t  *fis;
15066   bit32                     lba = 0;
15067   bit32                     tl = 0;
15068   bit32                     LoopNum = 1;
15069   bit8                      LBA[4];
15070   bit8                      TL[4];
15071
15072   pSatDevData   = satIOContext->pSatDevData;
15073   scsiCmnd      = &tiScsiRequest->scsiCmnd;
15074   fis           = satIOContext->pFis;
15075
15076   TI_DBG5(("satChainedWriteNVerify_Start_Verify: start\n"));
15077
15078   osti_memset(LBA, 0, sizeof(LBA));
15079   osti_memset(TL, 0, sizeof(TL));
15080
15081   /* do not use memcpy due to indexing in LBA and TL */
15082   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
15083   LBA[1] = scsiCmnd->cdb[3];
15084   LBA[2] = scsiCmnd->cdb[4];
15085   LBA[3] = scsiCmnd->cdb[5];  /* LSB */
15086
15087   TL[0] = scsiCmnd->cdb[6];   /* MSB */
15088   TL[1] = scsiCmnd->cdb[7];
15089   TL[2] = scsiCmnd->cdb[7];
15090   TL[3] = scsiCmnd->cdb[8];   /* LSB */
15091
15092   lba = satComputeCDB12LBA(satIOContext);
15093   tl = satComputeCDB12TL(satIOContext);
15094
15095   if (pSatDevData->sat48BitSupport == agTRUE)
15096   {
15097     TI_DBG5(("satChainedWriteNVerify_Start_Verify: SAT_READ_VERIFY_SECTORS_EXT\n"));
15098     fis->h.fisType        = 0x27;                   /* Reg host to device */
15099     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
15100
15101     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
15102     fis->h.features       = 0;                      /* FIS reserve */
15103     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
15104     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
15105     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
15106     fis->d.device         = 0x40;                   /* FIS LBA mode set 01000000 */
15107     fis->d.lbaLowExp      = scsiCmnd->cdb[2];       /* FIS LBA (31:24) */
15108     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
15109     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
15110     fis->d.featuresExp    = 0;                      /* FIS reserve */
15111     fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
15112     fis->d.sectorCountExp = scsiCmnd->cdb[7];       /* FIS sector count (15:8) */
15113
15114     fis->d.reserved4      = 0;
15115     fis->d.control        = 0;                      /* FIS HOB bit clear */
15116     fis->d.reserved5      = 0;
15117
15118     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
15119     satIOContext->ATACmd = SAT_READ_VERIFY_SECTORS_EXT;
15120   }
15121   else
15122   {
15123     TI_DBG5(("satChainedWriteNVerify_Start_Verify: SAT_READ_VERIFY_SECTORS\n"));
15124     fis->h.fisType        = 0x27;                   /* Reg host to device */
15125     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
15126     fis->h.command        = SAT_READ_VERIFY_SECTORS;      /* 0x40 */
15127     fis->h.features       = 0;                      /* FIS reserve */
15128     fis->d.lbaLow         = scsiCmnd->cdb[5];       /* FIS LBA (7 :0 ) */
15129     fis->d.lbaMid         = scsiCmnd->cdb[4];       /* FIS LBA (15:8 ) */
15130     fis->d.lbaHigh        = scsiCmnd->cdb[3];       /* FIS LBA (23:16) */
15131       /* FIS LBA mode set LBA (27:24) */
15132     fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[2] & 0xF));
15133     fis->d.lbaLowExp      = 0;
15134     fis->d.lbaMidExp      = 0;
15135     fis->d.lbaHighExp     = 0;
15136     fis->d.featuresExp    = 0;
15137     fis->d.sectorCount    = scsiCmnd->cdb[8];       /* FIS sector count (7:0) */
15138     fis->d.sectorCountExp = 0;
15139     fis->d.reserved4      = 0;
15140     fis->d.control        = 0;                      /* FIS HOB bit clear */
15141     fis->d.reserved5      = 0;
15142
15143     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
15144     satIOContext->ATACmd = SAT_READ_VERIFY_SECTORS;
15145
15146  }
15147
15148   satIOContext->currentLBA = lba;
15149   satIOContext->OrgTL = tl;
15150
15151   /*
15152     computing number of loop and remainder for tl
15153     0xFF in case not ext
15154     0xFFFF in case EXT
15155   */
15156   if (fis->h.command == SAT_READ_VERIFY_SECTORS)
15157   {
15158     LoopNum = satComputeLoopNum(tl, 0xFF);
15159   }
15160   else if (fis->h.command == SAT_READ_VERIFY_SECTORS_EXT)
15161   {
15162     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
15163     LoopNum = satComputeLoopNum(tl, 0xFFFF);
15164   }
15165   else
15166   {
15167     TI_DBG1(("satChainedWriteNVerify_Start_Verify: error case 1!!!\n"));
15168     LoopNum = 1;
15169   }
15170
15171   satIOContext->LoopNum = LoopNum;
15172
15173   if (LoopNum == 1)
15174   {
15175     TI_DBG5(("satChainedWriteNVerify_Start_Verify: NON CHAINED data\n"));
15176     /* Initialize CB for SATA completion.
15177      */
15178     satIOContext->satCompleteCB = &satNonChainedWriteNVerifyCB;
15179   }
15180   else
15181   {
15182     TI_DBG1(("satChainedWriteNVerify_Start_Verify: CHAINED data\n"));
15183     /* re-setting tl */
15184     if (fis->h.command == SAT_READ_VERIFY_SECTORS)
15185     {
15186        fis->d.sectorCount    = 0xFF;
15187     }
15188     else if (fis->h.command == SAT_READ_VERIFY_SECTORS_EXT)
15189     {
15190       fis->d.sectorCount    = 0xFF;
15191       fis->d.sectorCountExp = 0xFF;
15192     }
15193     else
15194     {
15195       TI_DBG1(("satChainedWriteNVerify_Start_Verify: error case 2!!!\n"));
15196     }
15197
15198     /* Initialize CB for SATA completion.
15199      */
15200     satIOContext->satCompleteCB = &satChainedWriteNVerifyCB;
15201   }
15202
15203
15204   /*
15205    * Prepare SGL and send FIS to LL layer.
15206    */
15207   satIOContext->reqType = agRequestType;       /* Save it */
15208
15209   status = sataLLIOStart( tiRoot,
15210                           tiIORequest,
15211                           tiDeviceHandle,
15212                           tiScsiRequest,
15213                           satIOContext);
15214   return (status);
15215 }
15216
15217 GLOBAL bit32  satChainedWriteNVerify_Verify(
15218                    tiRoot_t                  *tiRoot,
15219                    tiIORequest_t             *tiIORequest,
15220                    tiDeviceHandle_t          *tiDeviceHandle,
15221                    tiScsiInitiatorRequest_t *tiScsiRequest,
15222                    satIOContext_t            *satIOContext)
15223 {
15224   bit32                     status;
15225   satIOContext_t            *satOrgIOContext = agNULL;
15226   agsaFisRegHostToDevice_t  *fis;
15227   bit32                     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
15228   bit32                     lba = 0;
15229   bit32                     DenomTL = 0xFF;
15230   bit32                     Remainder = 0;
15231   bit8                      LBA[4]; /* 0 MSB, 3 LSB */
15232
15233   TI_DBG2(("satChainedWriteNVerify_Verify: start\n"));
15234
15235   fis             = satIOContext->pFis;
15236   satOrgIOContext = satIOContext->satOrgIOContext;
15237
15238   osti_memset(LBA,0, sizeof(LBA));
15239
15240   switch (satOrgIOContext->ATACmd)
15241   {
15242   case SAT_READ_VERIFY_SECTORS:
15243     DenomTL = 0xFF;
15244     break;
15245   case SAT_READ_VERIFY_SECTORS_EXT:
15246     DenomTL = 0xFFFF;
15247     break;
15248   default:
15249     TI_DBG1(("satChainedWriteNVerify_Verify: error incorrect ata command 0x%x\n", satIOContext->ATACmd));
15250     return tiError;
15251     break;
15252   }
15253
15254   Remainder = satOrgIOContext->OrgTL % DenomTL;
15255   satOrgIOContext->currentLBA = satOrgIOContext->currentLBA + DenomTL;
15256   lba = satOrgIOContext->currentLBA;
15257
15258   LBA[0] = (bit8)((lba & 0xF000) >> (8 * 3)); /* MSB */
15259   LBA[1] = (bit8)((lba & 0xF00) >> (8 * 2));
15260   LBA[2] = (bit8)((lba & 0xF0) >> 8);
15261   LBA[3] = (bit8)(lba & 0xF);               /* LSB */
15262
15263   switch (satOrgIOContext->ATACmd)
15264   {
15265   case SAT_READ_VERIFY_SECTORS:
15266     fis->h.fisType        = 0x27;                   /* Reg host to device */
15267     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
15268     fis->h.command        = SAT_READ_VERIFY_SECTORS;          /* 0x40 */
15269     fis->h.features       = 0;                      /* FIS reserve */
15270     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
15271     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
15272     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
15273
15274     /* FIS LBA mode set LBA (27:24) */
15275     fis->d.device         = (bit8)((0x4 << 4) | (LBA[0] & 0xF));
15276
15277     fis->d.lbaLowExp      = 0;
15278     fis->d.lbaMidExp      = 0;
15279     fis->d.lbaHighExp     = 0;
15280     fis->d.featuresExp    = 0;
15281     if (satOrgIOContext->LoopNum == 1)
15282     {
15283       /* last loop */
15284       fis->d.sectorCount    = (bit8)Remainder;             /* FIS sector count (7:0) */
15285     }
15286     else
15287     {
15288       fis->d.sectorCount    = 0xFF;                   /* FIS sector count (7:0) */
15289     }
15290     fis->d.sectorCountExp = 0;
15291     fis->d.reserved4      = 0;
15292     fis->d.control        = 0;                      /* FIS HOB bit clear */
15293     fis->d.reserved5      = 0;
15294
15295     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
15296
15297     break;
15298   case SAT_READ_VERIFY_SECTORS_EXT:
15299     fis->h.fisType        = 0x27;                   /* Reg host to device */
15300     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
15301     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;      /* 0x42 */
15302     fis->h.features       = 0;                      /* FIS reserve */
15303     fis->d.lbaLow         = LBA[3];                 /* FIS LBA (7 :0 ) */
15304     fis->d.lbaMid         = LBA[2];                 /* FIS LBA (15:8 ) */
15305     fis->d.lbaHigh        = LBA[1];                 /* FIS LBA (23:16) */
15306     fis->d.device         = 0x40;                   /* FIS LBA mode set */
15307     fis->d.lbaLowExp      = LBA[0];                 /* FIS LBA (31:24) */
15308     fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
15309     fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
15310     fis->d.featuresExp    = 0;                      /* FIS reserve */
15311     if (satOrgIOContext->LoopNum == 1)
15312     {
15313       /* last loop */
15314       fis->d.sectorCount    = (bit8)(Remainder & 0xFF);       /* FIS sector count (7:0) */
15315       fis->d.sectorCountExp = (bit8)((Remainder & 0xFF00) >> 8);       /* FIS sector count (15:8) */
15316     }
15317     else
15318     {
15319       fis->d.sectorCount    = 0xFF;                  /* FIS sector count (7:0) */
15320       fis->d.sectorCountExp = 0xFF;                  /* FIS sector count (15:8) */
15321     }
15322     fis->d.reserved4      = 0;
15323     fis->d.control        = 0;                       /* FIS HOB bit clear */
15324     fis->d.reserved5      = 0;
15325
15326     agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
15327
15328     break;
15329
15330   default:
15331     TI_DBG1(("satChainedWriteNVerify_Verify: error incorrect ata command 0x%x\n", satIOContext->ATACmd));
15332     return tiError;
15333     break;
15334   }
15335
15336   /* Initialize CB for SATA completion.
15337    */
15338   /* chained data */
15339   satIOContext->satCompleteCB = &satChainedWriteNVerifyCB;
15340
15341
15342   /*
15343    * Prepare SGL and send FIS to LL layer.
15344    */
15345   satIOContext->reqType = agRequestType;       /* Save it */
15346
15347   status = sataLLIOStart( tiRoot,
15348                           tiIORequest,
15349                           tiDeviceHandle,
15350                           tiScsiRequest,
15351                           satIOContext);
15352
15353   TI_DBG5(("satChainedWriteNVerify_Verify: return\n"));
15354   return (status);
15355
15356 }
15357
15358
15359 /*****************************************************************************/
15360 /*! \brief SAT implementation for SCSI satWriteAndVerify16.
15361  *
15362  *  SAT implementation for SCSI satWriteAndVerify16.
15363  *
15364  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
15365  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
15366  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
15367  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
15368  *  \param   satIOContext_t:   Pointer to the SAT IO Context
15369  *
15370  *  \return If command is started successfully
15371  *    - \e tiSuccess:     I/O request successfully initiated.
15372  *    - \e tiBusy:        No resources available, try again later.
15373  *    - \e tiIONoDevice:  Invalid device handle.
15374  *    - \e tiError:       Other errors.
15375  */
15376 /*****************************************************************************/
15377 GLOBAL bit32  satWriteAndVerify16(
15378                    tiRoot_t                  *tiRoot,
15379                    tiIORequest_t             *tiIORequest,
15380                    tiDeviceHandle_t          *tiDeviceHandle,
15381                    tiScsiInitiatorRequest_t *tiScsiRequest,
15382                    satIOContext_t            *satIOContext)
15383 {
15384   /*
15385     combination of write16 and verify16
15386     since write16 has 8 bytes LBA -> problem ATA LBA(upto 6 bytes), no support
15387   */
15388   bit32                     status;
15389   bit32                     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
15390   satDeviceData_t           *pSatDevData;
15391   scsiRspSense_t            *pSense;
15392   tiIniScsiCmnd_t           *scsiCmnd;
15393   agsaFisRegHostToDevice_t  *fis;
15394   bit32                     lba = 0;
15395   bit32                     tl = 0;
15396   bit32                     LoopNum = 1;
15397   bit8                      LBA[8];
15398   bit8                      TL[8];
15399   bit32                     rangeChk = agFALSE; /* lba and tl range check */
15400   bit32                     limitChk = agFALSE; /* lba and tl range check */
15401
15402   pSense        = satIOContext->pSense;
15403   pSatDevData   = satIOContext->pSatDevData;
15404   scsiCmnd      = &tiScsiRequest->scsiCmnd;
15405   fis           = satIOContext->pFis;
15406   TI_DBG5(("satWriteAndVerify16:start\n"));
15407
15408   /* checking BYTCHK bit */
15409   if (scsiCmnd->cdb[1] & SCSI_WRITE_N_VERIFY_BYTCHK_MASK)
15410   {
15411     satSetSensePayload( pSense,
15412                         SCSI_SNSKEY_ILLEGAL_REQUEST,
15413                         0,
15414                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
15415                         satIOContext);
15416
15417     ostiInitiatorIOCompleted( tiRoot,
15418                               tiIORequest,
15419                               tiIOSuccess,
15420                               SCSI_STAT_CHECK_CONDITION,
15421                               satIOContext->pTiSenseData,
15422                               satIOContext->interruptContext );
15423
15424     TI_DBG1(("satWriteAndVerify16: BYTCHK bit checking \n"));
15425     return tiSuccess;
15426   }
15427
15428
15429   /* checking CONTROL */
15430   /* NACA == 1 or LINK == 1*/
15431   if ( (scsiCmnd->cdb[15] & SCSI_NACA_MASK) || (scsiCmnd->cdb[15] & SCSI_LINK_MASK) )
15432   {
15433     satSetSensePayload( pSense,
15434                         SCSI_SNSKEY_ILLEGAL_REQUEST,
15435                         0,
15436                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
15437                         satIOContext);
15438
15439     ostiInitiatorIOCompleted( tiRoot,
15440                               tiIORequest,
15441                               tiIOSuccess,
15442                               SCSI_STAT_CHECK_CONDITION,
15443                               satIOContext->pTiSenseData,
15444                               satIOContext->interruptContext );
15445
15446     TI_DBG2(("satWriteAndVerify16: return control\n"));
15447     return tiSuccess;
15448   }
15449
15450   osti_memset(LBA, 0, sizeof(LBA));
15451   osti_memset(TL, 0, sizeof(TL));
15452
15453
15454   /* do not use memcpy due to indexing in LBA and TL */
15455   LBA[0] = scsiCmnd->cdb[2];  /* MSB */
15456   LBA[1] = scsiCmnd->cdb[3];
15457   LBA[2] = scsiCmnd->cdb[4];
15458   LBA[3] = scsiCmnd->cdb[5];
15459   LBA[4] = scsiCmnd->cdb[6];
15460   LBA[5] = scsiCmnd->cdb[7];
15461   LBA[6] = scsiCmnd->cdb[8];
15462   LBA[7] = scsiCmnd->cdb[9];  /* LSB */
15463
15464   TL[0] = 0;
15465   TL[1] = 0;
15466   TL[2] = 0;
15467   TL[3] = 0;
15468   TL[4] = scsiCmnd->cdb[10];   /* MSB */
15469   TL[5] = scsiCmnd->cdb[11];
15470   TL[6] = scsiCmnd->cdb[12];
15471   TL[7] = scsiCmnd->cdb[13];   /* LSB */
15472
15473   rangeChk = satAddNComparebit64(LBA, TL);
15474
15475   limitChk = satCompareLBALimitbit(LBA);
15476
15477   lba = satComputeCDB16LBA(satIOContext);
15478   tl = satComputeCDB16TL(satIOContext);
15479
15480
15481   /* Table 34, 9.1, p 46 */
15482   /*
15483     note: As of 2/10/2006, no support for DMA QUEUED
15484   */
15485
15486   /*
15487     Table 34, 9.1, p 46, b
15488     When no 48-bit addressing support or NCQ, if LBA is beyond (2^28 - 1),
15489     return check condition
15490   */
15491   if (pSatDevData->satNCQ != agTRUE &&
15492      pSatDevData->sat48BitSupport != agTRUE
15493      )
15494   {
15495     if (limitChk)
15496     {
15497       TI_DBG1(("satWriteAndVerify16: return LBA out of range, not EXT\n"));
15498       satSetSensePayload( pSense,
15499                           SCSI_SNSKEY_ILLEGAL_REQUEST,
15500                           0,
15501                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
15502                           satIOContext);
15503
15504       ostiInitiatorIOCompleted( tiRoot,
15505                                 tiIORequest,
15506                                 tiIOSuccess,
15507                                 SCSI_STAT_CHECK_CONDITION,
15508                                 satIOContext->pTiSenseData,
15509                                 satIOContext->interruptContext );
15510
15511     return tiSuccess;
15512     }
15513     if (rangeChk) //    if (lba + tl > SAT_TR_LBA_LIMIT)
15514     {
15515       TI_DBG1(("satWriteAndVerify16: return LBA+TL out of range, not EXT\n"));
15516       satSetSensePayload( pSense,
15517                           SCSI_SNSKEY_ILLEGAL_REQUEST,
15518                           0,
15519                           SCSI_SNSCODE_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE,
15520                           satIOContext);
15521
15522       ostiInitiatorIOCompleted( tiRoot,
15523                                 tiIORequest,
15524                                 tiIOSuccess,
15525                                 SCSI_STAT_CHECK_CONDITION,
15526                                 satIOContext->pTiSenseData,
15527                                 satIOContext->interruptContext );
15528
15529     return tiSuccess;
15530     }
15531   }
15532
15533
15534   /* case 1 and 2 */
15535   if (!rangeChk) //  if (lba + tl <= SAT_TR_LBA_LIMIT)
15536   {
15537     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
15538     {
15539       /* case 2 */
15540       /* WRITE DMA*/
15541       /* In case that we can't fit the transfer length, we loop */
15542       TI_DBG5(("satWriteAndVerify16: case 2\n"));
15543       fis->h.fisType        = 0x27;                   /* Reg host to device */
15544       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
15545       fis->h.command        = SAT_WRITE_DMA;          /* 0xCA */
15546       fis->h.features       = 0;                      /* FIS reserve */
15547       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
15548       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
15549       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
15550
15551       /* FIS LBA mode set LBA (27:24) */
15552       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[6] & 0xF));
15553
15554       fis->d.lbaLowExp      = 0;
15555       fis->d.lbaMidExp      = 0;
15556       fis->d.lbaHighExp     = 0;
15557       fis->d.featuresExp    = 0;
15558       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
15559       fis->d.sectorCountExp = 0;
15560       fis->d.reserved4      = 0;
15561       fis->d.control        = 0;                      /* FIS HOB bit clear */
15562       fis->d.reserved5      = 0;
15563
15564       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
15565       satIOContext->ATACmd = SAT_WRITE_DMA;
15566     }
15567     else
15568     {
15569       /* case 1 */
15570       /* WRITE MULTIPLE or WRITE SECTOR(S) */
15571       /* WRITE SECTORS for easier implemetation */
15572       /* In case that we can't fit the transfer length, we loop */
15573       TI_DBG5(("satWriteAndVerify16: case 1\n"));
15574       fis->h.fisType        = 0x27;                   /* Reg host to device */
15575       fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
15576       fis->h.command        = SAT_WRITE_SECTORS;      /* 0x30 */
15577       fis->h.features       = 0;                      /* FIS reserve */
15578       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
15579       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
15580       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
15581
15582       /* FIS LBA mode set LBA (27:24) */
15583       fis->d.device         = (bit8)((0x4 << 4) | (scsiCmnd->cdb[6] & 0xF));
15584
15585       fis->d.lbaLowExp      = 0;
15586       fis->d.lbaMidExp      = 0;
15587       fis->d.lbaHighExp     = 0;
15588       fis->d.featuresExp    = 0;
15589       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
15590       fis->d.sectorCountExp = 0;
15591       fis->d.reserved4      = 0;
15592       fis->d.control        = 0;                      /* FIS HOB bit clear */
15593       fis->d.reserved5      = 0;
15594
15595       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
15596       satIOContext->ATACmd = SAT_WRITE_SECTORS;
15597     }
15598   }
15599
15600   /* case 3 and 4 */
15601   if (pSatDevData->sat48BitSupport == agTRUE)
15602   {
15603     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
15604     {
15605       /* case 3 */
15606       /* WRITE DMA EXT or WRITE DMA FUA EXT */
15607       TI_DBG5(("satWriteAndVerify16: case 3\n"));
15608       fis->h.fisType        = 0x27;                   /* Reg host to device */
15609       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
15610
15611       /* SAT_WRITE_DMA_FUA_EXT is optional and we don't support it */
15612       fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x35 */
15613
15614       fis->h.features       = 0;                      /* FIS reserve */
15615       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
15616       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
15617       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
15618       fis->d.device         = 0x40;                   /* FIS LBA mode set */
15619       fis->d.lbaLowExp      = scsiCmnd->cdb[6];       /* FIS LBA (31:24) */
15620       fis->d.lbaMidExp      = scsiCmnd->cdb[5];       /* FIS LBA (39:32) */
15621       fis->d.lbaHighExp     = scsiCmnd->cdb[4];       /* FIS LBA (47:40) */
15622       fis->d.featuresExp    = 0;                      /* FIS reserve */
15623       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
15624       fis->d.sectorCountExp = scsiCmnd->cdb[12];       /* FIS sector count (15:8) */
15625       fis->d.reserved4      = 0;
15626       fis->d.control        = 0;                      /* FIS HOB bit clear */
15627       fis->d.reserved5      = 0;
15628
15629       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
15630       satIOContext->ATACmd = SAT_WRITE_DMA_EXT;
15631     }
15632     else
15633     {
15634       /* case 4 */
15635       /* WRITE MULTIPLE EXT or WRITE MULTIPLE FUA EXT or WRITE SECTOR(S) EXT */
15636       /* WRITE SECTORS EXT for easier implemetation */
15637       TI_DBG5(("satWriteAndVerify16: case 4\n"));
15638       fis->h.fisType        = 0x27;                   /* Reg host to device */
15639       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
15640       fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
15641
15642       fis->h.features       = 0;                      /* FIS reserve */
15643       fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
15644       fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
15645       fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
15646       fis->d.device         = 0x40;                   /* FIS LBA mode set */
15647       fis->d.lbaLowExp      = scsiCmnd->cdb[6];       /* FIS LBA (31:24) */
15648       fis->d.lbaMidExp      = scsiCmnd->cdb[5];       /* FIS LBA (39:32) */
15649       fis->d.lbaHighExp     = scsiCmnd->cdb[4];       /* FIS LBA (47:40) */
15650       fis->d.featuresExp    = 0;                      /* FIS reserve */
15651       fis->d.sectorCount    = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
15652       fis->d.sectorCountExp = scsiCmnd->cdb[12];       /* FIS sector count (15:8) */
15653       fis->d.reserved4      = 0;
15654       fis->d.control        = 0;                      /* FIS HOB bit clear */
15655       fis->d.reserved5      = 0;
15656
15657       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
15658       satIOContext->ATACmd = SAT_WRITE_SECTORS_EXT;
15659     }
15660   }
15661
15662   /* case 5 */
15663   if (pSatDevData->satNCQ == agTRUE)
15664   {
15665     /* WRITE FPDMA QUEUED */
15666     if (pSatDevData->sat48BitSupport != agTRUE)
15667     {
15668       TI_DBG5(("satWriteAndVerify16: case 5 !!! error NCQ but 28 bit address support \n"));
15669       satSetSensePayload( pSense,
15670                           SCSI_SNSKEY_ILLEGAL_REQUEST,
15671                           0,
15672                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
15673                           satIOContext);
15674
15675       ostiInitiatorIOCompleted( tiRoot,
15676                                 tiIORequest,
15677                                 tiIOSuccess,
15678                                 SCSI_STAT_CHECK_CONDITION,
15679                                 satIOContext->pTiSenseData,
15680                                 satIOContext->interruptContext );
15681       return tiSuccess;
15682     }
15683     TI_DBG6(("satWriteAndVerify16: case 5\n"));
15684
15685     /* Support 48-bit FPDMA addressing, use WRITE FPDMA QUEUE command */
15686
15687     fis->h.fisType        = 0x27;                   /* Reg host to device */
15688     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
15689     fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
15690     fis->h.features       = scsiCmnd->cdb[13];       /* FIS sector count (7:0) */
15691     fis->d.lbaLow         = scsiCmnd->cdb[9];       /* FIS LBA (7 :0 ) */
15692     fis->d.lbaMid         = scsiCmnd->cdb[8];       /* FIS LBA (15:8 ) */
15693     fis->d.lbaHigh        = scsiCmnd->cdb[7];       /* FIS LBA (23:16) */
15694
15695     /* Check FUA bit */
15696     if (scsiCmnd->cdb[1] & SCSI_WRITE16_FUA_MASK)
15697       fis->d.device       = 0xC0;                   /* FIS FUA set */
15698     else
15699       fis->d.device       = 0x40;                   /* FIS FUA clear */
15700
15701     fis->d.lbaLowExp      = scsiCmnd->cdb[6];       /* FIS LBA (31:24) */
15702     fis->d.lbaMidExp      = scsiCmnd->cdb[5];       /* FIS LBA (39:32) */
15703     fis->d.lbaHighExp     = scsiCmnd->cdb[4];       /* FIS LBA (47:40) */
15704     fis->d.featuresExp    = scsiCmnd->cdb[12];       /* FIS sector count (15:8) */
15705     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
15706     fis->d.sectorCountExp = 0;
15707     fis->d.reserved4      = 0;
15708     fis->d.control        = 0;                      /* FIS HOB bit clear */
15709     fis->d.reserved5      = 0;
15710
15711     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
15712     satIOContext->ATACmd = SAT_WRITE_FPDMA_QUEUED;
15713   }
15714
15715   satIOContext->currentLBA = lba;
15716   satIOContext->OrgTL = tl;
15717
15718   /*
15719     computing number of loop and remainder for tl
15720     0xFF in case not ext
15721     0xFFFF in case EXT
15722   */
15723   if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
15724   {
15725     LoopNum = satComputeLoopNum(tl, 0xFF);
15726   }
15727   else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
15728            fis->h.command == SAT_WRITE_DMA_EXT     ||
15729            fis->h.command == SAT_WRITE_DMA_FUA_EXT
15730            )
15731   {
15732     /* SAT_READ_SECTORS_EXT, SAT_READ_DMA_EXT */
15733     LoopNum = satComputeLoopNum(tl, 0xFFFF);
15734   }
15735   else
15736   {
15737     /* SAT_WRITE_FPDMA_QUEUEDK */
15738     LoopNum = satComputeLoopNum(tl, 0xFFFF);
15739   }
15740
15741   satIOContext->LoopNum = LoopNum;
15742
15743
15744   if (LoopNum == 1)
15745   {
15746     TI_DBG5(("satWriteAndVerify16: NON CHAINED data\n"));
15747     /* Initialize CB for SATA completion.
15748      */
15749     satIOContext->satCompleteCB = &satNonChainedWriteNVerifyCB;
15750   }
15751   else
15752   {
15753     TI_DBG1(("satWriteAndVerify16: CHAINED data\n"));
15754     /* re-setting tl */
15755     if (fis->h.command == SAT_WRITE_SECTORS || fis->h.command == SAT_WRITE_DMA)
15756     {
15757        fis->d.sectorCount    = 0xFF;
15758     }
15759     else if (fis->h.command == SAT_WRITE_SECTORS_EXT ||
15760              fis->h.command == SAT_WRITE_DMA_EXT ||
15761              fis->h.command == SAT_WRITE_DMA_FUA_EXT
15762              )
15763     {
15764       fis->d.sectorCount    = 0xFF;
15765       fis->d.sectorCountExp = 0xFF;
15766     }
15767     else
15768     {
15769       /* SAT_WRITE_FPDMA_QUEUED */
15770       fis->h.features       = 0xFF;
15771       fis->d.featuresExp    = 0xFF;
15772     }
15773
15774     /* Initialize CB for SATA completion.
15775      */
15776     satIOContext->satCompleteCB = &satChainedWriteNVerifyCB;
15777   }
15778
15779
15780   /*
15781    * Prepare SGL and send FIS to LL layer.
15782    */
15783   satIOContext->reqType = agRequestType;       /* Save it */
15784
15785   status = sataLLIOStart( tiRoot,
15786                           tiIORequest,
15787                           tiDeviceHandle,
15788                           tiScsiRequest,
15789                           satIOContext);
15790   return (status);
15791 }
15792
15793 /*****************************************************************************/
15794 /*! \brief SAT implementation for SCSI satReadMediaSerialNumber.
15795  *
15796  *  SAT implementation for SCSI Read Media Serial Number.
15797  *
15798  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
15799  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
15800  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
15801  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
15802  *  \param   satIOContext_t:   Pointer to the SAT IO Context
15803  *
15804  *  \return If command is started successfully
15805  *    - \e tiSuccess:     I/O request successfully initiated.
15806  *    - \e tiBusy:        No resources available, try again later.
15807  *    - \e tiIONoDevice:  Invalid device handle.
15808  *    - \e tiError:       Other errors.
15809  */
15810 /*****************************************************************************/
15811 GLOBAL bit32  satReadMediaSerialNumber(
15812                    tiRoot_t                  *tiRoot,
15813                    tiIORequest_t             *tiIORequest,
15814                    tiDeviceHandle_t          *tiDeviceHandle,
15815                    tiScsiInitiatorRequest_t  *tiScsiRequest,
15816                    satIOContext_t            *satIOContext)
15817 {
15818   bit32                     status;
15819   bit32                     agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
15820   satDeviceData_t           *pSatDevData;
15821   scsiRspSense_t            *pSense;
15822   tiIniScsiCmnd_t           *scsiCmnd;
15823   agsaFisRegHostToDevice_t  *fis;
15824   agsaSATAIdentifyData_t    *pSATAIdData;
15825   bit8                      *pSerialNumber;
15826
15827   pSense        = satIOContext->pSense;
15828   pSatDevData   = satIOContext->pSatDevData;
15829   scsiCmnd      = &tiScsiRequest->scsiCmnd;
15830   fis           = satIOContext->pFis;
15831   pSATAIdData   = &(pSatDevData->satIdentifyData);
15832   pSerialNumber = (bit8 *) tiScsiRequest->sglVirtualAddr;
15833
15834
15835   TI_DBG1(("satReadMediaSerialNumber: start\n"));
15836
15837   /* checking CONTROL */
15838   /* NACA == 1 or LINK == 1*/
15839   if ( (scsiCmnd->cdb[11] & SCSI_NACA_MASK) || (scsiCmnd->cdb[11] & SCSI_LINK_MASK) )
15840   {
15841     satSetSensePayload( pSense,
15842                         SCSI_SNSKEY_ILLEGAL_REQUEST,
15843                         0,
15844                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
15845                         satIOContext);
15846
15847     ostiInitiatorIOCompleted( tiRoot,
15848                               tiIORequest,
15849                               tiIOSuccess,
15850                               SCSI_STAT_CHECK_CONDITION,
15851                               satIOContext->pTiSenseData,
15852                               satIOContext->interruptContext );
15853
15854     TI_DBG1(("satReadMediaSerialNumber: return control\n"));
15855     return tiSuccess;
15856   }
15857
15858   if (tiScsiRequest->scsiCmnd.expDataLength == 4)
15859   {
15860     if (pSATAIdData->commandSetFeatureDefault & 0x4)
15861     {
15862       TI_DBG1(("satReadMediaSerialNumber: Media serial number returning only length\n"));
15863       /* SPC-3 6.16 p192; filling in length */
15864       pSerialNumber[0] = 0;
15865       pSerialNumber[1] = 0;
15866       pSerialNumber[2] = 0;
15867       pSerialNumber[3] = 0x3C;
15868     }
15869     else
15870     {
15871       /* 1 sector - 4 = 512 - 4 to avoid underflow; 0x1fc*/
15872       pSerialNumber[0] = 0;
15873       pSerialNumber[1] = 0;
15874       pSerialNumber[2] = 0x1;
15875       pSerialNumber[3] = 0xfc;
15876     }
15877
15878     ostiInitiatorIOCompleted( tiRoot,
15879                               tiIORequest,
15880                               tiIOSuccess,
15881                               SCSI_STAT_GOOD,
15882                               agNULL,
15883                               satIOContext->interruptContext);
15884
15885     return tiSuccess;
15886   }
15887
15888   if ( pSatDevData->IDDeviceValid == agTRUE)
15889   {
15890     if (pSATAIdData->commandSetFeatureDefault & 0x4)
15891     {
15892       /* word87 bit2 Media serial number is valid */
15893       /* read word 176 to 205; length is 2*30 = 60 = 0x3C*/
15894       tdhexdump("ID satReadMediaSerialNumber", (bit8*)pSATAIdData->currentMediaSerialNumber, 2*30);
15895       /* SPC-3 6.16 p192; filling in length */
15896       pSerialNumber[0] = 0;
15897       pSerialNumber[1] = 0;
15898       pSerialNumber[2] = 0;
15899       pSerialNumber[3] = 0x3C;
15900       osti_memcpy(&pSerialNumber[4], (void *)pSATAIdData->currentMediaSerialNumber, 60);
15901       tdhexdump("satReadMediaSerialNumber", (bit8*)pSerialNumber, 2*30 + 4);
15902
15903       ostiInitiatorIOCompleted( tiRoot,
15904                                 tiIORequest,
15905                                 tiIOSuccess,
15906                                 SCSI_STAT_GOOD,
15907                                 agNULL,
15908                                 satIOContext->interruptContext);
15909       return tiSuccess;
15910
15911
15912     }
15913     else
15914     {
15915      /* word87 bit2 Media serial number is NOT valid */
15916       TI_DBG1(("satReadMediaSerialNumber: Media serial number is NOT valid \n"));
15917
15918       if (pSatDevData->sat48BitSupport == agTRUE)
15919       {
15920         /* READ VERIFY SECTORS EXT */
15921         fis->h.fisType        = 0x27;                   /* Reg host to device */
15922         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
15923         fis->h.command        = SAT_READ_SECTORS_EXT;      /* 0x24 */
15924
15925         fis->h.features       = 0;                      /* FIS reserve */
15926         fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
15927         fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
15928         fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
15929         fis->d.device         = 0x40;                   /* FIS LBA mode set */
15930         fis->d.lbaLowExp      = 0;                      /* FIS LBA (31:24) */
15931         fis->d.lbaMidExp      = 0;                      /* FIS LBA (39:32) */
15932         fis->d.lbaHighExp     = 0;                      /* FIS LBA (47:40) */
15933         fis->d.featuresExp    = 0;                      /* FIS reserve */
15934         fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
15935         fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
15936         fis->d.reserved4      = 0;
15937         fis->d.control        = 0;                      /* FIS HOB bit clear */
15938         fis->d.reserved5      = 0;
15939
15940         agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
15941       }
15942       else
15943       {
15944         /* READ VERIFY SECTORS */
15945         fis->h.fisType        = 0x27;                   /* Reg host to device */
15946         fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
15947         fis->h.command        = SAT_READ_SECTORS;       /* 0x20 */
15948         fis->h.features       = 0;                      /* FIS reserve */
15949         fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
15950         fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
15951         fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
15952         fis->d.device         = 0x40;                   /* FIS LBA (27:24) and FIS LBA mode  */
15953         fis->d.lbaLowExp      = 0;
15954         fis->d.lbaMidExp      = 0;
15955         fis->d.lbaHighExp     = 0;
15956         fis->d.featuresExp    = 0;
15957         fis->d.sectorCount    = 1;                       /* FIS sector count (7:0) */
15958         fis->d.sectorCountExp = 0;
15959         fis->d.reserved4      = 0;
15960         fis->d.control        = 0;                      /* FIS HOB bit clear */
15961         fis->d.reserved5      = 0;
15962
15963
15964         agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
15965       }
15966       satIOContext->satCompleteCB = &satReadMediaSerialNumberCB;
15967       satIOContext->reqType = agRequestType;       /* Save it */
15968       status = sataLLIOStart( tiRoot,
15969                              tiIORequest,
15970                              tiDeviceHandle,
15971                              tiScsiRequest,
15972                              satIOContext);
15973
15974       return status;
15975     }
15976   }
15977   else
15978   {
15979      /* temporary failure */
15980     ostiInitiatorIOCompleted( tiRoot,
15981                               tiIORequest,
15982                               tiIOFailed,
15983                               tiDetailOtherError,
15984                               agNULL,
15985                               satIOContext->interruptContext);
15986
15987     return tiSuccess;
15988
15989   }
15990
15991 }
15992
15993 /*****************************************************************************/
15994 /*! \brief SAT implementation for SCSI satReadBuffer.
15995  *
15996  *  SAT implementation for SCSI Read Buffer.
15997  *
15998  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
15999  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
16000  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
16001  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
16002  *  \param   satIOContext_t:   Pointer to the SAT IO Context
16003  *
16004  *  \return If command is started successfully
16005  *    - \e tiSuccess:     I/O request successfully initiated.
16006  *    - \e tiBusy:        No resources available, try again later.
16007  *    - \e tiIONoDevice:  Invalid device handle.
16008  *    - \e tiError:       Other errors.
16009  */
16010 /*****************************************************************************/
16011 /* SAT-2, Revision 00*/
16012 GLOBAL bit32  satReadBuffer(
16013                    tiRoot_t                  *tiRoot,
16014                    tiIORequest_t             *tiIORequest,
16015                    tiDeviceHandle_t          *tiDeviceHandle,
16016                    tiScsiInitiatorRequest_t *tiScsiRequest,
16017                    satIOContext_t            *satIOContext)
16018 {
16019   bit32                     status = tiSuccess;
16020   bit32                     agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
16021   scsiRspSense_t            *pSense;
16022   tiIniScsiCmnd_t           *scsiCmnd;
16023   agsaFisRegHostToDevice_t  *fis;
16024   bit32                     bufferOffset;
16025   bit32                     tl;
16026   bit8                      mode;
16027   bit8                      bufferID;
16028   bit8                      *pBuff;
16029
16030   pSense        = satIOContext->pSense;
16031   scsiCmnd      = &tiScsiRequest->scsiCmnd;
16032   fis           = satIOContext->pFis;
16033   pBuff         = (bit8 *) tiScsiRequest->sglVirtualAddr;
16034
16035   TI_DBG2(("satReadBuffer: start\n"));
16036   /* checking CONTROL */
16037   /* NACA == 1 or LINK == 1*/
16038   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
16039   {
16040     satSetSensePayload( pSense,
16041                         SCSI_SNSKEY_ILLEGAL_REQUEST,
16042                         0,
16043                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
16044                         satIOContext);
16045     ostiInitiatorIOCompleted( tiRoot,
16046                               tiIORequest,
16047                               tiIOSuccess,
16048                               SCSI_STAT_CHECK_CONDITION,
16049                               satIOContext->pTiSenseData,
16050                               satIOContext->interruptContext );
16051     TI_DBG1(("satReadBuffer: return control\n"));
16052     return tiSuccess;
16053   }
16054
16055   bufferOffset = (scsiCmnd->cdb[3] << (8*2)) + (scsiCmnd->cdb[4] << 8) + scsiCmnd->cdb[5];
16056   tl = (scsiCmnd->cdb[6] << (8*2)) + (scsiCmnd->cdb[7] << 8) + scsiCmnd->cdb[8];
16057
16058   mode = (bit8)(scsiCmnd->cdb[1] & SCSI_READ_BUFFER_MODE_MASK);
16059   bufferID = scsiCmnd->cdb[2];
16060
16061   if (mode == READ_BUFFER_DATA_MODE) /* 2 */
16062   {
16063     if (bufferID == 0 && bufferOffset == 0 && tl == 512)
16064     {
16065       /* send ATA READ BUFFER */
16066       fis->h.fisType        = 0x27;                   /* Reg host to device */
16067       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
16068       fis->h.command        = SAT_READ_BUFFER;        /* 0xE4 */
16069       fis->h.features       = 0;                      /* FIS reserve */
16070       fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
16071       fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
16072       fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
16073       fis->d.device         = 0x40;                   /* FIS LBA (27:24) and FIS LBA mode  */
16074       fis->d.lbaLowExp      = 0;
16075       fis->d.lbaMidExp      = 0;
16076       fis->d.lbaHighExp     = 0;
16077       fis->d.featuresExp    = 0;
16078       fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
16079       fis->d.sectorCountExp = 0;
16080       fis->d.reserved4      = 0;
16081       fis->d.control        = 0;                      /* FIS HOB bit clear */
16082       fis->d.reserved5      = 0;
16083
16084       agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
16085       satIOContext->satCompleteCB = &satReadBufferCB;
16086       satIOContext->reqType = agRequestType;       /* Save it */
16087
16088       status = sataLLIOStart( tiRoot,
16089                               tiIORequest,
16090                               tiDeviceHandle,
16091                               tiScsiRequest,
16092                               satIOContext);
16093       return status;
16094     }
16095     if (bufferID == 0 && bufferOffset == 0 && tl != 512)
16096     {
16097       satSetSensePayload( pSense,
16098                           SCSI_SNSKEY_ILLEGAL_REQUEST,
16099                           0,
16100                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
16101                           satIOContext);
16102       ostiInitiatorIOCompleted( tiRoot,
16103                                 tiIORequest,
16104                                 tiIOSuccess,
16105                                 SCSI_STAT_CHECK_CONDITION,
16106                                 satIOContext->pTiSenseData,
16107                                 satIOContext->interruptContext );
16108       TI_DBG1(("satReadBuffer: allocation length is not 512; it is %d\n", tl));
16109       return tiSuccess;
16110     }
16111     if (bufferID == 0 && bufferOffset != 0)
16112     {
16113       satSetSensePayload( pSense,
16114                           SCSI_SNSKEY_ILLEGAL_REQUEST,
16115                           0,
16116                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
16117                           satIOContext);
16118       ostiInitiatorIOCompleted( tiRoot,
16119                                 tiIORequest,
16120                                 tiIOSuccess,
16121                                 SCSI_STAT_CHECK_CONDITION,
16122                                 satIOContext->pTiSenseData,
16123                                 satIOContext->interruptContext );
16124       TI_DBG1(("satReadBuffer: buffer offset is not 0; it is %d\n", bufferOffset));
16125       return tiSuccess;
16126     }
16127     /* all other cases unsupported */
16128     TI_DBG1(("satReadBuffer: unsupported case 1\n"));
16129     satSetSensePayload( pSense,
16130                           SCSI_SNSKEY_ILLEGAL_REQUEST,
16131                           0,
16132                           SCSI_SNSCODE_INVALID_COMMAND,
16133                           satIOContext);
16134
16135     ostiInitiatorIOCompleted( tiRoot,
16136                                 tiIORequest,
16137                                 tiIOSuccess,
16138                                 SCSI_STAT_CHECK_CONDITION,
16139                                 satIOContext->pTiSenseData,
16140                                 satIOContext->interruptContext );
16141     return tiSuccess;
16142   }
16143   else if (mode == READ_BUFFER_DESCRIPTOR_MODE) /* 3 */
16144   {
16145     if (tl < READ_BUFFER_DESCRIPTOR_MODE_DATA_LEN) /* 4 */
16146     {
16147       satSetSensePayload( pSense,
16148                           SCSI_SNSKEY_ILLEGAL_REQUEST,
16149                           0,
16150                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
16151                           satIOContext);
16152       ostiInitiatorIOCompleted( tiRoot,
16153                                 tiIORequest,
16154                                 tiIOSuccess,
16155                                 SCSI_STAT_CHECK_CONDITION,
16156                                 satIOContext->pTiSenseData,
16157                                 satIOContext->interruptContext );
16158       TI_DBG1(("satReadBuffer: tl < 4; tl is %d\n", tl));
16159       return tiSuccess;
16160     }
16161     if (bufferID == 0)
16162     {
16163       /* SPC-4, 6.15.5, p189; SAT-2 Rev00, 8.7.2.3, p41*/
16164       pBuff[0] = 0xFF;
16165       pBuff[1] = 0x00;
16166       pBuff[2] = 0x02;
16167       pBuff[3] = 0x00;
16168       if (READ_BUFFER_DESCRIPTOR_MODE_DATA_LEN < tl)
16169       {
16170         /* underrrun */
16171         TI_DBG1(("satReadBuffer: underrun tl %d data %d\n", tl, READ_BUFFER_DESCRIPTOR_MODE_DATA_LEN));
16172         ostiInitiatorIOCompleted( tiRoot,
16173                                 tiIORequest,
16174                                 tiIOUnderRun,
16175                                 tl - READ_BUFFER_DESCRIPTOR_MODE_DATA_LEN,
16176                                 agNULL,
16177                                 satIOContext->interruptContext );
16178         return tiSuccess;
16179       }
16180       else
16181       {
16182         ostiInitiatorIOCompleted( tiRoot,
16183                                   tiIORequest,
16184                                   tiIOSuccess,
16185                                   SCSI_STAT_GOOD,
16186                                   agNULL,
16187                                   satIOContext->interruptContext);
16188         return tiSuccess;
16189       }
16190     }
16191     else
16192     {
16193       /* We don't support other than bufferID 0 */
16194       satSetSensePayload( pSense,
16195                           SCSI_SNSKEY_ILLEGAL_REQUEST,
16196                           0,
16197                           SCSI_SNSCODE_INVALID_COMMAND,
16198                           satIOContext);
16199
16200       ostiInitiatorIOCompleted( tiRoot,
16201                                 tiIORequest,
16202                                 tiIOSuccess,
16203                                 SCSI_STAT_CHECK_CONDITION,
16204                                 satIOContext->pTiSenseData,
16205                                 satIOContext->interruptContext );
16206       return tiSuccess;
16207     }
16208   }
16209   else
16210   {
16211     /* We don't support any other mode */
16212     TI_DBG1(("satReadBuffer: unsupported mode %d\n", mode));
16213     satSetSensePayload( pSense,
16214                           SCSI_SNSKEY_ILLEGAL_REQUEST,
16215                           0,
16216                           SCSI_SNSCODE_INVALID_COMMAND,
16217                           satIOContext);
16218
16219     ostiInitiatorIOCompleted( tiRoot,
16220                                 tiIORequest,
16221                                 tiIOSuccess,
16222                                 SCSI_STAT_CHECK_CONDITION,
16223                                 satIOContext->pTiSenseData,
16224                                 satIOContext->interruptContext );
16225     return tiSuccess;
16226   }
16227 }
16228
16229 /*****************************************************************************/
16230 /*! \brief SAT implementation for SCSI satWriteBuffer.
16231  *
16232  *  SAT implementation for SCSI Write Buffer.
16233  *
16234  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
16235  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
16236  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
16237  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
16238  *  \param   satIOContext_t:   Pointer to the SAT IO Context
16239  *
16240  *  \return If command is started successfully
16241  *    - \e tiSuccess:     I/O request successfully initiated.
16242  *    - \e tiBusy:        No resources available, try again later.
16243  *    - \e tiIONoDevice:  Invalid device handle.
16244  *    - \e tiError:       Other errors.
16245  */
16246 /*****************************************************************************/
16247 /* SAT-2, Revision 00*/
16248 GLOBAL bit32  satWriteBuffer(
16249                    tiRoot_t                  *tiRoot,
16250                    tiIORequest_t             *tiIORequest,
16251                    tiDeviceHandle_t          *tiDeviceHandle,
16252                    tiScsiInitiatorRequest_t *tiScsiRequest,
16253                    satIOContext_t            *satIOContext)
16254 {
16255 #ifdef NOT_YET
16256   bit32                     agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
16257 #endif
16258   scsiRspSense_t            *pSense;
16259   tiIniScsiCmnd_t           *scsiCmnd;
16260   bit32                     bufferOffset;
16261   bit32                     parmLen;
16262   bit8                      mode;
16263   bit8                      bufferID;
16264   bit8                      *pBuff;
16265
16266   pSense        = satIOContext->pSense;
16267   scsiCmnd      = &tiScsiRequest->scsiCmnd;
16268   pBuff         = (bit8 *) tiScsiRequest->sglVirtualAddr;
16269
16270   TI_DBG2(("satWriteBuffer: start\n"));
16271
16272   /* checking CONTROL */
16273   /* NACA == 1 or LINK == 1*/
16274   if ( (scsiCmnd->cdb[9] & SCSI_NACA_MASK) || (scsiCmnd->cdb[9] & SCSI_LINK_MASK) )
16275   {
16276     satSetSensePayload( pSense,
16277                         SCSI_SNSKEY_ILLEGAL_REQUEST,
16278                         0,
16279                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
16280                         satIOContext);
16281
16282     ostiInitiatorIOCompleted( tiRoot,
16283                               tiIORequest,
16284                               tiIOSuccess,
16285                               SCSI_STAT_CHECK_CONDITION,
16286                               satIOContext->pTiSenseData,
16287                               satIOContext->interruptContext );
16288
16289     TI_DBG1(("satWriteBuffer: return control\n"));
16290     return tiSuccess;
16291   }
16292
16293   bufferOffset = (scsiCmnd->cdb[3] << (8*2)) + (scsiCmnd->cdb[4] << 8) + scsiCmnd->cdb[5];
16294   parmLen = (scsiCmnd->cdb[6] << (8*2)) + (scsiCmnd->cdb[7] << 8) + scsiCmnd->cdb[8];
16295
16296   mode = (bit8)(scsiCmnd->cdb[1] & SCSI_READ_BUFFER_MODE_MASK);
16297   bufferID = scsiCmnd->cdb[2];
16298
16299   /* for debugging only */
16300   tdhexdump("satWriteBuffer pBuff", (bit8 *)pBuff, 24);
16301
16302   if (mode == WRITE_BUFFER_DATA_MODE) /* 2 */
16303   {
16304     if (bufferID == 0 && bufferOffset == 0 && parmLen == 512)
16305     {
16306       TI_DBG1(("satWriteBuffer: sending ATA WRITE BUFFER\n"));
16307       /* send ATA WRITE BUFFER */
16308 #ifdef NOT_YET
16309       fis->h.fisType        = 0x27;                   /* Reg host to device */
16310       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
16311       fis->h.command        = SAT_WRITE_BUFFER;       /* 0xE8 */
16312       fis->h.features       = 0;                      /* FIS reserve */
16313       fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
16314       fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
16315       fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
16316       fis->d.device         = 0x40;                   /* FIS LBA (27:24) and FIS LBA mode  */
16317       fis->d.lbaLowExp      = 0;
16318       fis->d.lbaMidExp      = 0;
16319       fis->d.lbaHighExp     = 0;
16320       fis->d.featuresExp    = 0;
16321       fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
16322       fis->d.sectorCountExp = 0;
16323       fis->d.reserved4      = 0;
16324       fis->d.control        = 0;                      /* FIS HOB bit clear */
16325       fis->d.reserved5      = 0;
16326
16327
16328       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
16329
16330       satIOContext->satCompleteCB = &satWriteBufferCB;
16331
16332       satIOContext->reqType = agRequestType;       /* Save it */
16333
16334       status = sataLLIOStart( tiRoot,
16335                               tiIORequest,
16336                               tiDeviceHandle,
16337                               tiScsiRequest,
16338                               satIOContext);
16339       return status;
16340 #endif
16341       /* temp */
16342       ostiInitiatorIOCompleted( tiRoot,
16343                                   tiIORequest,
16344                                   tiIOSuccess,
16345                                   SCSI_STAT_GOOD,
16346                                   agNULL,
16347                                   satIOContext->interruptContext);
16348       return tiSuccess;
16349     }
16350     if ( (bufferID == 0 && bufferOffset != 0) ||
16351          (bufferID == 0 && parmLen != 512)
16352         )
16353     {
16354       satSetSensePayload( pSense,
16355                           SCSI_SNSKEY_ILLEGAL_REQUEST,
16356                           0,
16357                           SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
16358                           satIOContext);
16359
16360       ostiInitiatorIOCompleted( tiRoot,
16361                                 tiIORequest,
16362                                 tiIOSuccess,
16363                                 SCSI_STAT_CHECK_CONDITION,
16364                                 satIOContext->pTiSenseData,
16365                                 satIOContext->interruptContext );
16366
16367       TI_DBG1(("satWriteBuffer: wrong buffer offset %d or parameter length parmLen %d\n", bufferOffset, parmLen));
16368       return tiSuccess;
16369     }
16370
16371     /* all other cases unsupported */
16372     TI_DBG1(("satWriteBuffer: unsupported case 1\n"));
16373     satSetSensePayload( pSense,
16374                           SCSI_SNSKEY_ILLEGAL_REQUEST,
16375                           0,
16376                           SCSI_SNSCODE_INVALID_COMMAND,
16377                           satIOContext);
16378
16379     ostiInitiatorIOCompleted( tiRoot,
16380                                 tiIORequest,
16381                                 tiIOSuccess,
16382                                 SCSI_STAT_CHECK_CONDITION,
16383                                 satIOContext->pTiSenseData,
16384                                 satIOContext->interruptContext );
16385
16386     return tiSuccess;
16387
16388   }
16389   else if (mode == WRITE_BUFFER_DL_MICROCODE_SAVE_MODE) /* 5 */
16390   {
16391     TI_DBG1(("satWriteBuffer: not yet supported mode %d\n", mode));
16392     satSetSensePayload( pSense,
16393                           SCSI_SNSKEY_ILLEGAL_REQUEST,
16394                           0,
16395                           SCSI_SNSCODE_INVALID_COMMAND,
16396                           satIOContext);
16397
16398     ostiInitiatorIOCompleted( tiRoot,
16399                                 tiIORequest,
16400                                 tiIOSuccess,
16401                                 SCSI_STAT_CHECK_CONDITION,
16402                                 satIOContext->pTiSenseData,
16403                                 satIOContext->interruptContext );
16404
16405     return tiSuccess;
16406   }
16407   else
16408   {
16409     /* We don't support any other mode */
16410     TI_DBG1(("satWriteBuffer: unsupported mode %d\n", mode));
16411     satSetSensePayload( pSense,
16412                           SCSI_SNSKEY_ILLEGAL_REQUEST,
16413                           0,
16414                           SCSI_SNSCODE_INVALID_COMMAND,
16415                           satIOContext);
16416
16417     ostiInitiatorIOCompleted( tiRoot,
16418                                 tiIORequest,
16419                                 tiIOSuccess,
16420                                 SCSI_STAT_CHECK_CONDITION,
16421                                 satIOContext->pTiSenseData,
16422                                 satIOContext->interruptContext );
16423
16424     return tiSuccess;
16425   }
16426
16427 }
16428
16429 /*****************************************************************************/
16430 /*! \brief SAT implementation for SCSI satReassignBlocks.
16431  *
16432  *  SAT implementation for SCSI Reassign Blocks.
16433  *
16434  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
16435  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
16436  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
16437  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
16438  *  \param   satIOContext_t:   Pointer to the SAT IO Context
16439  *
16440  *  \return If command is started successfully
16441  *    - \e tiSuccess:     I/O request successfully initiated.
16442  *    - \e tiBusy:        No resources available, try again later.
16443  *    - \e tiIONoDevice:  Invalid device handle.
16444  *    - \e tiError:       Other errors.
16445  */
16446 /*****************************************************************************/
16447 GLOBAL bit32  satReassignBlocks(
16448                    tiRoot_t                  *tiRoot,
16449                    tiIORequest_t             *tiIORequest,
16450                    tiDeviceHandle_t          *tiDeviceHandle,
16451                    tiScsiInitiatorRequest_t *tiScsiRequest,
16452                    satIOContext_t            *satIOContext)
16453 {
16454   /*
16455     assumes all LBA fits in ATA command; no boundary condition is checked here yet
16456   */
16457   bit32                     status;
16458   bit32                     agRequestType;
16459   satDeviceData_t           *pSatDevData;
16460   scsiRspSense_t            *pSense;
16461   tiIniScsiCmnd_t           *scsiCmnd;
16462   agsaFisRegHostToDevice_t  *fis;
16463   bit8                      *pParmList;    /* Log Page data buffer */
16464   bit8                      LongLBA;
16465   bit8                      LongList;
16466   bit32                     defectListLen;
16467   bit8                      LBA[8];
16468   bit32                     startingIndex;
16469
16470   pSense        = satIOContext->pSense;
16471   pSatDevData   = satIOContext->pSatDevData;
16472   scsiCmnd      = &tiScsiRequest->scsiCmnd;
16473   fis           = satIOContext->pFis;
16474   pParmList     = (bit8 *) tiScsiRequest->sglVirtualAddr;
16475
16476   TI_DBG5(("satReassignBlocks: start\n"));
16477
16478   /* checking CONTROL */
16479   /* NACA == 1 or LINK == 1*/
16480   if ( (scsiCmnd->cdb[5] & SCSI_NACA_MASK) || (scsiCmnd->cdb[5] & SCSI_LINK_MASK) )
16481   {
16482     satSetSensePayload( pSense,
16483                         SCSI_SNSKEY_ILLEGAL_REQUEST,
16484                         0,
16485                         SCSI_SNSCODE_INVALID_FIELD_IN_CDB,
16486                         satIOContext);
16487
16488     ostiInitiatorIOCompleted( tiRoot,
16489                               tiIORequest,
16490                               tiIOSuccess,
16491                               SCSI_STAT_CHECK_CONDITION,
16492                               satIOContext->pTiSenseData,
16493                               satIOContext->interruptContext );
16494
16495     TI_DBG1(("satReassignBlocks: return control\n"));
16496     return tiSuccess;
16497   }
16498
16499   osti_memset(satIOContext->LBA, 0, 8);
16500   satIOContext->ParmIndex = 0;
16501   satIOContext->ParmLen = 0;
16502
16503   LongList = (bit8)(scsiCmnd->cdb[1] & SCSI_REASSIGN_BLOCKS_LONGLIST_MASK);
16504   LongLBA = (bit8)(scsiCmnd->cdb[1] & SCSI_REASSIGN_BLOCKS_LONGLBA_MASK);
16505   osti_memset(LBA, 0, sizeof(LBA));
16506
16507   if (LongList == 0)
16508   {
16509     defectListLen = (pParmList[2] << 8) + pParmList[3];
16510   }
16511   else
16512   {
16513     defectListLen = (pParmList[0] << (8*3)) + (pParmList[1] << (8*2))
16514                   + (pParmList[2] << 8) + pParmList[3];
16515   }
16516   /* SBC 5.16.2, p61*/
16517   satIOContext->ParmLen = defectListLen + 4 /* header size */;
16518
16519   startingIndex = 4;
16520
16521   if (LongLBA == 0)
16522   {
16523     LBA[4] = pParmList[startingIndex];   /* MSB */
16524     LBA[5] = pParmList[startingIndex+1];
16525     LBA[6] = pParmList[startingIndex+2];
16526     LBA[7] = pParmList[startingIndex+3];  /* LSB */
16527     startingIndex = startingIndex + 4;
16528   }
16529   else
16530   {
16531     LBA[0] = pParmList[startingIndex];    /* MSB */
16532     LBA[1] = pParmList[startingIndex+1];
16533     LBA[2] = pParmList[startingIndex+2];
16534     LBA[3] = pParmList[startingIndex+3];
16535     LBA[4] = pParmList[startingIndex+4];
16536     LBA[5] = pParmList[startingIndex+5];
16537     LBA[6] = pParmList[startingIndex+6];
16538     LBA[7] = pParmList[startingIndex+7];  /* LSB */
16539     startingIndex = startingIndex + 8;
16540   }
16541
16542   tdhexdump("satReassignBlocks Parameter list", (bit8 *)pParmList, 4 + defectListLen);
16543
16544   if (pSatDevData->sat48BitSupport == agTRUE)
16545   {
16546     /* sends READ VERIFY SECTOR(S) EXT*/
16547     fis->h.fisType        = 0x27;                   /* Reg host to device */
16548     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
16549     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
16550     fis->h.features       = 0;                      /* FIS reserve */
16551     fis->d.lbaLow         = LBA[7];                 /* FIS LBA (7 :0 ) */
16552     fis->d.lbaMid         = LBA[6];                 /* FIS LBA (15:8 ) */
16553     fis->d.lbaHigh        = LBA[5];                 /* FIS LBA (23:16) */
16554     fis->d.lbaLowExp      = LBA[4];                 /* FIS LBA (31:24) */
16555     fis->d.lbaMidExp      = LBA[3];                 /* FIS LBA (39:32) */
16556     fis->d.lbaHighExp     = LBA[2];                 /* FIS LBA (47:40) */
16557     fis->d.featuresExp    = 0;                      /* FIS reserve */
16558     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
16559     fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
16560     fis->d.reserved4      = 0;
16561     fis->d.device         = 0x40;                   /* 01000000 */
16562     fis->d.control        = 0;                      /* FIS HOB bit clear */
16563     fis->d.reserved5      = 0;
16564   }
16565   else
16566   {
16567     /* READ VERIFY SECTOR(S)*/
16568     fis->h.fisType        = 0x27;                   /* Reg host to device */
16569     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
16570     fis->h.command        = SAT_READ_VERIFY_SECTORS;/* 0x40 */
16571     fis->h.features       = 0;                      /* FIS features NA       */
16572     fis->d.lbaLow         = LBA[7];                 /* FIS LBA (7 :0 ) */
16573     fis->d.lbaMid         = LBA[6];                 /* FIS LBA (15:8 ) */
16574     fis->d.lbaHigh        = LBA[5];                 /* FIS LBA (23:16) */
16575     fis->d.lbaLowExp      = 0;
16576     fis->d.lbaMidExp      = 0;
16577     fis->d.lbaHighExp     = 0;
16578     fis->d.featuresExp    = 0;
16579     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
16580     fis->d.sectorCountExp = 0;
16581     fis->d.reserved4      = 0;
16582     fis->d.device         = (bit8)((0x4 << 4) | (LBA[4] & 0xF));
16583                             /* DEV and LBA 27:24 */
16584     fis->d.control        = 0;                      /* FIS HOB bit clear */
16585     fis->d.reserved5      = 0;
16586   }
16587
16588   osti_memcpy(satIOContext->LBA, LBA, 8);
16589   satIOContext->ParmIndex = startingIndex;
16590
16591   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
16592
16593   /* Initialize CB for SATA completion.
16594    */
16595   satIOContext->satCompleteCB = &satReassignBlocksCB;
16596
16597   /*
16598    * Prepare SGL and send FIS to LL layer.
16599    */
16600   satIOContext->reqType = agRequestType;       /* Save it */
16601
16602   status = sataLLIOStart( tiRoot,
16603                           tiIORequest,
16604                           tiDeviceHandle,
16605                           tiScsiRequest,
16606                           satIOContext);
16607
16608   return status;
16609 }
16610
16611 /*****************************************************************************/
16612 /*! \brief SAT implementation for SCSI satReassignBlocks_1.
16613  *
16614  *  SAT implementation for SCSI Reassign Blocks. This is helper function for
16615  *  satReassignBlocks and satReassignBlocksCB. This sends ATA verify command.
16616  *
16617  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
16618  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
16619  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
16620  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
16621  *  \param   satIOContext_t:   Pointer to the SAT IO Context
16622  *
16623  *  \return If command is started successfully
16624  *    - \e tiSuccess:     I/O request successfully initiated.
16625  *    - \e tiBusy:        No resources available, try again later.
16626  *    - \e tiIONoDevice:  Invalid device handle.
16627  *    - \e tiError:       Other errors.
16628  */
16629 /*****************************************************************************/
16630 /* next LBA; sends READ VERIFY SECTOR; update LBA and ParmIdx */
16631 GLOBAL bit32  satReassignBlocks_1(
16632                    tiRoot_t                  *tiRoot,
16633                    tiIORequest_t             *tiIORequest,
16634                    tiDeviceHandle_t          *tiDeviceHandle,
16635                    tiScsiInitiatorRequest_t *tiScsiRequest,
16636                    satIOContext_t            *satIOContext,
16637                    satIOContext_t            *satOrgIOContext
16638                    )
16639 {
16640   /*
16641     assumes all LBA fits in ATA command; no boundary condition is checked here yet
16642     tiScsiRequest is OS generated; needs for accessing parameter list
16643   */
16644   bit32                     agRequestType;
16645   satDeviceData_t           *pSatDevData;
16646   tiIniScsiCmnd_t           *scsiCmnd;
16647   agsaFisRegHostToDevice_t  *fis;
16648   bit8                      *pParmList;    /* Log Page data buffer */
16649   bit8                      LongLBA;
16650   bit8                      LBA[8];
16651   bit32                     startingIndex;
16652
16653   pSatDevData   = satIOContext->pSatDevData;
16654   scsiCmnd      = &tiScsiRequest->scsiCmnd;
16655   fis           = satIOContext->pFis;
16656   pParmList     = (bit8 *) tiScsiRequest->sglVirtualAddr;
16657
16658   TI_DBG5(("satReassignBlocks_1: start\n"));
16659
16660   LongLBA = (bit8)(scsiCmnd->cdb[1] & SCSI_REASSIGN_BLOCKS_LONGLBA_MASK);
16661   osti_memset(LBA, 0, sizeof(LBA));
16662
16663   startingIndex = satOrgIOContext->ParmIndex;
16664
16665   if (LongLBA == 0)
16666   {
16667     LBA[4] = pParmList[startingIndex];
16668     LBA[5] = pParmList[startingIndex+1];
16669     LBA[6] = pParmList[startingIndex+2];
16670     LBA[7] = pParmList[startingIndex+3];
16671     startingIndex = startingIndex + 4;
16672   }
16673   else
16674   {
16675     LBA[0] = pParmList[startingIndex];
16676     LBA[1] = pParmList[startingIndex+1];
16677     LBA[2] = pParmList[startingIndex+2];
16678     LBA[3] = pParmList[startingIndex+3];
16679     LBA[4] = pParmList[startingIndex+4];
16680     LBA[5] = pParmList[startingIndex+5];
16681     LBA[6] = pParmList[startingIndex+6];
16682     LBA[7] = pParmList[startingIndex+7];
16683     startingIndex = startingIndex + 8;
16684   }
16685
16686   if (pSatDevData->sat48BitSupport == agTRUE)
16687   {
16688     /* sends READ VERIFY SECTOR(S) EXT*/
16689     fis->h.fisType        = 0x27;                   /* Reg host to device */
16690     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
16691     fis->h.command        = SAT_READ_VERIFY_SECTORS_EXT;/* 0x42 */
16692     fis->h.features       = 0;                      /* FIS reserve */
16693     fis->d.lbaLow         = LBA[7];                 /* FIS LBA (7 :0 ) */
16694     fis->d.lbaMid         = LBA[6];                 /* FIS LBA (15:8 ) */
16695     fis->d.lbaHigh        = LBA[5];                 /* FIS LBA (23:16) */
16696     fis->d.lbaLowExp      = LBA[4];                 /* FIS LBA (31:24) */
16697     fis->d.lbaMidExp      = LBA[3];                 /* FIS LBA (39:32) */
16698     fis->d.lbaHighExp     = LBA[2];                 /* FIS LBA (47:40) */
16699     fis->d.featuresExp    = 0;                      /* FIS reserve */
16700     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
16701     fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
16702     fis->d.reserved4      = 0;
16703     fis->d.device         = 0x40;                   /* 01000000 */
16704     fis->d.control        = 0;                      /* FIS HOB bit clear */
16705     fis->d.reserved5      = 0;
16706   }
16707   else
16708   {
16709     /* READ VERIFY SECTOR(S)*/
16710     fis->h.fisType        = 0x27;                   /* Reg host to device */
16711     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
16712     fis->h.command        = SAT_READ_VERIFY_SECTORS;/* 0x40 */
16713     fis->h.features       = 0;                      /* FIS features NA       */
16714     fis->d.lbaLow         = LBA[7];                 /* FIS LBA (7 :0 ) */
16715     fis->d.lbaMid         = LBA[6];                 /* FIS LBA (15:8 ) */
16716     fis->d.lbaHigh        = LBA[5];                 /* FIS LBA (23:16) */
16717     fis->d.lbaLowExp      = 0;
16718     fis->d.lbaMidExp      = 0;
16719     fis->d.lbaHighExp     = 0;
16720     fis->d.featuresExp    = 0;
16721     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
16722     fis->d.sectorCountExp = 0;
16723     fis->d.reserved4      = 0;
16724     fis->d.device         = (bit8)((0x4 << 4) | (LBA[4] & 0xF));
16725                             /* DEV and LBA 27:24 */
16726     fis->d.control        = 0;                      /* FIS HOB bit clear */
16727     fis->d.reserved5      = 0;
16728   }
16729   osti_memcpy(satOrgIOContext->LBA, LBA, 8);
16730   satOrgIOContext->ParmIndex = startingIndex;
16731   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
16732   /* Initialize CB for SATA completion.
16733    */
16734   satIOContext->satCompleteCB = &satReassignBlocksCB;
16735   /*
16736    * Prepare SGL and send FIS to LL layer.
16737    */
16738   satIOContext->reqType = agRequestType;       /* Save it */
16739
16740   sataLLIOStart( tiRoot,
16741                  tiIORequest,
16742                  tiDeviceHandle,
16743                  tiScsiRequest,
16744                  satIOContext );
16745   return tiSuccess;
16746 }
16747
16748 /*****************************************************************************/
16749 /*! \brief SAT implementation for SCSI satReassignBlocks_2.
16750  *
16751  *  SAT implementation for SCSI Reassign Blocks. This is helper function for
16752  *  satReassignBlocks and satReassignBlocksCB. This sends ATA write command.
16753  *
16754  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
16755  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
16756  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
16757  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
16758  *  \param   satIOContext_t:   Pointer to the SAT IO Context
16759  *  \param   LBA:              Pointer to the LBA to be processed
16760  *
16761  *  \return If command is started successfully
16762  *    - \e tiSuccess:     I/O request successfully initiated.
16763  *    - \e tiBusy:        No resources available, try again later.
16764  *    - \e tiIONoDevice:  Invalid device handle.
16765  *    - \e tiError:       Other errors.
16766  */
16767 /*****************************************************************************/
16768 /* current LBA; sends WRITE */
16769 GLOBAL bit32  satReassignBlocks_2(
16770                    tiRoot_t                  *tiRoot,
16771                    tiIORequest_t             *tiIORequest,
16772                    tiDeviceHandle_t          *tiDeviceHandle,
16773                    tiScsiInitiatorRequest_t *tiScsiRequest,
16774                    satIOContext_t            *satIOContext,
16775                    bit8                      *LBA
16776                    )
16777 {
16778   /*
16779     assumes all LBA fits in ATA command; no boundary condition is checked here yet
16780     tiScsiRequest is TD generated for writing
16781   */
16782   bit32                     status;
16783   bit32                     agRequestType;
16784   satDeviceData_t           *pSatDevData;
16785   scsiRspSense_t            *pSense;
16786   agsaFisRegHostToDevice_t  *fis;
16787
16788   pSense        = satIOContext->pSense;
16789   pSatDevData   = satIOContext->pSatDevData;
16790   fis           = satIOContext->pFis;
16791
16792   if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
16793   {
16794     /* case 2 */
16795     /* WRITE DMA*/
16796     /* can't fit the transfer length */
16797     TI_DBG5(("satReassignBlocks_2: case 2\n"));
16798     fis->h.fisType        = 0x27;                   /* Reg host to device */
16799     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
16800     fis->h.command        = SAT_WRITE_DMA;          /* 0xCA */
16801     fis->h.features       = 0;                      /* FIS reserve */
16802     fis->d.lbaLow         = LBA[7];                 /* FIS LBA (7 :0 ) */
16803     fis->d.lbaMid         = LBA[6];                 /* FIS LBA (15:8 ) */
16804     fis->d.lbaHigh        = LBA[5];                 /* FIS LBA (23:16) */
16805
16806     /* FIS LBA mode set LBA (27:24) */
16807     fis->d.device         = (bit8)((0x4 << 4) | (LBA[4] & 0xF));
16808
16809     fis->d.lbaLowExp      = 0;
16810     fis->d.lbaMidExp      = 0;
16811     fis->d.lbaHighExp     = 0;
16812     fis->d.featuresExp    = 0;
16813     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
16814     fis->d.sectorCountExp = 0;
16815     fis->d.reserved4      = 0;
16816     fis->d.control        = 0;                      /* FIS HOB bit clear */
16817     fis->d.reserved5      = 0;
16818
16819     agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
16820     satIOContext->ATACmd = SAT_WRITE_DMA;
16821   }
16822   else
16823   {
16824     /* case 1 */
16825     /* WRITE MULTIPLE or WRITE SECTOR(S) */
16826     /* WRITE SECTORS for easier implemetation */
16827     /* can't fit the transfer length */
16828     TI_DBG5(("satReassignBlocks_2: case 1\n"));
16829     fis->h.fisType        = 0x27;                   /* Reg host to device */
16830     fis->h.c_pmPort       = 0x80;                   /* C bit is set       */
16831     fis->h.command        = SAT_WRITE_SECTORS;      /* 0x30 */
16832     fis->h.features       = 0;                      /* FIS reserve */
16833     fis->d.lbaLow         = LBA[7];                 /* FIS LBA (7 :0 ) */
16834     fis->d.lbaMid         = LBA[6];                 /* FIS LBA (15:8 ) */
16835     fis->d.lbaHigh        = LBA[7];                 /* FIS LBA (23:16) */
16836
16837     /* FIS LBA mode set LBA (27:24) */
16838     fis->d.device         = (bit8)((0x4 << 4) | (LBA[4] & 0xF));
16839
16840     fis->d.lbaLowExp      = 0;
16841     fis->d.lbaMidExp      = 0;
16842     fis->d.lbaHighExp     = 0;
16843     fis->d.featuresExp    = 0;
16844     fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
16845     fis->d.sectorCountExp = 0;
16846     fis->d.reserved4      = 0;
16847     fis->d.control        = 0;                      /* FIS HOB bit clear */
16848     fis->d.reserved5      = 0;
16849
16850     agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
16851     satIOContext->ATACmd = SAT_WRITE_SECTORS;
16852   }
16853
16854   /* case 3 and 4 */
16855   if (pSatDevData->sat48BitSupport == agTRUE)
16856   {
16857     if (pSatDevData->satDMASupport == agTRUE && pSatDevData->satDMAEnabled == agTRUE)
16858     {
16859       /* case 3 */
16860       /* WRITE DMA EXT or WRITE DMA FUA EXT */
16861       TI_DBG5(("satReassignBlocks_2: case 3\n"));
16862       fis->h.fisType        = 0x27;                   /* Reg host to device */
16863       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
16864
16865       /* SAT_WRITE_DMA_FUA_EXT is optional and we don't support it */
16866       fis->h.command        = SAT_WRITE_DMA_EXT;      /* 0x35 */
16867       satIOContext->ATACmd  = SAT_WRITE_DMA_EXT;
16868
16869       fis->h.features       = 0;                      /* FIS reserve */
16870       fis->d.lbaLow         = LBA[7];                 /* FIS LBA (7 :0 ) */
16871       fis->d.lbaMid         = LBA[6];                 /* FIS LBA (15:8 ) */
16872       fis->d.lbaHigh        = LBA[5];                 /* FIS LBA (23:16) */
16873       fis->d.device         = 0x40;                   /* FIS LBA mode set */
16874       fis->d.lbaLowExp      = LBA[4];                 /* FIS LBA (31:24) */
16875       fis->d.lbaMidExp      = LBA[3];                 /* FIS LBA (39:32) */
16876       fis->d.lbaHighExp     = LBA[2];                 /* FIS LBA (47:40) */
16877       fis->d.featuresExp    = 0;                      /* FIS reserve */
16878       fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
16879       fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
16880       fis->d.reserved4      = 0;
16881       fis->d.control        = 0;                      /* FIS HOB bit clear */
16882       fis->d.reserved5      = 0;
16883
16884       agRequestType = AGSA_SATA_PROTOCOL_DMA_WRITE;
16885     }
16886     else
16887     {
16888       /* case 4 */
16889       /* WRITE MULTIPLE EXT or WRITE MULTIPLE FUA EXT or WRITE SECTOR(S) EXT */
16890       /* WRITE SECTORS EXT for easier implemetation */
16891       TI_DBG5(("satReassignBlocks_2: case 4\n"));
16892       fis->h.fisType        = 0x27;                   /* Reg host to device */
16893       fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
16894       fis->h.command        = SAT_WRITE_SECTORS_EXT;  /* 0x34 */
16895
16896       fis->h.features       = 0;                      /* FIS reserve */
16897       fis->d.lbaLow         = LBA[7];                 /* FIS LBA (7 :0 ) */
16898       fis->d.lbaMid         = LBA[6];                 /* FIS LBA (15:8 ) */
16899       fis->d.lbaHigh        = LBA[5];                 /* FIS LBA (23:16) */
16900       fis->d.device         = 0x40;                   /* FIS LBA mode set */
16901       fis->d.lbaLowExp      = LBA[4];                 /* FIS LBA (31:24) */
16902       fis->d.lbaMidExp      = LBA[3];                 /* FIS LBA (39:32) */
16903       fis->d.lbaHighExp     = LBA[2];                 /* FIS LBA (47:40) */
16904       fis->d.featuresExp    = 0;                      /* FIS reserve */
16905       fis->d.sectorCount    = 1;                      /* FIS sector count (7:0) */
16906       fis->d.sectorCountExp = 0;                      /* FIS sector count (15:8) */
16907       fis->d.reserved4      = 0;
16908       fis->d.control        = 0;                      /* FIS HOB bit clear */
16909       fis->d.reserved5      = 0;
16910
16911       agRequestType = AGSA_SATA_PROTOCOL_PIO_WRITE;
16912       satIOContext->ATACmd = SAT_WRITE_SECTORS_EXT;
16913     }
16914   }
16915   /* case 5 */
16916   if (pSatDevData->satNCQ == agTRUE)
16917   {
16918     /* WRITE FPDMA QUEUED */
16919     if (pSatDevData->sat48BitSupport != agTRUE)
16920     {
16921       TI_DBG5(("satReassignBlocks_2: case 5 !!! error NCQ but 28 bit address support \n"));
16922       satSetSensePayload( pSense,
16923                           SCSI_SNSKEY_HARDWARE_ERROR,
16924                           0,
16925                           SCSI_SNSCODE_WRITE_ERROR_AUTO_REALLOCATION_FAILED,
16926                           satIOContext);
16927
16928       ostiInitiatorIOCompleted( tiRoot,
16929                                 tiIORequest,
16930                                 tiIOSuccess,
16931                                 SCSI_STAT_CHECK_CONDITION,
16932                                 satIOContext->pTiSenseData,
16933                                 satIOContext->interruptContext );
16934       return tiSuccess;
16935     }
16936     TI_DBG6(("satWrite10: case 5\n"));
16937
16938     /* Support 48-bit FPDMA addressing, use WRITE FPDMA QUEUE command */
16939
16940     fis->h.fisType        = 0x27;                   /* Reg host to device */
16941     fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
16942     fis->h.command        = SAT_WRITE_FPDMA_QUEUED; /* 0x61 */
16943     fis->h.features       = 1;                      /* FIS sector count (7:0) */
16944     fis->d.lbaLow         = LBA[7];                 /* FIS LBA (7 :0 ) */
16945     fis->d.lbaMid         = LBA[6];                 /* FIS LBA (15:8 ) */
16946     fis->d.lbaHigh        = LBA[5];                 /* FIS LBA (23:16) */
16947
16948     /* Check FUA bit */
16949     fis->d.device       = 0x40;                     /* FIS FUA clear */
16950
16951     fis->d.lbaLowExp      = LBA[4];                 /* FIS LBA (31:24) */
16952     fis->d.lbaMidExp      = LBA[3];                 /* FIS LBA (39:32) */
16953     fis->d.lbaHighExp     = LBA[2];                 /* FIS LBA (47:40) */
16954     fis->d.featuresExp    = 0;                      /* FIS sector count (15:8) */
16955     fis->d.sectorCount    = 0;                      /* Tag (7:3) set by LL layer */
16956     fis->d.sectorCountExp = 0;
16957     fis->d.reserved4      = 0;
16958     fis->d.control        = 0;                      /* FIS HOB bit clear */
16959     fis->d.reserved5      = 0;
16960
16961     agRequestType = AGSA_SATA_PROTOCOL_FPDMA_WRITE;
16962     satIOContext->ATACmd = SAT_WRITE_FPDMA_QUEUED;
16963   }
16964
16965   satIOContext->satCompleteCB = &satReassignBlocksCB;
16966
16967   /*
16968    * Prepare SGL and send FIS to LL layer.
16969    */
16970   satIOContext->reqType = agRequestType;       /* Save it */
16971
16972   status = sataLLIOStart( tiRoot,
16973                           tiIORequest,
16974                           tiDeviceHandle,
16975                           /* not the original, should be the TD generated one */
16976                           tiScsiRequest,
16977                           satIOContext);
16978   return (status);
16979 }
16980
16981
16982 /*****************************************************************************/
16983 /*! \brief SAT implementation for SCSI satPrepareNewIO.
16984  *
16985  *  This function fills in the fields of internal IO generated by TD layer.
16986  *  This is mostly used in the callback functions.
16987  *
16988  *  \param   satNewIntIo:      Pointer to the internal IO structure.
16989  *  \param   tiOrgIORequest:   Pointer to the original tiIOrequest sent by OS layer
16990  *  \param   satDevData:       Pointer to the device data.
16991  *  \param   scsiCmnd:         Pointer to SCSI command.
16992  *  \param   satOrgIOContext:  Pointer to the original SAT IO Context
16993  *
16994  *  \return
16995  *    - \e Pointer to the new SAT IO Context
16996  */
16997 /*****************************************************************************/
16998 GLOBAL satIOContext_t *satPrepareNewIO(
16999                             satInternalIo_t         *satNewIntIo,
17000                             tiIORequest_t           *tiOrgIORequest,
17001                             satDeviceData_t         *satDevData,
17002                             tiIniScsiCmnd_t         *scsiCmnd,
17003                             satIOContext_t          *satOrgIOContext
17004                             )
17005 {
17006   satIOContext_t          *satNewIOContext;
17007   tdIORequestBody_t       *tdNewIORequestBody;
17008
17009   TI_DBG2(("satPrepareNewIO: start\n"));
17010
17011   /* the one to be used; good 8/2/07 */
17012   satNewIntIo->satOrgTiIORequest = tiOrgIORequest; /* this is already done in
17013                                                         satAllocIntIoResource() */
17014
17015   tdNewIORequestBody = (tdIORequestBody_t *)satNewIntIo->satIntRequestBody;
17016   satNewIOContext = &(tdNewIORequestBody->transport.SATA.satIOContext);
17017
17018   satNewIOContext->pSatDevData   = satDevData;
17019   satNewIOContext->pFis          = &(tdNewIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev);
17020   satNewIOContext->pScsiCmnd     = &(satNewIntIo->satIntTiScsiXchg.scsiCmnd);
17021   if (scsiCmnd != agNULL)
17022   {
17023     /* saves only CBD; not scsi command for LBA and number of blocks */
17024     osti_memcpy(satNewIOContext->pScsiCmnd->cdb, scsiCmnd->cdb, 16);
17025   }
17026   satNewIOContext->pSense        = &(tdNewIORequestBody->transport.SATA.sensePayload);
17027   satNewIOContext->pTiSenseData  = &(tdNewIORequestBody->transport.SATA.tiSenseData);
17028   satNewIOContext->pTiSenseData->senseData = satNewIOContext->pSense;
17029   satNewIOContext->tiRequestBody = satNewIntIo->satIntRequestBody;
17030   satNewIOContext->interruptContext = satNewIOContext->interruptContext;
17031   satNewIOContext->satIntIoContext  = satNewIntIo;
17032   satNewIOContext->ptiDeviceHandle = satOrgIOContext->ptiDeviceHandle;
17033   satNewIOContext->satOrgIOContext = satOrgIOContext;
17034   /* saves tiScsiXchg; only for writesame10() */
17035   satNewIOContext->tiScsiXchg = satOrgIOContext->tiScsiXchg;
17036
17037   return satNewIOContext;
17038 }
17039 /*****************************************************************************
17040  *! \brief  satIOAbort
17041  *
17042  *   This routine is called to initiate a I/O abort to SATL.
17043  *   This routine is independent of HW/LL API.
17044  *
17045  *  \param  tiRoot:     Pointer to TISA initiator driver/port instance.
17046  *  \param  taskTag:    Pointer to TISA I/O request context/tag to be aborted.
17047  *
17048  *  \return:
17049  *
17050  *  \e tiSuccess:     I/O request successfully initiated.
17051  *  \e tiBusy:        No resources available, try again later.
17052  *  \e tiError:       Other errors that prevent the I/O request to be started.
17053  *
17054  *
17055  *****************************************************************************/
17056 GLOBAL bit32 satIOAbort(
17057                           tiRoot_t      *tiRoot,
17058                           tiIORequest_t *taskTag )
17059 {
17060
17061   tdsaRoot_t          *tdsaRoot = (tdsaRoot_t *) tiRoot->tdData;
17062   tdsaContext_t       *tdsaAllShared = (tdsaContext_t *)&tdsaRoot->tdsaAllShared;
17063   agsaRoot_t          *agRoot;
17064   tdIORequestBody_t   *tdIORequestBody;
17065   tdIORequestBody_t   *tdIONewRequestBody;
17066   agsaIORequest_t     *agIORequest;
17067   bit32               status;
17068   agsaIORequest_t     *agAbortIORequest;
17069   tdIORequestBody_t   *tdAbortIORequestBody;
17070   bit32               PhysUpper32;
17071   bit32               PhysLower32;
17072   bit32               memAllocStatus;
17073   void                *osMemHandle;
17074   satIOContext_t      *satIOContext;
17075   satInternalIo_t     *satIntIo;
17076
17077   TI_DBG2(("satIOAbort: start\n"));
17078
17079   agRoot          = &(tdsaAllShared->agRootNonInt);
17080   tdIORequestBody = (tdIORequestBody_t *)taskTag->tdData;
17081
17082   /* needs to distinguish internally generated or externally generated */
17083   satIOContext = &(tdIORequestBody->transport.SATA.satIOContext);
17084   satIntIo     = satIOContext->satIntIoContext;
17085   if (satIntIo == agNULL)
17086   {
17087     TI_DBG1(("satIOAbort: External, OS generated\n"));
17088     agIORequest     = &(tdIORequestBody->agIORequest);
17089   }
17090   else
17091   {
17092     TI_DBG1(("satIOAbort: Internal, TD generated\n"));
17093     tdIONewRequestBody = (tdIORequestBody_t *)satIntIo->satIntRequestBody;
17094     agIORequest     = &(tdIONewRequestBody->agIORequest);
17095   }
17096
17097   /* allocating agIORequest for abort itself */
17098   memAllocStatus = ostiAllocMemory(
17099                                    tiRoot,
17100                                    &osMemHandle,
17101                                    (void **)&tdAbortIORequestBody,
17102                                    &PhysUpper32,
17103                                    &PhysLower32,
17104                                    8,
17105                                    sizeof(tdIORequestBody_t),
17106                                    agTRUE
17107                                    );
17108   if (memAllocStatus != tiSuccess)
17109   {
17110     /* let os process IO */
17111     TI_DBG1(("satIOAbort: ostiAllocMemory failed...\n"));
17112     return tiError;
17113   }
17114
17115   if (tdAbortIORequestBody == agNULL)
17116   {
17117     /* let os process IO */
17118     TI_DBG1(("satIOAbort: ostiAllocMemory returned NULL tdAbortIORequestBody\n"));
17119     return tiError;
17120   }
17121
17122   /* setup task management structure */
17123   tdAbortIORequestBody->IOType.InitiatorTMIO.osMemHandle = osMemHandle;
17124   tdAbortIORequestBody->tiDevHandle = tdIORequestBody->tiDevHandle;
17125
17126   /* initialize agIORequest */
17127   agAbortIORequest = &(tdAbortIORequestBody->agIORequest);
17128   agAbortIORequest->osData = (void *) tdAbortIORequestBody;
17129   agAbortIORequest->sdkData = agNULL; /* LL takes care of this */
17130
17131   /* remember IO to be aborted */
17132   tdAbortIORequestBody->tiIOToBeAbortedRequest = taskTag;
17133
17134   status = saSATAAbort( agRoot, agAbortIORequest, 0, agNULL, 0, agIORequest, agNULL );
17135
17136   TI_DBG5(("satIOAbort: return status=0x%x\n", status));
17137
17138   if (status == AGSA_RC_SUCCESS)
17139     return tiSuccess;
17140   else
17141     return tiError;
17142
17143 }
17144
17145
17146 /*****************************************************************************
17147  *! \brief  satTM
17148  *
17149  *   This routine is called to initiate a TM request to SATL.
17150  *   This routine is independent of HW/LL API.
17151  *
17152  *  \param  tiRoot:           Pointer to TISA initiator driver/port instance.
17153  *  \param  tiDeviceHandle:   Pointer to TISA device handle for this I/O.
17154  *  \param  task:             SAM-3 task management request.
17155  *  \param  lun:              Pointer to LUN.
17156  *  \param  taskTag:          Pointer to the associated task where the TM
17157  *                            command is to be applied.
17158  *  \param  currentTaskTag:   Pointer to tag/context for this TM request.
17159  *
17160  *  \return:
17161  *
17162  *  \e tiSuccess:     I/O request successfully initiated.
17163  *  \e tiBusy:        No resources available, try again later.
17164  *  \e tiIONoDevice:  Invalid device handle.
17165  *  \e tiError:       Other errors that prevent the I/O request to be started.
17166  *
17167  *
17168  *****************************************************************************/
17169  /* save task in satIOContext */
17170 osGLOBAL bit32 satTM(
17171                         tiRoot_t          *tiRoot,
17172                         tiDeviceHandle_t  *tiDeviceHandle,
17173                         bit32             task,
17174                         tiLUN_t           *lun,
17175                         tiIORequest_t     *taskTag,
17176                         tiIORequest_t     *currentTaskTag,
17177                         tdIORequestBody_t *tiRequestBody,
17178                         bit32              NotifyOS
17179                         )
17180 {
17181   tdIORequestBody_t           *tdIORequestBody = agNULL;
17182   satIOContext_t              *satIOContext = agNULL;
17183   tdsaDeviceData_t            *oneDeviceData = agNULL;
17184   bit32                       status;
17185
17186   TI_DBG3(("satTM: tiDeviceHandle=%p task=0x%x\n", tiDeviceHandle, task ));
17187
17188   /* set satIOContext fields and etc */
17189   oneDeviceData = (tdsaDeviceData_t *)tiDeviceHandle->tdData;
17190
17191
17192   tdIORequestBody = (tdIORequestBody_t *)tiRequestBody;
17193   satIOContext = &(tdIORequestBody->transport.SATA.satIOContext);
17194
17195   satIOContext->pSatDevData   = &oneDeviceData->satDevData;
17196   satIOContext->pFis          =
17197     &tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev;
17198
17199
17200   satIOContext->tiRequestBody = tiRequestBody;
17201   satIOContext->ptiDeviceHandle = tiDeviceHandle;
17202   satIOContext->satIntIoContext  = agNULL;
17203   satIOContext->satOrgIOContext  = agNULL;
17204
17205   /* followings are used only for internal IO */
17206   satIOContext->currentLBA = 0;
17207   satIOContext->OrgTL = 0;
17208
17209   /* saving task in satIOContext */
17210   satIOContext->TMF = task;
17211
17212   satIOContext->satToBeAbortedIOContext = agNULL;
17213
17214   if (NotifyOS == agTRUE)
17215   {
17216     satIOContext->NotifyOS = agTRUE;
17217   }
17218   else
17219   {
17220     satIOContext->NotifyOS = agFALSE;
17221   }
17222   /*
17223    * Our SAT supports RESET LUN and partially support ABORT TASK (only if there
17224    * is no more than one I/O pending on the drive.
17225    */
17226
17227   if (task == AG_LOGICAL_UNIT_RESET)
17228   {
17229     status = satTmResetLUN( tiRoot,
17230                             currentTaskTag,
17231                             tiDeviceHandle,
17232                             agNULL,
17233                             satIOContext,
17234                             lun);
17235     return status;
17236   }
17237 #ifdef TO_BE_REMOVED
17238   else if (task == AG_TARGET_WARM_RESET)
17239   {
17240     status = satTmWarmReset( tiRoot,
17241                              currentTaskTag,
17242                              tiDeviceHandle,
17243                              agNULL,
17244                              satIOContext);
17245
17246     return status;
17247   }
17248 #endif
17249   else if (task == AG_ABORT_TASK)
17250   {
17251     status = satTmAbortTask( tiRoot,
17252                              currentTaskTag,
17253                              tiDeviceHandle,
17254                              agNULL,
17255                              satIOContext,
17256                              taskTag);
17257
17258     return status;
17259   }
17260   else if (task == TD_INTERNAL_TM_RESET)
17261   {
17262     status = satTDInternalTmReset( tiRoot,
17263                                    currentTaskTag,
17264                                    tiDeviceHandle,
17265                                    agNULL,
17266                                    satIOContext);
17267    return status;
17268   }
17269   else
17270   {
17271     TI_DBG1(("satTM: tiDeviceHandle=%p UNSUPPORTED TM task=0x%x\n",
17272         tiDeviceHandle, task ));
17273
17274     /* clean up TD layer's IORequestBody */
17275     ostiFreeMemory(
17276                    tiRoot,
17277                    tiRequestBody->IOType.InitiatorTMIO.osMemHandle,
17278                    sizeof(tdIORequestBody_t)
17279                    );
17280     return tiError;
17281   }
17282
17283 }
17284
17285
17286 /*****************************************************************************
17287  *! \brief  satTmResetLUN
17288  *
17289  *   This routine is called to initiate a TM RESET LUN request to SATL.
17290  *   This routine is independent of HW/LL API.
17291  *
17292  *  \param  tiRoot:           Pointer to TISA initiator driver/port instance.
17293  *  \param  tiDeviceHandle:   Pointer to TISA device handle for this I/O.
17294  *  \param  lun:              Pointer to LUN.
17295  *  \param  currentTaskTag:   Pointer to tag/context for this TM request.
17296  *
17297  *  \return:
17298  *
17299  *  \e tiSuccess:     I/O request successfully initiated.
17300  *  \e tiBusy:        No resources available, try again later.
17301  *  \e tiIONoDevice:  Invalid device handle.
17302  *  \e tiError:       Other errors that prevent the I/O request to be started.
17303  *
17304  *
17305  *****************************************************************************/
17306 osGLOBAL bit32 satTmResetLUN(
17307                             tiRoot_t                  *tiRoot,
17308                             tiIORequest_t             *tiIORequest, /* current task tag */
17309                             tiDeviceHandle_t          *tiDeviceHandle,
17310                             tiScsiInitiatorRequest_t *tiScsiRequest,
17311                             satIOContext_t            *satIOContext,
17312                             tiLUN_t                   *lun)
17313 {
17314
17315   tdsaDeviceData_t        *tdsaDeviceData;
17316   satDeviceData_t         *satDevData;
17317
17318   tdsaDeviceData  = (tdsaDeviceData_t *)tiDeviceHandle->tdData;
17319   satDevData      = &tdsaDeviceData->satDevData;
17320
17321   TI_DBG1(("satTmResetLUN: tiDeviceHandle=%p.\n", tiDeviceHandle ));
17322
17323   /*
17324    * Only support LUN 0
17325    */
17326   if ( (lun->lun[0] | lun->lun[1] | lun->lun[2] | lun->lun[3] |
17327         lun->lun[4] | lun->lun[5] | lun->lun[6] | lun->lun[7] ) != 0 )
17328   {
17329     TI_DBG1(("satTmResetLUN: *** REJECT *** LUN not zero, tiDeviceHandle=%p\n",
17330                 tiDeviceHandle));
17331     return tiError;
17332   }
17333
17334   /*
17335    * Check if there is other TM request pending
17336    */
17337   if (satDevData->satTmTaskTag != agNULL)
17338   {
17339     TI_DBG1(("satTmResetLUN: *** REJECT *** other TM pending, tiDeviceHandle=%p\n",
17340                 tiDeviceHandle));
17341     return tiError;
17342   }
17343
17344   /*
17345    * Save tiIORequest, will be returned at device reset completion to return
17346    * the TM completion.
17347    */
17348    satDevData->satTmTaskTag = tiIORequest;
17349
17350   /*
17351    * Set flag to indicate device in recovery mode.
17352    */
17353   satDevData->satDriveState = SAT_DEV_STATE_IN_RECOVERY;
17354
17355   /*
17356    * Issue SATA device reset. Set flag to indicate NOT to automatically abort
17357    * at the completion of SATA device reset.
17358    */
17359   satDevData->satAbortAfterReset = agFALSE;
17360
17361   /* SAT rev8 6.3.6 p22 */
17362   satStartResetDevice(
17363                       tiRoot,
17364                       tiIORequest, /* currentTaskTag */
17365                       tiDeviceHandle,
17366                       tiScsiRequest,
17367                       satIOContext
17368                       );
17369
17370
17371   return tiSuccess;
17372
17373 }
17374
17375 /*****************************************************************************
17376  *! \brief  satTmWarmReset
17377  *
17378  *   This routine is called to initiate a TM warm RESET request to SATL.
17379  *   This routine is independent of HW/LL API.
17380  *
17381  *  \param  tiRoot:           Pointer to TISA initiator driver/port instance.
17382  *  \param  tiDeviceHandle:   Pointer to TISA device handle for this I/O.
17383  *  \param  currentTaskTag:   Pointer to tag/context for this TM request.
17384  *
17385  *  \return:
17386  *
17387  *  \e tiSuccess:     I/O request successfully initiated.
17388  *  \e tiBusy:        No resources available, try again later.
17389  *  \e tiIONoDevice:  Invalid device handle.
17390  *  \e tiError:       Other errors that prevent the I/O request to be started.
17391  *
17392  *
17393  *****************************************************************************/
17394 osGLOBAL bit32 satTmWarmReset(
17395                             tiRoot_t                  *tiRoot,
17396                             tiIORequest_t             *tiIORequest, /* current task tag */
17397                             tiDeviceHandle_t          *tiDeviceHandle,
17398                             tiScsiInitiatorRequest_t *tiScsiRequest,
17399                             satIOContext_t            *satIOContext)
17400 {
17401
17402   tdsaDeviceData_t        *tdsaDeviceData;
17403   satDeviceData_t         *satDevData;
17404
17405   tdsaDeviceData  = (tdsaDeviceData_t *)tiDeviceHandle->tdData;
17406   satDevData      = &tdsaDeviceData->satDevData;
17407
17408   TI_DBG1(("satTmWarmReset: tiDeviceHandle=%p.\n", tiDeviceHandle ));
17409
17410   /*
17411    * Check if there is other TM request pending
17412    */
17413   if (satDevData->satTmTaskTag != agNULL)
17414   {
17415     TI_DBG1(("satTmWarmReset: *** REJECT *** other TM pending, tiDeviceHandle=%p\n",
17416                 tiDeviceHandle));
17417     return tiError;
17418   }
17419
17420   /*
17421    * Save tiIORequest, will be returned at device reset completion to return
17422    * the TM completion.
17423    */
17424    satDevData->satTmTaskTag = tiIORequest;
17425
17426   /*
17427    * Set flag to indicate device in recovery mode.
17428    */
17429   satDevData->satDriveState = SAT_DEV_STATE_IN_RECOVERY;
17430
17431   /*
17432    * Issue SATA device reset. Set flag to indicate NOT to automatically abort
17433    * at the completion of SATA device reset.
17434    */
17435   satDevData->satAbortAfterReset = agFALSE;
17436
17437   /* SAT rev8 6.3.6 p22 */
17438   satStartResetDevice(
17439                       tiRoot,
17440                       tiIORequest, /* currentTaskTag */
17441                       tiDeviceHandle,
17442                       tiScsiRequest,
17443                       satIOContext
17444                       );
17445
17446   return tiSuccess;
17447
17448 }
17449
17450 osGLOBAL bit32 satTDInternalTmReset(
17451                             tiRoot_t                  *tiRoot,
17452                             tiIORequest_t             *tiIORequest, /* current task tag */
17453                             tiDeviceHandle_t          *tiDeviceHandle,
17454                             tiScsiInitiatorRequest_t *tiScsiRequest,
17455                             satIOContext_t            *satIOContext)
17456 {
17457
17458   tdsaDeviceData_t        *tdsaDeviceData;
17459   satDeviceData_t         *satDevData;
17460
17461   tdsaDeviceData  = (tdsaDeviceData_t *)tiDeviceHandle->tdData;
17462   satDevData      = &tdsaDeviceData->satDevData;
17463
17464   TI_DBG1(("satTmWarmReset: tiDeviceHandle=%p.\n", tiDeviceHandle ));
17465
17466   /*
17467    * Check if there is other TM request pending
17468    */
17469   if (satDevData->satTmTaskTag != agNULL)
17470   {
17471     TI_DBG1(("satTmWarmReset: *** REJECT *** other TM pending, tiDeviceHandle=%p\n",
17472                 tiDeviceHandle));
17473     return tiError;
17474   }
17475
17476   /*
17477    * Save tiIORequest, will be returned at device reset completion to return
17478    * the TM completion.
17479    */
17480    satDevData->satTmTaskTag = tiIORequest;
17481
17482   /*
17483    * Set flag to indicate device in recovery mode.
17484    */
17485   satDevData->satDriveState = SAT_DEV_STATE_IN_RECOVERY;
17486
17487   /*
17488    * Issue SATA device reset. Set flag to indicate NOT to automatically abort
17489    * at the completion of SATA device reset.
17490    */
17491   satDevData->satAbortAfterReset = agFALSE;
17492
17493   /* SAT rev8 6.3.6 p22 */
17494   satStartResetDevice(
17495                       tiRoot,
17496                       tiIORequest, /* currentTaskTag */
17497                       tiDeviceHandle,
17498                       tiScsiRequest,
17499                       satIOContext
17500                       );
17501
17502   return tiSuccess;
17503
17504 }
17505
17506 /*****************************************************************************
17507  *! \brief  satTmAbortTask
17508  *
17509  *   This routine is called to initiate a TM ABORT TASK request to SATL.
17510  *   This routine is independent of HW/LL API.
17511  *
17512  *  \param  tiRoot:           Pointer to TISA initiator driver/port instance.
17513  *  \param  tiDeviceHandle:   Pointer to TISA device handle for this I/O.
17514  *  \param  taskTag:          Pointer to the associated task where the TM
17515  *                            command is to be applied.
17516  *  \param  currentTaskTag:   Pointer to tag/context for this TM request.
17517  *
17518  *  \return:
17519  *
17520  *  \e tiSuccess:     I/O request successfully initiated.
17521  *  \e tiBusy:        No resources available, try again later.
17522  *  \e tiIONoDevice:  Invalid device handle.
17523  *  \e tiError:       Other errors that prevent the I/O request to be started.
17524  *
17525  *
17526  *****************************************************************************/
17527 osGLOBAL bit32 satTmAbortTask(
17528                             tiRoot_t                  *tiRoot,
17529                             tiIORequest_t             *tiIORequest,  /* current task tag */
17530                             tiDeviceHandle_t          *tiDeviceHandle,
17531                             tiScsiInitiatorRequest_t *tiScsiRequest, /* NULL */
17532                             satIOContext_t            *satIOContext,
17533                             tiIORequest_t             *taskTag)
17534 {
17535
17536   tdsaDeviceData_t        *tdsaDeviceData;
17537   satDeviceData_t         *satDevData;
17538   satIOContext_t          *satTempIOContext = agNULL;
17539   tdIORequestBody_t       *tdIORequestBody;
17540   tdIORequestBody_t       *TMtdIORequestBody;
17541   tdList_t                *elementHdr;
17542   bit32                   found = agFALSE;
17543   tiIORequest_t           *tiIOReq;
17544
17545   tdsaDeviceData  = (tdsaDeviceData_t *)tiDeviceHandle->tdData;
17546   satDevData      = &tdsaDeviceData->satDevData;
17547   TMtdIORequestBody = (tdIORequestBody_t *)tiIORequest->tdData;
17548
17549   TI_DBG1(("satTmAbortTask: tiDeviceHandle=%p taskTag=%p.\n", tiDeviceHandle, taskTag ));
17550   /*
17551    * Check if there is other TM request pending
17552    */
17553   if (satDevData->satTmTaskTag != agNULL)
17554   {
17555     TI_DBG1(("satTmAbortTask: REJECT other TM pending, tiDeviceHandle=%p\n",
17556                 tiDeviceHandle));
17557     /* clean up TD layer's IORequestBody */
17558     ostiFreeMemory(
17559                    tiRoot,
17560                    TMtdIORequestBody->IOType.InitiatorTMIO.osMemHandle,
17561                    sizeof(tdIORequestBody_t)
17562                    );
17563     return tiError;
17564   }
17565
17566 #ifdef REMOVED
17567   /*
17568    * Check if there is only one I/O pending.
17569    */
17570   if (satDevData->satPendingIO > 0)
17571   {
17572     TI_DBG1(("satTmAbortTask: REJECT num pending I/O, tiDeviceHandle=%p, satPendingIO=0x%x\n",
17573                 tiDeviceHandle, satDevData->satPendingIO));
17574     /* clean up TD layer's IORequestBody */
17575     ostiFreeMemory(
17576                    tiRoot,
17577                    TMtdIORequestBody->IOType.InitiatorTMIO.osMemHandle,
17578                    sizeof(tdIORequestBody_t)
17579                    );
17580
17581     return tiError;
17582   }
17583 #endif
17584
17585   /*
17586    * Check that the only pending I/O matches taskTag. If not return tiError.
17587    */
17588   elementHdr = satDevData->satIoLinkList.flink;
17589
17590   while (elementHdr != &satDevData->satIoLinkList)
17591   {
17592     satTempIOContext = TDLIST_OBJECT_BASE( satIOContext_t,
17593                                            satIoContextLink,
17594                                            elementHdr );
17595
17596     tdIORequestBody = (tdIORequestBody_t *) satTempIOContext->tiRequestBody;
17597     tiIOReq = tdIORequestBody->tiIORequest;
17598
17599     elementHdr = elementHdr->flink;   /* for the next while loop  */
17600
17601     /*
17602      * Check if the tag matches
17603      */
17604     if ( tiIOReq == taskTag)
17605     {
17606       found = agTRUE;
17607       satIOContext->satToBeAbortedIOContext = satTempIOContext;
17608       TI_DBG1(("satTmAbortTask: found matching tag.\n"));
17609
17610       break;
17611
17612     } /* if matching tag */
17613
17614   } /* while loop */
17615
17616
17617   if (found == agFALSE )
17618   {
17619     TI_DBG1(("satTmAbortTask: *** REJECT *** no match, tiDeviceHandle=%p\n",
17620                 tiDeviceHandle ));
17621
17622     /* clean up TD layer's IORequestBody */
17623     ostiFreeMemory(
17624                    tiRoot,
17625                    TMtdIORequestBody->IOType.InitiatorTMIO.osMemHandle,
17626                    sizeof(tdIORequestBody_t)
17627                    );
17628
17629     return tiError;
17630   }
17631
17632   /*
17633    * Save tiIORequest, will be returned at device reset completion to return
17634    * the TM completion.
17635    */
17636    satDevData->satTmTaskTag = tiIORequest;
17637
17638   /*
17639    * Set flag to indicate device in recovery mode.
17640    */
17641   satDevData->satDriveState = SAT_DEV_STATE_IN_RECOVERY;
17642
17643
17644   /*
17645    * Issue SATA device reset or check power mode. Set flag to to automatically abort
17646    * at the completion of SATA device reset.
17647    * SAT r09 p25
17648    */
17649   satDevData->satAbortAfterReset = agTRUE;
17650
17651   if ( (satTempIOContext->reqType == AGSA_SATA_PROTOCOL_FPDMA_WRITE) ||
17652        (satTempIOContext->reqType == AGSA_SATA_PROTOCOL_FPDMA_READ)
17653       )
17654   {
17655     TI_DBG1(("satTmAbortTask: calling satStartCheckPowerMode\n"));
17656     /* send check power mode */
17657     satStartCheckPowerMode(
17658                       tiRoot,
17659                       tiIORequest, /* currentTaskTag */
17660                       tiDeviceHandle,
17661                       tiScsiRequest,
17662                       satIOContext
17663                       );
17664   }
17665   else
17666   {
17667     TI_DBG1(("satTmAbortTask: calling satStartResetDevice\n"));
17668     /* send AGSA_SATA_PROTOCOL_SRST_ASSERT */
17669     satStartResetDevice(
17670                       tiRoot,
17671                       tiIORequest, /* currentTaskTag */
17672                       tiDeviceHandle,
17673                       tiScsiRequest,
17674                       satIOContext
17675                       );
17676   }
17677
17678
17679   return tiSuccess;
17680 }
17681
17682 /*****************************************************************************
17683  *! \brief  osSatResetCB
17684  *
17685  *   This routine is called to notify the completion of SATA device reset
17686  *   which was initiated previously through the call to sataLLReset().
17687  *   This routine is independent of HW/LL API.
17688  *
17689  *  \param  tiRoot:           Pointer to TISA initiator driver/port instance.
17690  *  \param  tiDeviceHandle:   Pointer to TISA device handle for this I/O.
17691  *  \param  resetStatus:      Reset status either tiSuccess or tiError.
17692  *  \param  respFis:          Pointer to the Register Device-To-Host FIS
17693  *                            received from the device.
17694  *
17695  *  \return: None
17696  *
17697  *****************************************************************************/
17698 osGLOBAL void osSatResetCB(
17699                 tiRoot_t          *tiRoot,
17700                 tiDeviceHandle_t  *tiDeviceHandle,
17701                 bit32             resetStatus,
17702                 void              *respFis)
17703 {
17704
17705   agsaRoot_t              *agRoot;
17706   tdsaDeviceData_t        *tdsaDeviceData;
17707   satDeviceData_t         *satDevData;
17708   satIOContext_t          *satIOContext;
17709   tdIORequestBody_t       *tdIORequestBodyTmp;
17710   tdList_t                *elementHdr;
17711   agsaIORequest_t         *agAbortIORequest;
17712   tdIORequestBody_t       *tdAbortIORequestBody;
17713   bit32                   PhysUpper32;
17714   bit32                   PhysLower32;
17715   bit32                   memAllocStatus;
17716   void                    *osMemHandle;
17717
17718   tdsaDeviceData  = (tdsaDeviceData_t *)tiDeviceHandle->tdData;
17719   agRoot          = tdsaDeviceData->agRoot;
17720   satDevData      = &tdsaDeviceData->satDevData;
17721
17722   TI_DBG5(("osSatResetCB: tiDeviceHandle=%p resetStatus=0x%x\n",
17723       tiDeviceHandle, resetStatus ));
17724
17725   /* We may need to check FIS to check device operating condition */
17726
17727
17728   /*
17729    * Check if need to abort all pending I/Os
17730    */
17731   if ( satDevData->satAbortAfterReset == agTRUE )
17732   {
17733     /*
17734      * Issue abort to LL layer to all other pending I/Os for the same SATA drive
17735      */
17736     elementHdr = satDevData->satIoLinkList.flink;
17737     while (elementHdr != &satDevData->satIoLinkList)
17738     {
17739       satIOContext = TDLIST_OBJECT_BASE( satIOContext_t,
17740                                          satIoContextLink,
17741                                          elementHdr );
17742
17743       tdIORequestBodyTmp = (tdIORequestBody_t *)satIOContext->tiRequestBody;
17744
17745       /*
17746        * Issue abort
17747        */
17748       TI_DBG5(("osSatResetCB: issuing ABORT tiDeviceHandle=%p agIORequest=%p\n",
17749       tiDeviceHandle, &tdIORequestBodyTmp->agIORequest ));
17750
17751       /* allocating agIORequest for abort itself */
17752       memAllocStatus = ostiAllocMemory(
17753                                        tiRoot,
17754                                        &osMemHandle,
17755                                        (void **)&tdAbortIORequestBody,
17756                                        &PhysUpper32,
17757                                        &PhysLower32,
17758                                        8,
17759                                        sizeof(tdIORequestBody_t),
17760                                        agTRUE
17761                                        );
17762
17763       if (memAllocStatus != tiSuccess)
17764       {
17765         /* let os process IO */
17766         TI_DBG1(("osSatResetCB: ostiAllocMemory failed...\n"));
17767         return;
17768       }
17769
17770       if (tdAbortIORequestBody == agNULL)
17771       {
17772         /* let os process IO */
17773         TI_DBG1(("osSatResetCB: ostiAllocMemory returned NULL tdAbortIORequestBody\n"));
17774         return;
17775       }
17776       /* setup task management structure */
17777       tdAbortIORequestBody->IOType.InitiatorTMIO.osMemHandle = osMemHandle;
17778       tdAbortIORequestBody->tiDevHandle = tiDeviceHandle;
17779
17780       /* initialize agIORequest */
17781       agAbortIORequest = &(tdAbortIORequestBody->agIORequest);
17782       agAbortIORequest->osData = (void *) tdAbortIORequestBody;
17783       agAbortIORequest->sdkData = agNULL; /* LL takes care of this */
17784
17785       saSATAAbort( agRoot, agAbortIORequest, 0, agNULL, 0, &(tdIORequestBodyTmp->agIORequest), agNULL );
17786       elementHdr = elementHdr->flink;   /* for the next while loop  */
17787
17788     } /* while */
17789
17790     /* Reset flag */
17791     satDevData->satAbortAfterReset = agFALSE;
17792
17793   }
17794
17795
17796   /*
17797    * Check if the device reset if the result of TM request.
17798    */
17799   if ( satDevData->satTmTaskTag != agNULL )
17800   {
17801     TI_DBG5(("osSatResetCB: calling TM completion tiDeviceHandle=%p satTmTaskTag=%p\n",
17802     tiDeviceHandle, satDevData->satTmTaskTag ));
17803
17804     ostiInitiatorEvent( tiRoot,
17805                         agNULL,               /* portalContext not used */
17806                         tiDeviceHandle,
17807                         tiIntrEventTypeTaskManagement,
17808                         tiTMOK,
17809                         satDevData->satTmTaskTag);
17810     /*
17811      * Reset flag
17812      */
17813     satDevData->satTmTaskTag = agNULL;
17814   }
17815
17816 }
17817
17818
17819 /*****************************************************************************
17820  *! \brief  osSatIOCompleted
17821  *
17822  *   This routine is a callback for SATA completion that required FIS status
17823  *   translation to SCSI status.
17824  *
17825  *  \param   tiRoot:          Pointer to TISA initiator driver/port instance.
17826  *  \param   tiIORequest:     Pointer to TISA I/O request context for this I/O.
17827  *  \param   respFis:         Pointer to status FIS to read.
17828  *  \param   respFisLen:      Length of response FIS to read.
17829  *  \param   satIOContext:    Pointer to SAT context.
17830  *  \param   interruptContext:      Interrupt context
17831  *
17832  *  \return: None
17833  *
17834  *****************************************************************************/
17835 osGLOBAL void osSatIOCompleted(
17836                           tiRoot_t           *tiRoot,
17837                           tiIORequest_t      *tiIORequest,
17838                           agsaFisHeader_t    *agFirstDword,
17839                           bit32              respFisLen,
17840                           agsaFrameHandle_t  agFrameHandle,
17841                           satIOContext_t     *satIOContext,
17842                           bit32              interruptContext)
17843
17844 {
17845   satDeviceData_t           *pSatDevData;
17846   scsiRspSense_t            *pSense;
17847 #ifdef  TD_DEBUG_ENABLE
17848   tiIniScsiCmnd_t           *pScsiCmnd;
17849 #endif
17850   agsaFisRegHostToDevice_t  *hostToDevFis = agNULL;
17851   bit32                     ataStatus = 0;
17852   bit32                     ataError;
17853   satInternalIo_t           *satIntIo = agNULL;
17854   bit32                     status;
17855   tiDeviceHandle_t          *tiDeviceHandle;
17856   satIOContext_t            *satIOContext2;
17857   tdIORequestBody_t         *tdIORequestBody;
17858   agsaFisRegD2HHeader_t     *statDevToHostFisHeader = agNULL;
17859   agsaFisSetDevBitsHeader_t *statSetDevBitFisHeader = agNULL;
17860   tiIORequest_t             tiIORequestTMP;
17861
17862   pSense          = satIOContext->pSense;
17863   pSatDevData     = satIOContext->pSatDevData;
17864 #ifdef  TD_DEBUG_ENABLE
17865   pScsiCmnd       = satIOContext->pScsiCmnd;
17866 #endif
17867   hostToDevFis    = satIOContext->pFis;
17868
17869   tiDeviceHandle  = &((tdsaDeviceData_t *)(pSatDevData->satSaDeviceData))->tiDeviceHandle;
17870   /*
17871    * Find out the type of response FIS:
17872    * Set Device Bit FIS or Reg Device To Host FIS.
17873    */
17874
17875   /* First assume it is Reg Device to Host FIS */
17876   statDevToHostFisHeader = (agsaFisRegD2HHeader_t *)&(agFirstDword->D2H);
17877   ataStatus     = statDevToHostFisHeader->status;   /* ATA Status register */
17878   ataError      = statDevToHostFisHeader->error;    /* ATA Eror register   */
17879
17880   /* for debugging */
17881   TI_DBG1(("osSatIOCompleted: H to D command 0x%x\n", hostToDevFis->h.command));
17882   TI_DBG1(("osSatIOCompleted: D to H fistype 0x%x\n", statDevToHostFisHeader->fisType));
17883
17884
17885   if (statDevToHostFisHeader->fisType == SET_DEV_BITS_FIS)
17886   {
17887     /* It is Set Device Bits FIS */
17888     statSetDevBitFisHeader = (agsaFisSetDevBitsHeader_t *)&(agFirstDword->D2H);
17889     /* Get ATA Status register */
17890     ataStatus = (statSetDevBitFisHeader->statusHi_Lo & 0x70);               /* bits 4,5,6 */
17891     ataStatus = ataStatus | (statSetDevBitFisHeader->statusHi_Lo & 0x07);   /* bits 0,1,2 */
17892
17893     /* ATA Eror register   */
17894     ataError  = statSetDevBitFisHeader->error;
17895
17896     statDevToHostFisHeader = agNULL;
17897   }
17898
17899   else if (statDevToHostFisHeader->fisType != REG_DEV_TO_HOST_FIS)
17900   {
17901     TI_DBG1(("osSatIOCompleted: *** UNEXPECTED RESP FIS TYPE 0x%x *** tiIORequest=%p\n",
17902                  statDevToHostFisHeader->fisType, tiIORequest));
17903
17904     satSetSensePayload( pSense,
17905                         SCSI_SNSKEY_HARDWARE_ERROR,
17906                         0,
17907                         SCSI_SNSCODE_INTERNAL_TARGET_FAILURE,
17908                         satIOContext);
17909
17910     ostiInitiatorIOCompleted( tiRoot,
17911                               tiIORequest,
17912                               tiIOSuccess,
17913                               SCSI_STAT_CHECK_CONDITION,
17914                               satIOContext->pTiSenseData,
17915                               interruptContext );
17916     return;
17917
17918   }
17919
17920   if ( ataStatus & DF_ATA_STATUS_MASK )
17921   {
17922     pSatDevData->satDeviceFaultState = agTRUE;
17923   }
17924   else
17925   {
17926     pSatDevData->satDeviceFaultState = agFALSE;
17927   }
17928
17929   TI_DBG5(("osSatIOCompleted: tiIORequest=%p  CDB=0x%x ATA CMD =0x%x\n",
17930     tiIORequest, pScsiCmnd->cdb[0], hostToDevFis->h.command));
17931
17932   /*
17933    * Decide which ATA command is the translation needed
17934    */
17935   switch(hostToDevFis->h.command)
17936   {
17937     case SAT_READ_FPDMA_QUEUED:
17938     case SAT_WRITE_FPDMA_QUEUED:
17939
17940       /************************************************************************
17941        *
17942        * !!!! See Section 13.5.2.4 of SATA 2.5 specs.                      !!!!
17943        * !!!! If the NCQ error ends up here, it means that the device sent !!!!
17944        * !!!! Set Device Bit FIS (which has SActive register) instead of   !!!!
17945        * !!!! Register Device To Host FIS (which does not have SActive     !!!!
17946        * !!!! register). The callback ossaSATAEvent() deals with the case  !!!!
17947        * !!!! where Register Device To Host FIS was sent by the device.    !!!!
17948        *
17949        * For NCQ we need to issue READ LOG EXT command with log page 10h
17950        * to get the error and to allow other I/Os to continue.
17951        *
17952        * Here is the basic flow or sequence of error recovery, note that due
17953        * to the SATA HW assist that we have, this sequence is slighly different
17954        * from the one described in SATA 2.5:
17955        *
17956        * 1. Set SATA device flag to indicate error condition and returning busy
17957        *    for all new request.
17958        *   return tiSuccess;
17959
17960        * 2. Because the HW/LL layer received Set Device Bit FIS, it can get the
17961        *    tag or I/O context for NCQ request, SATL would translate the ATA error
17962        *    to SCSI status and return the original NCQ I/O with the appopriate
17963        *    SCSI status.
17964        *
17965        * 3. Prepare READ LOG EXT page 10h command. Set flag to indicate that
17966        *    the failed I/O has been returned to the OS Layer. Send command.
17967        *
17968        * 4. When the device receives READ LOG EXT page 10h request all other
17969        *    pending I/O are implicitly aborted. No completion (aborted) status
17970        *    will be sent to the host for these aborted commands.
17971        *
17972        * 5. SATL receives the completion for READ LOG EXT command in
17973        *    satReadLogExtCB(). Steps 6,7,8,9 below are the step 1,2,3,4 in
17974        *    satReadLogExtCB().
17975        *
17976        * 6. Check flag that indicates whether the failed I/O has been returned
17977        *    to the OS Layer. If not, search the I/O context in device data
17978        *    looking for a matched tag. Then return the completion of the failed
17979        *    NCQ command with the appopriate/trasnlated SCSI status.
17980        *
17981        * 7. Issue abort to LL layer to all other pending I/Os for the same SATA
17982        *    drive.
17983        *
17984        * 8. Free resource allocated for the internally generated READ LOG EXT.
17985        *
17986        * 9. At the completion of abort, in the context of ossaSATACompleted(),
17987        *    return the I/O with error status to the OS-App Specific layer.
17988        *    When all I/O aborts are completed, clear SATA device flag to
17989        *    indicate ready to process new request.
17990        *
17991        ***********************************************************************/
17992
17993       TI_DBG1(("osSatIOCompleted: NCQ ERROR tiIORequest=%p ataStatus=0x%x ataError=0x%x\n",
17994           tiIORequest, ataStatus, ataError ));
17995
17996       /* Set flag to indicate we are in recovery */
17997       pSatDevData->satDriveState = SAT_DEV_STATE_IN_RECOVERY;
17998
17999       /* Return the failed NCQ I/O to OS-Apps Specifiic layer */
18000       osSatDefaultTranslation( tiRoot,
18001                                tiIORequest,
18002                                satIOContext,
18003                                pSense,
18004                                (bit8)ataStatus,
18005                                (bit8)ataError,
18006                                interruptContext );
18007
18008       /*
18009        * Allocate resource for READ LOG EXT page 10h
18010        */
18011       satIntIo = satAllocIntIoResource( tiRoot,
18012                                         &(tiIORequestTMP), /* anything but NULL */
18013                                         pSatDevData,
18014                                         sizeof (satReadLogExtPage10h_t),
18015                                         satIntIo);
18016
18017       if (satIntIo == agNULL)
18018       {
18019         TI_DBG1(("osSatIOCompleted: can't send RLE due to resource lack\n"));
18020
18021         /* Abort I/O after completion of device reset */
18022         pSatDevData->satAbortAfterReset = agTRUE;
18023 #ifdef NOT_YET
18024         /* needs further investigation */
18025         /* no report to OS layer */
18026         satSubTM(tiRoot,
18027                  tiDeviceHandle,
18028                  TD_INTERNAL_TM_RESET,
18029                  agNULL,
18030                  agNULL,
18031                  agNULL,
18032                  agFALSE);
18033 #endif
18034
18035
18036         TI_DBG1(("osSatIOCompleted: calling saSATADeviceReset 1\n"));
18037         return;
18038       }
18039
18040
18041       /*
18042        * Set flag to indicate that the failed I/O has been returned to the
18043        * OS-App specific Layer.
18044        */
18045       satIntIo->satIntFlag = AG_SAT_INT_IO_FLAG_ORG_IO_COMPLETED;
18046
18047       /* compare to satPrepareNewIO() */
18048       /* Send READ LOG EXIT page 10h command */
18049
18050       /*
18051        * Need to initialize all the fields within satIOContext except
18052        * reqType and satCompleteCB which will be set depending on cmd.
18053        */
18054
18055       tdIORequestBody = (tdIORequestBody_t *)satIntIo->satIntRequestBody;
18056       satIOContext2 = &(tdIORequestBody->transport.SATA.satIOContext);
18057
18058       satIOContext2->pSatDevData   = pSatDevData;
18059       satIOContext2->pFis          = &(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev);
18060       satIOContext2->pScsiCmnd     = &(satIntIo->satIntTiScsiXchg.scsiCmnd);
18061       satIOContext2->pSense        = &(tdIORequestBody->transport.SATA.sensePayload);
18062       satIOContext2->pTiSenseData  = &(tdIORequestBody->transport.SATA.tiSenseData);
18063       satIOContext2->pTiSenseData->senseData = satIOContext2->pSense;
18064
18065       satIOContext2->tiRequestBody = satIntIo->satIntRequestBody;
18066       satIOContext2->interruptContext = interruptContext;
18067       satIOContext2->satIntIoContext  = satIntIo;
18068
18069       satIOContext2->ptiDeviceHandle = tiDeviceHandle;
18070       satIOContext2->satOrgIOContext = agNULL;
18071       satIOContext2->tiScsiXchg = agNULL;
18072
18073       status = satSendReadLogExt( tiRoot,
18074                                   &satIntIo->satIntTiIORequest,
18075                                   tiDeviceHandle,
18076                                   &satIntIo->satIntTiScsiXchg,
18077                                   satIOContext2);
18078
18079       if (status != tiSuccess)
18080       {
18081         TI_DBG1(("osSatIOCompleted: can't send RLE due to LL api failure\n"));
18082         satFreeIntIoResource( tiRoot,
18083                               pSatDevData,
18084                               satIntIo);
18085
18086         /* Abort I/O after completion of device reset */
18087         pSatDevData->satAbortAfterReset = agTRUE;
18088 #ifdef NOT_YET
18089         /* needs further investigation */
18090         /* no report to OS layer */
18091         satSubTM(tiRoot,
18092                  tiDeviceHandle,
18093                  TD_INTERNAL_TM_RESET,
18094                  agNULL,
18095                  agNULL,
18096                  agNULL,
18097                  agFALSE);
18098 #endif
18099
18100         TI_DBG1(("osSatIOCompleted: calling saSATADeviceReset 2\n"));
18101         return;
18102       }
18103
18104       break;
18105
18106     case SAT_READ_DMA_EXT:
18107       /* fall through */
18108       /* Use default status/error translation */
18109
18110     case SAT_READ_DMA:
18111       /* fall through */
18112       /* Use default status/error translation */
18113
18114     default:
18115       osSatDefaultTranslation( tiRoot,
18116                                tiIORequest,
18117                                satIOContext,
18118                                pSense,
18119                                (bit8)ataStatus,
18120                                (bit8)ataError,
18121                                interruptContext );
18122       break;
18123
18124   }  /* end switch  */
18125 }
18126
18127
18128 /*****************************************************************************/
18129 /*! \brief SAT implementation for SCSI STANDARD INQUIRY.
18130  *
18131  *  SAT implementation for SCSI STANDARD INQUIRY.
18132  *
18133  *  \param   pInquiry:         Pointer to Inquiry Data buffer.
18134  *  \param   pSATAIdData:      Pointer to ATA IDENTIFY DEVICE data.
18135  *
18136  *  \return None.
18137  */
18138 /*****************************************************************************/
18139 GLOBAL void  satInquiryStandard(
18140                                 bit8                    *pInquiry,
18141                                 agsaSATAIdentifyData_t  *pSATAIdData,
18142                                 tiIniScsiCmnd_t          *scsiCmnd
18143                                 )
18144 {
18145   tiLUN_t       *pLun;
18146   pLun          = &scsiCmnd->lun;
18147
18148   /*
18149     Assumption: Basic Task Mangement is supported
18150     -> BQUE 1 and CMDQUE 0, SPC-4, Table96, p147
18151   */
18152  /*
18153     See SPC-4, 6.4.2, p 143
18154     and SAT revision 8, 8.1.2, p 28
18155    */
18156
18157   TI_DBG5(("satInquiryStandard: start\n"));
18158
18159   if (pInquiry == agNULL)
18160   {
18161     TI_DBG1(("satInquiryStandard: pInquiry is NULL, wrong\n"));
18162     return;
18163   }
18164   else
18165   {
18166     TI_DBG5(("satInquiryStandard: pInquiry is NOT NULL\n"));
18167   }
18168   /*
18169    * Reject all other LUN other than LUN 0.
18170    */
18171   if ( ((pLun->lun[0] | pLun->lun[1] | pLun->lun[2] | pLun->lun[3] |
18172          pLun->lun[4] | pLun->lun[5] | pLun->lun[6] | pLun->lun[7] ) != 0) )
18173   {
18174     /* SAT Spec Table 8, p27, footnote 'a' */
18175     pInquiry[0] = 0x7F;
18176
18177   }
18178   else
18179   {
18180     pInquiry[0] = 0x00;
18181   }
18182
18183   if (pSATAIdData->rm_ataDevice & ATA_REMOVABLE_MEDIA_DEVICE_MASK )
18184   {
18185     pInquiry[1] = 0x80;
18186   }
18187   else
18188   {
18189     pInquiry[1] = 0x00;
18190   }
18191   pInquiry[2] = 0x05;   /* SPC-3 */
18192   pInquiry[3] = 0x12;   /* set HiSup 1; resp data format set to 2 */
18193   pInquiry[4] = 0x1F;   /* 35 - 4 = 31; Additional length */
18194   pInquiry[5] = 0x00;
18195   /* The following two are for task management. SAT Rev8, p20 */
18196   if (pSATAIdData->sataCapabilities & 0x100)
18197   {
18198     /* NCQ supported; multiple outstanding SCSI IO are supported */
18199     pInquiry[6] = 0x00;   /* BQUE bit is not set */
18200     pInquiry[7] = 0x02;   /* CMDQUE bit is set */
18201   }
18202   else
18203   {
18204     pInquiry[6] = 0x80;   /* BQUE bit is set */
18205     pInquiry[7] = 0x00;   /* CMDQUE bit is not set */
18206   }
18207   /*
18208    * Vendor ID.
18209    */
18210   osti_strncpy((char*)&pInquiry[8],  AG_SAT_VENDOR_ID_STRING,8);   /* 8 bytes   */
18211
18212   /*
18213    * Product ID
18214    */
18215   /* when flipped by LL */
18216   pInquiry[16] = pSATAIdData->modelNumber[1];
18217   pInquiry[17] = pSATAIdData->modelNumber[0];
18218   pInquiry[18] = pSATAIdData->modelNumber[3];
18219   pInquiry[19] = pSATAIdData->modelNumber[2];
18220   pInquiry[20] = pSATAIdData->modelNumber[5];
18221   pInquiry[21] = pSATAIdData->modelNumber[4];
18222   pInquiry[22] = pSATAIdData->modelNumber[7];
18223   pInquiry[23] = pSATAIdData->modelNumber[6];
18224   pInquiry[24] = pSATAIdData->modelNumber[9];
18225   pInquiry[25] = pSATAIdData->modelNumber[8];
18226   pInquiry[26] = pSATAIdData->modelNumber[11];
18227   pInquiry[27] = pSATAIdData->modelNumber[10];
18228   pInquiry[28] = pSATAIdData->modelNumber[13];
18229   pInquiry[29] = pSATAIdData->modelNumber[12];
18230   pInquiry[30] = pSATAIdData->modelNumber[15];
18231   pInquiry[31] = pSATAIdData->modelNumber[14];
18232
18233   /* when flipped */
18234   /*
18235    * Product Revision level.
18236    */
18237
18238   /*
18239    * If the IDENTIFY DEVICE data received in words 25 and 26 from the ATA
18240    * device are ASCII spaces (20h), do this translation.
18241    */
18242   if ( (pSATAIdData->firmwareVersion[4] == 0x20 ) &&
18243        (pSATAIdData->firmwareVersion[5] == 0x00 ) &&
18244        (pSATAIdData->firmwareVersion[6] == 0x20 ) &&
18245        (pSATAIdData->firmwareVersion[7] == 0x00 )
18246        )
18247   {
18248     pInquiry[32] = pSATAIdData->firmwareVersion[1];
18249     pInquiry[33] = pSATAIdData->firmwareVersion[0];
18250     pInquiry[34] = pSATAIdData->firmwareVersion[3];
18251     pInquiry[35] = pSATAIdData->firmwareVersion[2];
18252   }
18253   else
18254   {
18255     pInquiry[32] = pSATAIdData->firmwareVersion[5];
18256     pInquiry[33] = pSATAIdData->firmwareVersion[4];
18257     pInquiry[34] = pSATAIdData->firmwareVersion[7];
18258     pInquiry[35] = pSATAIdData->firmwareVersion[6];
18259   }
18260
18261
18262 #ifdef REMOVED
18263   /*
18264    * Product ID
18265    */
18266   /* when flipped by LL */
18267   pInquiry[16] = pSATAIdData->modelNumber[0];
18268   pInquiry[17] = pSATAIdData->modelNumber[1];
18269   pInquiry[18] = pSATAIdData->modelNumber[2];
18270   pInquiry[19] = pSATAIdData->modelNumber[3];
18271   pInquiry[20] = pSATAIdData->modelNumber[4];
18272   pInquiry[21] = pSATAIdData->modelNumber[5];
18273   pInquiry[22] = pSATAIdData->modelNumber[6];
18274   pInquiry[23] = pSATAIdData->modelNumber[7];
18275   pInquiry[24] = pSATAIdData->modelNumber[8];
18276   pInquiry[25] = pSATAIdData->modelNumber[9];
18277   pInquiry[26] = pSATAIdData->modelNumber[10];
18278   pInquiry[27] = pSATAIdData->modelNumber[11];
18279   pInquiry[28] = pSATAIdData->modelNumber[12];
18280   pInquiry[29] = pSATAIdData->modelNumber[13];
18281   pInquiry[30] = pSATAIdData->modelNumber[14];
18282   pInquiry[31] = pSATAIdData->modelNumber[15];
18283
18284   /* when flipped */
18285   /*
18286    * Product Revision level.
18287    */
18288
18289   /*
18290    * If the IDENTIFY DEVICE data received in words 25 and 26 from the ATA
18291    * device are ASCII spaces (20h), do this translation.
18292    */
18293   if ( (pSATAIdData->firmwareVersion[4] == 0x20 ) &&
18294        (pSATAIdData->firmwareVersion[5] == 0x00 ) &&
18295        (pSATAIdData->firmwareVersion[6] == 0x20 ) &&
18296        (pSATAIdData->firmwareVersion[7] == 0x00 )
18297        )
18298   {
18299     pInquiry[32] = pSATAIdData->firmwareVersion[0];
18300     pInquiry[33] = pSATAIdData->firmwareVersion[1];
18301     pInquiry[34] = pSATAIdData->firmwareVersion[2];
18302     pInquiry[35] = pSATAIdData->firmwareVersion[3];
18303   }
18304   else
18305   {
18306     pInquiry[32] = pSATAIdData->firmwareVersion[4];
18307     pInquiry[33] = pSATAIdData->firmwareVersion[5];
18308     pInquiry[34] = pSATAIdData->firmwareVersion[6];
18309     pInquiry[35] = pSATAIdData->firmwareVersion[7];
18310   }
18311 #endif
18312
18313   TI_DBG5(("satInquiryStandard: end\n"));
18314
18315 }
18316
18317
18318 /*****************************************************************************/
18319 /*! \brief SAT implementation for SCSI INQUIRY page 0.
18320  *
18321  *  SAT implementation for SCSI INQUIRY page 0.
18322  *
18323  *  \param   pInquiry:         Pointer to Inquiry Data buffer.
18324  *  \param   pSATAIdData:      Pointer to ATA IDENTIFY DEVICE data.
18325  *
18326  *  \return None.
18327  */
18328 /*****************************************************************************/
18329 GLOBAL void  satInquiryPage0(
18330                     bit8                    *pInquiry,
18331                     agsaSATAIdentifyData_t  *pSATAIdData)
18332 {
18333
18334   TI_DBG5(("satInquiryPage0: entry\n"));
18335
18336   /*
18337     See SPC-4, 7.6.9, p 345
18338     and SAT revision 8, 10.3.2, p 77
18339    */
18340   pInquiry[0] = 0x00;
18341   pInquiry[1] = 0x00; /* page code */
18342   pInquiry[2] = 0x00; /* reserved */
18343   pInquiry[3] = 7 - 3; /* last index(in this case, 6) - 3; page length */
18344
18345   /* supported vpd page list */
18346   pInquiry[4] = 0x00; /* page 0x00 supported */
18347   pInquiry[5] = 0x80; /* page 0x80 supported */
18348   pInquiry[6] = 0x83; /* page 0x83 supported */
18349   pInquiry[7] = 0x89; /* page 0x89 supported */
18350
18351 }
18352
18353
18354 /*****************************************************************************/
18355 /*! \brief SAT implementation for SCSI INQUIRY page 83.
18356  *
18357  *  SAT implementation for SCSI INQUIRY page 83.
18358  *
18359  *  \param   pInquiry:         Pointer to Inquiry Data buffer.
18360  *  \param   pSATAIdData:      Pointer to ATA IDENTIFY DEVICE data.
18361  *
18362  *  \return None.
18363  */
18364 /*****************************************************************************/
18365 GLOBAL void  satInquiryPage83(
18366                     bit8                    *pInquiry,
18367                     agsaSATAIdentifyData_t  *pSATAIdData,
18368                     satDeviceData_t         *pSatDevData)
18369 {
18370
18371   satSimpleSATAIdentifyData_t   *pSimpleData;
18372
18373   /*
18374    * When translating the fields, in some cases using the simple form of SATA
18375    * Identify Device Data is easier. So we define it here.
18376    * Both pSimpleData and pSATAIdData points to the same data.
18377    */
18378   pSimpleData = ( satSimpleSATAIdentifyData_t *)pSATAIdData;
18379
18380   TI_DBG5(("satInquiryPage83: entry\n"));
18381
18382   pInquiry[0] = 0x00;
18383   pInquiry[1] = 0x83; /* page code */
18384   pInquiry[2] = 0;    /* Reserved */
18385
18386   /*
18387    * If the ATA device returns word 87 bit 8 set to one in its IDENTIFY DEVICE
18388    * data indicating that it supports the WORLD WIDE NAME field
18389    * (i.e., words 108-111), the SATL shall include an identification descriptor
18390    * containing a logical unit name.
18391    */
18392   if ( pSatDevData->satWWNSupport)
18393   {
18394     /* Fill in SAT Rev8 Table85 */
18395     /*
18396      * Logical unit name derived from the world wide name.
18397      */
18398     pInquiry[3] = 12;         /* 15-3; page length, no addition ID descriptor assumed*/
18399
18400     /*
18401      * Identifier descriptor
18402      */
18403     pInquiry[4]  = 0x01;                        /* Code set: binary codes */
18404     pInquiry[5]  = 0x03;                        /* Identifier type : NAA  */
18405     pInquiry[6]  = 0x00;                        /* Reserved               */
18406     pInquiry[7]  = 0x08;                        /* Identifier length      */
18407
18408     /* Bit 4-7 NAA field, bit 0-3 MSB of IEEE Company ID */
18409     pInquiry[8]  = (bit8)((pSATAIdData->namingAuthority) >> 8);
18410     pInquiry[9]  = (bit8)((pSATAIdData->namingAuthority) & 0xFF);           /* IEEE Company ID */
18411     pInquiry[10] = (bit8)((pSATAIdData->namingAuthority1) >> 8);            /* IEEE Company ID */
18412     /* Bit 4-7 LSB of IEEE Company ID, bit 0-3 MSB of Vendor Specific ID */
18413     pInquiry[11] = (bit8)((pSATAIdData->namingAuthority1) & 0xFF);
18414     pInquiry[12] = (bit8)((pSATAIdData->uniqueID_bit16_31) >> 8);       /* Vendor Specific ID  */
18415     pInquiry[13] = (bit8)((pSATAIdData->uniqueID_bit16_31) & 0xFF);     /* Vendor Specific ID  */
18416     pInquiry[14] = (bit8)((pSATAIdData->uniqueID_bit0_15) >> 8);        /* Vendor Specific ID  */
18417     pInquiry[15] = (bit8)((pSATAIdData->uniqueID_bit0_15) & 0xFF);      /* Vendor Specific ID  */
18418
18419   }
18420   else
18421   {
18422     /* Fill in SAT Rev8 Table86 */
18423     /*
18424      * Logical unit name derived from the model number and serial number.
18425      */
18426     pInquiry[3] = 72;    /* 75 - 3; page length */
18427
18428     /*
18429      * Identifier descriptor
18430      */
18431     pInquiry[4] = 0x02;             /* Code set: ASCII codes */
18432     pInquiry[5] = 0x01;             /* Identifier type : T10 vendor ID based */
18433     pInquiry[6] = 0x00;             /* Reserved */
18434     pInquiry[7] = 0x44;               /* 0x44, 68 Identifier length */
18435
18436     /* Byte 8 to 15 is the vendor id string 'ATA     '. */
18437     osti_strncpy((char *)&pInquiry[8], AG_SAT_VENDOR_ID_STRING, 8);
18438
18439
18440         /*
18441      * Byte 16 to 75 is vendor specific id
18442      */
18443     pInquiry[16] = (bit8)((pSimpleData->word[27]) >> 8);
18444     pInquiry[17] = (bit8)((pSimpleData->word[27]) & 0x00ff);
18445     pInquiry[18] = (bit8)((pSimpleData->word[28]) >> 8);
18446     pInquiry[19] = (bit8)((pSimpleData->word[28]) & 0x00ff);
18447     pInquiry[20] = (bit8)((pSimpleData->word[29]) >> 8);
18448     pInquiry[21] = (bit8)((pSimpleData->word[29]) & 0x00ff);
18449     pInquiry[22] = (bit8)((pSimpleData->word[30]) >> 8);
18450     pInquiry[23] = (bit8)((pSimpleData->word[30]) & 0x00ff);
18451     pInquiry[24] = (bit8)((pSimpleData->word[31]) >> 8);
18452     pInquiry[25] = (bit8)((pSimpleData->word[31]) & 0x00ff);
18453     pInquiry[26] = (bit8)((pSimpleData->word[32]) >> 8);
18454     pInquiry[27] = (bit8)((pSimpleData->word[32]) & 0x00ff);
18455     pInquiry[28] = (bit8)((pSimpleData->word[33]) >> 8);
18456     pInquiry[29] = (bit8)((pSimpleData->word[33]) & 0x00ff);
18457     pInquiry[30] = (bit8)((pSimpleData->word[34]) >> 8);
18458     pInquiry[31] = (bit8)((pSimpleData->word[34]) & 0x00ff);
18459     pInquiry[32] = (bit8)((pSimpleData->word[35]) >> 8);
18460     pInquiry[33] = (bit8)((pSimpleData->word[35]) & 0x00ff);
18461     pInquiry[34] = (bit8)((pSimpleData->word[36]) >> 8);
18462     pInquiry[35] = (bit8)((pSimpleData->word[36]) & 0x00ff);
18463     pInquiry[36] = (bit8)((pSimpleData->word[37]) >> 8);
18464     pInquiry[37] = (bit8)((pSimpleData->word[37]) & 0x00ff);
18465     pInquiry[38] = (bit8)((pSimpleData->word[38]) >> 8);
18466     pInquiry[39] = (bit8)((pSimpleData->word[38]) & 0x00ff);
18467     pInquiry[40] = (bit8)((pSimpleData->word[39]) >> 8);
18468     pInquiry[41] = (bit8)((pSimpleData->word[39]) & 0x00ff);
18469     pInquiry[42] = (bit8)((pSimpleData->word[40]) >> 8);
18470     pInquiry[43] = (bit8)((pSimpleData->word[40]) & 0x00ff);
18471     pInquiry[44] = (bit8)((pSimpleData->word[41]) >> 8);
18472     pInquiry[45] = (bit8)((pSimpleData->word[41]) & 0x00ff);
18473     pInquiry[46] = (bit8)((pSimpleData->word[42]) >> 8);
18474     pInquiry[47] = (bit8)((pSimpleData->word[42]) & 0x00ff);
18475     pInquiry[48] = (bit8)((pSimpleData->word[43]) >> 8);
18476     pInquiry[49] = (bit8)((pSimpleData->word[43]) & 0x00ff);
18477     pInquiry[50] = (bit8)((pSimpleData->word[44]) >> 8);
18478     pInquiry[51] = (bit8)((pSimpleData->word[44]) & 0x00ff);
18479     pInquiry[52] = (bit8)((pSimpleData->word[45]) >> 8);
18480     pInquiry[53] = (bit8)((pSimpleData->word[45]) & 0x00ff);
18481     pInquiry[54] = (bit8)((pSimpleData->word[46]) >> 8);
18482     pInquiry[55] = (bit8)((pSimpleData->word[46]) & 0x00ff);
18483
18484     pInquiry[56] = (bit8)((pSimpleData->word[10]) >> 8);
18485     pInquiry[57] = (bit8)((pSimpleData->word[10]) & 0x00ff);
18486     pInquiry[58] = (bit8)((pSimpleData->word[11]) >> 8);
18487     pInquiry[59] = (bit8)((pSimpleData->word[11]) & 0x00ff);
18488     pInquiry[60] = (bit8)((pSimpleData->word[12]) >> 8);
18489     pInquiry[61] = (bit8)((pSimpleData->word[12]) & 0x00ff);
18490     pInquiry[62] = (bit8)((pSimpleData->word[13]) >> 8);
18491     pInquiry[63] = (bit8)((pSimpleData->word[13]) & 0x00ff);
18492     pInquiry[64] = (bit8)((pSimpleData->word[14]) >> 8);
18493     pInquiry[65] = (bit8)((pSimpleData->word[14]) & 0x00ff);
18494     pInquiry[66] = (bit8)((pSimpleData->word[15]) >> 8);
18495     pInquiry[67] = (bit8)((pSimpleData->word[15]) & 0x00ff);
18496     pInquiry[68] = (bit8)((pSimpleData->word[16]) >> 8);
18497     pInquiry[69] = (bit8)((pSimpleData->word[16]) & 0x00ff);
18498     pInquiry[70] = (bit8)((pSimpleData->word[17]) >> 8);
18499     pInquiry[71] = (bit8)((pSimpleData->word[17]) & 0x00ff);
18500     pInquiry[72] = (bit8)((pSimpleData->word[18]) >> 8);
18501     pInquiry[73] = (bit8)((pSimpleData->word[18]) & 0x00ff);
18502     pInquiry[74] = (bit8)((pSimpleData->word[19]) >> 8);
18503     pInquiry[75] = (bit8)((pSimpleData->word[19]) & 0x00ff);
18504   }
18505
18506 }
18507
18508 /*****************************************************************************/
18509 /*! \brief SAT implementation for SCSI INQUIRY page 89.
18510  *
18511  *  SAT implementation for SCSI INQUIRY page 89.
18512  *
18513  *  \param   pInquiry:         Pointer to Inquiry Data buffer.
18514  *  \param   pSATAIdData:      Pointer to ATA IDENTIFY DEVICE data.
18515  *  \param   pSatDevData       Pointer to internal device data structure
18516  *
18517  *  \return None.
18518  */
18519 /*****************************************************************************/
18520 GLOBAL void  satInquiryPage89(
18521                     bit8                    *pInquiry,
18522                     agsaSATAIdentifyData_t  *pSATAIdData,
18523                     satDeviceData_t         *pSatDevData)
18524 {
18525   /*
18526     SAT revision 8, 10.3.5, p 83
18527    */
18528   satSimpleSATAIdentifyData_t   *pSimpleData;
18529
18530   /*
18531    * When translating the fields, in some cases using the simple form of SATA
18532    * Identify Device Data is easier. So we define it here.
18533    * Both pSimpleData and pSATAIdData points to the same data.
18534    */
18535   pSimpleData = ( satSimpleSATAIdentifyData_t *)pSATAIdData;
18536
18537   TI_DBG5(("satInquiryPage89: start\n"));
18538
18539   pInquiry[0] = 0x00;   /* Peripheral Qualifier and Peripheral Device Type */
18540   pInquiry[1] = 0x89;   /* page code */
18541
18542   /* Page length 0x238 */
18543   pInquiry[2] = 0x02;
18544   pInquiry[3] = 0x38;
18545
18546   pInquiry[4] = 0x0;    /* reserved */
18547   pInquiry[5] = 0x0;    /* reserved */
18548   pInquiry[6] = 0x0;    /* reserved */
18549   pInquiry[7] = 0x0;    /* reserved */
18550
18551   /* SAT Vendor Identification */
18552   osti_strncpy((char*)&pInquiry[8],  "PMC-SIERRA", 8);   /* 8 bytes   */
18553
18554   /* SAT Product Idetification */
18555   osti_strncpy((char*)&pInquiry[16],  "Tachyon-SPC    ", 16);   /* 16 bytes   */
18556
18557   /* SAT Product Revision Level */
18558   osti_strncpy((char*)&pInquiry[32],  "01", 4);   /* 4 bytes   */
18559
18560   /* Signature, SAT revision8, Table88, p85 */
18561
18562
18563   pInquiry[36] = 0x34;    /* FIS type */
18564   if (pSatDevData->satDeviceType == SATA_ATA_DEVICE)
18565   {
18566     /* interrupt assume to be 0 */
18567     pInquiry[37] = (bit8)((pSatDevData->satPMField) >> (4 * 7)); /* first four bits of PM field */
18568   }
18569   else
18570   {
18571     /* interrupt assume to be 1 */
18572     pInquiry[37] = (bit8)(0x40 + (bit8)(((pSatDevData->satPMField) >> (4 * 7)))); /* first four bits of PM field */
18573   }
18574   pInquiry[38] = 0;
18575   pInquiry[39] = 0;
18576
18577   if (pSatDevData->satDeviceType == SATA_ATA_DEVICE)
18578   {
18579     pInquiry[40] = 0x01; /* LBA Low          */
18580     pInquiry[41] = 0x00; /* LBA Mid          */
18581     pInquiry[42] = 0x00; /* LBA High         */
18582     pInquiry[43] = 0x00; /* Device           */
18583     pInquiry[44] = 0x00; /* LBA Low Exp      */
18584     pInquiry[45] = 0x00; /* LBA Mid Exp      */
18585     pInquiry[46] = 0x00; /* LBA High Exp     */
18586     pInquiry[47] = 0x00; /* Reserved         */
18587     pInquiry[48] = 0x01; /* Sector Count     */
18588     pInquiry[49] = 0x00; /* Sector Count Exp */
18589   }
18590   else
18591   {
18592     pInquiry[40] = 0x01; /* LBA Low          */
18593     pInquiry[41] = 0x00; /* LBA Mid          */
18594     pInquiry[42] = 0x00; /* LBA High         */
18595     pInquiry[43] = 0x00; /* Device           */
18596     pInquiry[44] = 0x00; /* LBA Low Exp      */
18597     pInquiry[45] = 0x00; /* LBA Mid Exp      */
18598     pInquiry[46] = 0x00; /* LBA High Exp     */
18599     pInquiry[47] = 0x00; /* Reserved         */
18600     pInquiry[48] = 0x01; /* Sector Count     */
18601     pInquiry[49] = 0x00; /* Sector Count Exp */
18602   }
18603
18604   /* Reserved */
18605   pInquiry[50] = 0x00;
18606   pInquiry[51] = 0x00;
18607   pInquiry[52] = 0x00;
18608   pInquiry[53] = 0x00;
18609   pInquiry[54] = 0x00;
18610   pInquiry[55] = 0x00;
18611
18612   /* Command Code */
18613   if (pSatDevData->satDeviceType == SATA_ATA_DEVICE)
18614   {
18615     pInquiry[56] = 0xEC;    /* IDENTIFY DEVICE */
18616   }
18617   else
18618   {
18619     pInquiry[56] = 0xA1;    /* IDENTIFY PACKET DEVICE */
18620   }
18621   /* Reserved */
18622   pInquiry[57] = 0x0;
18623   pInquiry[58] = 0x0;
18624   pInquiry[59] = 0x0;
18625
18626   /* Identify Device */
18627   osti_memcpy(&pInquiry[60], pSimpleData, sizeof(satSimpleSATAIdentifyData_t));
18628   return;
18629 }
18630
18631 /*****************************************************************************/
18632 /*! \brief SAT implementation for SCSI INQUIRY page 0.
18633  *
18634  *  SAT implementation for SCSI INQUIRY page 0.
18635  *
18636  *  \param   pInquiry:         Pointer to Inquiry Data buffer.
18637  *  \param   pSATAIdData:      Pointer to ATA IDENTIFY DEVICE data.
18638  *
18639  *  \return None.
18640  */
18641 /*****************************************************************************/
18642 GLOBAL void  satInquiryPage80(
18643                     bit8                    *pInquiry,
18644                     agsaSATAIdentifyData_t  *pSATAIdData)
18645 {
18646
18647   TI_DBG5(("satInquiryPage80: entry\n"));
18648
18649   /*
18650     See SPC-4, 7.6.9, p 345
18651     and SAT revision 8, 10.3.3, p 77
18652    */
18653   pInquiry[0] = 0x00;
18654   pInquiry[1] = 0x80; /* page code */
18655   pInquiry[2] = 0x00; /* reserved */
18656   pInquiry[3] = 0x14; /* page length */
18657
18658   /* supported vpd page list */
18659   pInquiry[4] = pSATAIdData->serialNumber[1];
18660   pInquiry[5] = pSATAIdData->serialNumber[0];
18661   pInquiry[6] = pSATAIdData->serialNumber[3];
18662   pInquiry[7] = pSATAIdData->serialNumber[2];
18663   pInquiry[8] = pSATAIdData->serialNumber[5];
18664   pInquiry[9] = pSATAIdData->serialNumber[4];
18665   pInquiry[10] = pSATAIdData->serialNumber[7];
18666   pInquiry[11] = pSATAIdData->serialNumber[6];
18667   pInquiry[12] = pSATAIdData->serialNumber[9];
18668   pInquiry[13] = pSATAIdData->serialNumber[8];
18669   pInquiry[14] = pSATAIdData->serialNumber[11];
18670   pInquiry[15] = pSATAIdData->serialNumber[10];
18671   pInquiry[16] = pSATAIdData->serialNumber[13];
18672   pInquiry[17] = pSATAIdData->serialNumber[12];
18673   pInquiry[18] = pSATAIdData->serialNumber[15];
18674   pInquiry[19] = pSATAIdData->serialNumber[14];
18675   pInquiry[20] = pSATAIdData->serialNumber[17];
18676   pInquiry[21] = pSATAIdData->serialNumber[16];
18677   pInquiry[22] = pSATAIdData->serialNumber[19];
18678   pInquiry[23] = pSATAIdData->serialNumber[18];
18679
18680
18681 }
18682
18683
18684
18685 /*****************************************************************************/
18686 /*! \brief  Send READ LOG EXT ATA PAGE 10h command to sata drive.
18687  *
18688  *  Send READ LOG EXT ATA command PAGE 10h request to LL layer.
18689  *
18690  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
18691  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
18692  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
18693  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
18694  *  \param   satIOContext_t:   Pointer to the SAT IO Context
18695  *
18696  *  \return If command is started successfully
18697  *    - \e tiSuccess:     I/O request successfully initiated.
18698  *    - \e tiBusy:        No resources available, try again later.
18699  *    - \e tiIONoDevice:  Invalid device handle.
18700  *    - \e tiError:       Other errors.
18701  */
18702 /*****************************************************************************/
18703 GLOBAL bit32  satSendReadLogExt(
18704                    tiRoot_t                  *tiRoot,
18705                    tiIORequest_t             *tiIORequest,
18706                    tiDeviceHandle_t          *tiDeviceHandle,
18707                    tiScsiInitiatorRequest_t *tiScsiRequest,
18708                    satIOContext_t            *satIOContext)
18709
18710 {
18711
18712   bit32                     status;
18713   bit32                     agRequestType;
18714   agsaFisRegHostToDevice_t  *fis;
18715
18716   fis           = satIOContext->pFis;
18717
18718   TI_DBG1(("satSendReadLogExt: tiDeviceHandle=%p tiIORequest=%p\n",
18719       tiDeviceHandle, tiIORequest));
18720
18721   fis->h.fisType        = 0x27;                   /* Reg host to device */
18722   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
18723   fis->h.command        = SAT_READ_LOG_EXT;       /* 0x2F */
18724   fis->h.features       = 0;                      /* FIS reserve */
18725   fis->d.lbaLow         = 0x10;                   /* Page number */
18726   fis->d.lbaMid         = 0;                      /*  */
18727   fis->d.lbaHigh        = 0;                      /*  */
18728   fis->d.device         = 0;                      /* DEV is ignored in SATA */
18729   fis->d.lbaLowExp      = 0;                      /*  */
18730   fis->d.lbaMidExp      = 0;                      /*  */
18731   fis->d.lbaHighExp     = 0;                      /*  */
18732   fis->d.featuresExp    = 0;                      /* FIS reserve */
18733   fis->d.sectorCount    = 0x01;                   /*  1 sector counts*/
18734   fis->d.sectorCountExp = 0x00;                   /*  1 sector counts */
18735   fis->d.reserved4      = 0;
18736   fis->d.control        = 0;                      /* FIS HOB bit clear */
18737   fis->d.reserved5      = 0;
18738
18739   agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
18740
18741   /* Initialize CB for SATA completion.
18742    */
18743   satIOContext->satCompleteCB = &satReadLogExtCB;
18744
18745   /*
18746    * Prepare SGL and send FIS to LL layer.
18747    */
18748   satIOContext->reqType = agRequestType;       /* Save it */
18749
18750   status = sataLLIOStart( tiRoot,
18751                           tiIORequest,
18752                           tiDeviceHandle,
18753                           tiScsiRequest,
18754                           satIOContext);
18755
18756   TI_DBG1(("satSendReadLogExt: end status %d\n", status));
18757
18758   return (status);
18759
18760 }
18761
18762
18763 /*****************************************************************************/
18764 /*! \brief  SAT default ATA status and ATA error translation to SCSI.
18765  *
18766  *  SSAT default ATA status and ATA error translation to SCSI.
18767  *
18768  *  \param   tiRoot:        Pointer to TISA initiator driver/port instance.
18769  *  \param   tiIORequest:   Pointer to TISA I/O request context for this I/O.
18770  *  \param   satIOContext:  Pointer to the SAT IO Context
18771  *  \param   pSense:        Pointer to scsiRspSense_t
18772  *  \param   ataStatus:     ATA status register
18773  *  \param   ataError:      ATA error register
18774  *  \param   interruptContext:    Interrupt context
18775  *
18776  *  \return  None
18777  */
18778 /*****************************************************************************/
18779 GLOBAL void  osSatDefaultTranslation(
18780                    tiRoot_t             *tiRoot,
18781                    tiIORequest_t        *tiIORequest,
18782                    satIOContext_t       *satIOContext,
18783                    scsiRspSense_t       *pSense,
18784                    bit8                 ataStatus,
18785                    bit8                 ataError,
18786                    bit32                interruptContext )
18787 {
18788
18789   /*
18790    * Check for device fault case
18791    */
18792   if ( ataStatus & DF_ATA_STATUS_MASK )
18793   {
18794     satSetSensePayload( pSense,
18795                         SCSI_SNSKEY_HARDWARE_ERROR,
18796                         0,
18797                         SCSI_SNSCODE_INTERNAL_TARGET_FAILURE,
18798                         satIOContext);
18799
18800     ostiInitiatorIOCompleted( tiRoot,
18801                               tiIORequest,
18802                               tiIOSuccess,
18803                               SCSI_STAT_CHECK_CONDITION,
18804                               satIOContext->pTiSenseData,
18805                               interruptContext );
18806     return;
18807   }
18808
18809   /*
18810    * If status error bit it set, need to check the error register
18811    */
18812   if ( ataStatus & ERR_ATA_STATUS_MASK )
18813   {
18814     if ( ataError & NM_ATA_ERROR_MASK )
18815     {
18816       TI_DBG1(("osSatDefaultTranslation: NM_ATA_ERROR ataError= 0x%x, tiIORequest=%p\n",
18817                  ataError, tiIORequest));
18818       satSetSensePayload( pSense,
18819                           SCSI_SNSKEY_NOT_READY,
18820                           0,
18821                           SCSI_SNSCODE_MEDIUM_NOT_PRESENT,
18822                           satIOContext);
18823     }
18824
18825     else if (ataError & UNC_ATA_ERROR_MASK)
18826     {
18827       TI_DBG1(("osSatDefaultTranslation: UNC_ATA_ERROR ataError= 0x%x, tiIORequest=%p\n",
18828                  ataError, tiIORequest));
18829       satSetSensePayload( pSense,
18830                           SCSI_SNSKEY_MEDIUM_ERROR,
18831                           0,
18832                           SCSI_SNSCODE_UNRECOVERED_READ_ERROR,
18833                           satIOContext);
18834     }
18835
18836     else if (ataError & IDNF_ATA_ERROR_MASK)
18837     {
18838       TI_DBG1(("osSatDefaultTranslation: IDNF_ATA_ERROR ataError= 0x%x, tiIORequest=%p\n",
18839                  ataError, tiIORequest));
18840       satSetSensePayload( pSense,
18841                           SCSI_SNSKEY_MEDIUM_ERROR,
18842                           0,
18843                           SCSI_SNSCODE_RECORD_NOT_FOUND,
18844                           satIOContext);
18845     }
18846
18847     else if (ataError & MC_ATA_ERROR_MASK)
18848     {
18849       TI_DBG1(("osSatDefaultTranslation: MC_ATA_ERROR ataError= 0x%x, tiIORequest=%p\n",
18850                  ataError, tiIORequest));
18851       satSetSensePayload( pSense,
18852                           SCSI_SNSKEY_UNIT_ATTENTION,
18853                           0,
18854                           SCSI_SNSCODE_NOT_READY_TO_READY_CHANGE,
18855                           satIOContext);
18856     }
18857
18858     else if (ataError & MCR_ATA_ERROR_MASK)
18859     {
18860       TI_DBG1(("osSatDefaultTranslation: MCR_ATA_ERROR ataError= 0x%x, tiIORequest=%p\n",
18861                  ataError, tiIORequest));
18862       satSetSensePayload( pSense,
18863                           SCSI_SNSKEY_UNIT_ATTENTION,
18864                           0,
18865                           SCSI_SNSCODE_OPERATOR_MEDIUM_REMOVAL_REQUEST,
18866                           satIOContext);
18867     }
18868
18869     else if (ataError & ICRC_ATA_ERROR_MASK)
18870     {
18871       TI_DBG1(("osSatDefaultTranslation: ICRC_ATA_ERROR ataError= 0x%x, tiIORequest=%p\n",
18872                  ataError, tiIORequest));
18873       satSetSensePayload( pSense,
18874                           SCSI_SNSKEY_ABORTED_COMMAND,
18875                           0,
18876                           SCSI_SNSCODE_INFORMATION_UNIT_CRC_ERROR,
18877                           satIOContext);
18878     }
18879
18880     else if (ataError & ABRT_ATA_ERROR_MASK)
18881     {
18882       TI_DBG1(("osSatDefaultTranslation: ABRT_ATA_ERROR ataError= 0x%x, tiIORequest=%p\n",
18883                  ataError, tiIORequest));
18884       satSetSensePayload( pSense,
18885                           SCSI_SNSKEY_ABORTED_COMMAND,
18886                           0,
18887                           SCSI_SNSCODE_NO_ADDITIONAL_INFO,
18888                           satIOContext);
18889     }
18890
18891     else
18892     {
18893       TI_DBG1(("osSatDefaultTranslation: **** UNEXPECTED ATA_ERROR **** ataError= 0x%x, tiIORequest=%p\n",
18894                  ataError, tiIORequest));
18895       satSetSensePayload( pSense,
18896                           SCSI_SNSKEY_HARDWARE_ERROR,
18897                           0,
18898                           SCSI_SNSCODE_INTERNAL_TARGET_FAILURE,
18899                           satIOContext);
18900     }
18901
18902     /* Send the completion response now */
18903     ostiInitiatorIOCompleted( tiRoot,
18904                               tiIORequest,
18905                               tiIOSuccess,
18906                               SCSI_STAT_CHECK_CONDITION,
18907                               satIOContext->pTiSenseData,
18908                               interruptContext );
18909     return;
18910
18911
18912   }
18913
18914   else /*  (ataStatus & ERR_ATA_STATUS_MASK ) is false */
18915   {
18916     /* This case should never happen */
18917     TI_DBG1(("osSatDefaultTranslation: *** UNEXPECTED ATA status 0x%x *** tiIORequest=%p\n",
18918                  ataStatus, tiIORequest));
18919     satSetSensePayload( pSense,
18920                         SCSI_SNSKEY_HARDWARE_ERROR,
18921                         0,
18922                         SCSI_SNSCODE_INTERNAL_TARGET_FAILURE,
18923                         satIOContext);
18924
18925     ostiInitiatorIOCompleted( tiRoot,
18926                               tiIORequest,
18927                               tiIOSuccess,
18928                               SCSI_STAT_CHECK_CONDITION,
18929                               satIOContext->pTiSenseData,
18930                               interruptContext );
18931     return;
18932
18933   }
18934
18935
18936 }
18937
18938 /*****************************************************************************/
18939 /*! \brief  Allocate resource for SAT intervally generated I/O.
18940  *
18941  *  Allocate resource for SAT intervally generated I/O.
18942  *
18943  *  \param   tiRoot:      Pointer to TISA driver/port instance.
18944  *  \param   satDevData:  Pointer to SAT specific device data.
18945  *  \param   allocLength: Length in byte of the DMA mem to allocate, upto
18946  *                        one page size.
18947  *  \param   satIntIo:    Pointer (output) to context for SAT internally
18948  *                        generated I/O that is allocated by this routine.
18949  *
18950  *  \return If command is started successfully
18951  *    - \e tiSuccess:     Success.
18952  *    - \e tiError:       Failed allocating resource.
18953  */
18954 /*****************************************************************************/
18955 GLOBAL satInternalIo_t * satAllocIntIoResource(
18956                     tiRoot_t              *tiRoot,
18957                     tiIORequest_t         *tiIORequest,
18958                     satDeviceData_t       *satDevData,
18959                     bit32                 dmaAllocLength,
18960                     satInternalIo_t       *satIntIo)
18961 {
18962   tdList_t          *tdList = agNULL;
18963   bit32             memAllocStatus;
18964
18965   TI_DBG1(("satAllocIntIoResource: start\n"));
18966   TI_DBG6(("satAllocIntIoResource: satIntIo %p\n", satIntIo));
18967   if (satDevData == agNULL)
18968   {
18969     TI_DBG1(("satAllocIntIoResource: ***** ASSERT satDevData is null\n"));
18970     return agNULL;
18971   }
18972
18973   tdsaSingleThreadedEnter(tiRoot, TD_SATA_LOCK);
18974   if (!TDLIST_EMPTY(&(satDevData->satFreeIntIoLinkList)))
18975   {
18976     TDLIST_DEQUEUE_FROM_HEAD(&tdList, &(satDevData->satFreeIntIoLinkList));
18977   }
18978   else
18979   {
18980     tdsaSingleThreadedLeave(tiRoot, TD_SATA_LOCK);
18981     TI_DBG1(("satAllocIntIoResource() no more internal free link.\n"));
18982     return agNULL;
18983   }
18984
18985   if (tdList == agNULL)
18986   {
18987     tdsaSingleThreadedLeave(tiRoot, TD_SATA_LOCK);
18988     TI_DBG1(("satAllocIntIoResource() FAIL to alloc satIntIo.\n"));
18989     return agNULL;
18990   }
18991
18992   satIntIo = TDLIST_OBJECT_BASE( satInternalIo_t, satIntIoLink, tdList);
18993   TI_DBG6(("satAllocIntIoResource: satDevData %p satIntIo id %d\n", satDevData, satIntIo->id));
18994
18995   /* Put in active list */
18996   TDLIST_DEQUEUE_THIS (&(satIntIo->satIntIoLink));
18997   TDLIST_ENQUEUE_AT_TAIL (&(satIntIo->satIntIoLink), &(satDevData->satActiveIntIoLinkList));
18998   tdsaSingleThreadedLeave(tiRoot, TD_SATA_LOCK);
18999
19000 #ifdef REMOVED
19001   /* Put in active list */
19002   tdsaSingleThreadedEnter(tiRoot, TD_SATA_LOCK);
19003   TDLIST_DEQUEUE_THIS (tdList);
19004   TDLIST_ENQUEUE_AT_TAIL (tdList, &(satDevData->satActiveIntIoLinkList));
19005   tdsaSingleThreadedLeave(tiRoot, TD_SATA_LOCK);
19006
19007   satIntIo = TDLIST_OBJECT_BASE( satInternalIo_t, satIntIoLink, tdList);
19008   TI_DBG6(("satAllocIntIoResource: satDevData %p satIntIo id %d\n", satDevData, satIntIo->id));
19009 #endif
19010
19011   /*
19012     typedef struct
19013     {
19014       tdList_t                    satIntIoLink;
19015       tiIORequest_t               satIntTiIORequest;
19016       void                        *satIntRequestBody;
19017       tiScsiInitiatorRequest_t   satIntTiScsiXchg;
19018       tiMem_t                     satIntDmaMem;
19019       tiMem_t                     satIntReqBodyMem;
19020       bit32                       satIntFlag;
19021     } satInternalIo_t;
19022   */
19023
19024   /*
19025    * Allocate mem for Request Body
19026    */
19027   satIntIo->satIntReqBodyMem.totalLength = sizeof(tdIORequestBody_t);
19028
19029   memAllocStatus = ostiAllocMemory( tiRoot,
19030                                     &satIntIo->satIntReqBodyMem.osHandle,
19031                                     (void **)&satIntIo->satIntRequestBody,
19032                                     &satIntIo->satIntReqBodyMem.physAddrUpper,
19033                                     &satIntIo->satIntReqBodyMem.physAddrLower,
19034                                     8,
19035                                     satIntIo->satIntReqBodyMem.totalLength,
19036                                     agTRUE );
19037
19038   if (memAllocStatus != tiSuccess)
19039   {
19040     TI_DBG1(("satAllocIntIoResource() FAIL to alloc mem for Req Body.\n"));
19041     /*
19042      * Return satIntIo to the free list
19043      */
19044     tdsaSingleThreadedEnter(tiRoot, TD_SATA_LOCK);
19045     TDLIST_DEQUEUE_THIS (&satIntIo->satIntIoLink);
19046     TDLIST_ENQUEUE_AT_HEAD(&satIntIo->satIntIoLink, &satDevData->satFreeIntIoLinkList);
19047     tdsaSingleThreadedLeave(tiRoot, TD_SATA_LOCK);
19048
19049     return agNULL;
19050   }
19051
19052   /*
19053    *   Allocate DMA memory if required
19054    */
19055   if (dmaAllocLength != 0)
19056   {
19057     satIntIo->satIntDmaMem.totalLength = dmaAllocLength;
19058
19059     memAllocStatus = ostiAllocMemory( tiRoot,
19060                                       &satIntIo->satIntDmaMem.osHandle,
19061                                       (void **)&satIntIo->satIntDmaMem.virtPtr,
19062                                       &satIntIo->satIntDmaMem.physAddrUpper,
19063                                       &satIntIo->satIntDmaMem.physAddrLower,
19064                                       8,
19065                                       satIntIo->satIntDmaMem.totalLength,
19066                                       agFALSE);
19067     TI_DBG6(("satAllocIntIoResource: len %d \n", satIntIo->satIntDmaMem.totalLength));
19068     TI_DBG6(("satAllocIntIoResource: pointer %p \n", satIntIo->satIntDmaMem.osHandle));
19069
19070     if (memAllocStatus != tiSuccess)
19071     {
19072       TI_DBG1(("satAllocIntIoResource() FAIL to alloc mem for DMA mem.\n"));
19073       /*
19074        * Return satIntIo to the free list
19075        */
19076       tdsaSingleThreadedEnter(tiRoot, TD_SATA_LOCK);
19077       TDLIST_DEQUEUE_THIS (&satIntIo->satIntIoLink);
19078       TDLIST_ENQUEUE_AT_HEAD(&satIntIo->satIntIoLink, &satDevData->satFreeIntIoLinkList);
19079       tdsaSingleThreadedLeave(tiRoot, TD_SATA_LOCK);
19080
19081       /*
19082        * Free mem allocated for Req body
19083        */
19084       ostiFreeMemory( tiRoot,
19085                       satIntIo->satIntReqBodyMem.osHandle,
19086                       satIntIo->satIntReqBodyMem.totalLength);
19087
19088       return agNULL;
19089     }
19090   }
19091
19092   /*
19093     typedef struct
19094     {
19095       tdList_t                    satIntIoLink;
19096       tiIORequest_t               satIntTiIORequest;
19097       void                        *satIntRequestBody;
19098       tiScsiInitiatorRequest_t   satIntTiScsiXchg;
19099       tiMem_t                     satIntDmaMem;
19100       tiMem_t                     satIntReqBodyMem;
19101       bit32                       satIntFlag;
19102     } satInternalIo_t;
19103   */
19104
19105   /*
19106    * Initialize satIntTiIORequest field
19107    */
19108   satIntIo->satIntTiIORequest.osData = agNULL;  /* Not used for internal SAT I/O */
19109   satIntIo->satIntTiIORequest.tdData = satIntIo->satIntRequestBody;
19110
19111   /*
19112    * saves the original tiIOrequest
19113    */
19114   satIntIo->satOrgTiIORequest = tiIORequest;
19115   /*
19116     typedef struct tiIniScsiCmnd
19117     {
19118       tiLUN_t     lun;
19119       bit32       expDataLength;
19120       bit32       taskAttribute;
19121       bit32       crn;
19122       bit8        cdb[16];
19123     } tiIniScsiCmnd_t;
19124
19125     typedef struct tiScsiInitiatorExchange
19126     {
19127       void                *sglVirtualAddr;
19128       tiIniScsiCmnd_t     scsiCmnd;
19129       tiSgl_t             agSgl1;
19130       tiSgl_t             agSgl2;
19131       tiDataDirection_t   dataDirection;
19132     } tiScsiInitiatorRequest_t;
19133
19134   */
19135
19136   /*
19137    * Initialize satIntTiScsiXchg. Since the internal SAT request is NOT
19138    * originated from SCSI request, only the following fields are initialized:
19139    *  - sglVirtualAddr if DMA transfer is involved
19140    *  - agSgl1 if DMA transfer is involved
19141    *  - expDataLength in scsiCmnd since this field is read by sataLLIOStart()
19142    */
19143   if (dmaAllocLength != 0)
19144   {
19145     satIntIo->satIntTiScsiXchg.sglVirtualAddr = satIntIo->satIntDmaMem.virtPtr;
19146
19147     OSSA_WRITE_LE_32(agNULL, &satIntIo->satIntTiScsiXchg.agSgl1.len, 0,
19148                      satIntIo->satIntDmaMem.totalLength);
19149     satIntIo->satIntTiScsiXchg.agSgl1.lower = satIntIo->satIntDmaMem.physAddrLower;
19150     satIntIo->satIntTiScsiXchg.agSgl1.upper = satIntIo->satIntDmaMem.physAddrUpper;
19151     satIntIo->satIntTiScsiXchg.agSgl1.type  = tiSgl;
19152
19153     satIntIo->satIntTiScsiXchg.scsiCmnd.expDataLength = satIntIo->satIntDmaMem.totalLength;
19154   }
19155   else
19156   {
19157     satIntIo->satIntTiScsiXchg.sglVirtualAddr = agNULL;
19158
19159     satIntIo->satIntTiScsiXchg.agSgl1.len   = 0;
19160     satIntIo->satIntTiScsiXchg.agSgl1.lower = 0;
19161     satIntIo->satIntTiScsiXchg.agSgl1.upper = 0;
19162     satIntIo->satIntTiScsiXchg.agSgl1.type  = tiSgl;
19163
19164     satIntIo->satIntTiScsiXchg.scsiCmnd.expDataLength = 0;
19165   }
19166
19167   TI_DBG5(("satAllocIntIoResource: satIntIo->satIntTiScsiXchg.agSgl1.len %d\n", satIntIo->satIntTiScsiXchg.agSgl1.len));
19168
19169   TI_DBG5(("satAllocIntIoResource: satIntIo->satIntTiScsiXchg.agSgl1.upper %d\n", satIntIo->satIntTiScsiXchg.agSgl1.upper));
19170
19171   TI_DBG5(("satAllocIntIoResource: satIntIo->satIntTiScsiXchg.agSgl1.lower %d\n", satIntIo->satIntTiScsiXchg.agSgl1.lower));
19172
19173   TI_DBG5(("satAllocIntIoResource: satIntIo->satIntTiScsiXchg.agSgl1.type %d\n", satIntIo->satIntTiScsiXchg.agSgl1.type));
19174     TI_DBG5(("satAllocIntIoResource: return satIntIo %p\n", satIntIo));
19175   return  satIntIo;
19176
19177 }
19178
19179 /*****************************************************************************/
19180 /*! \brief  Free resource for SAT intervally generated I/O.
19181  *
19182  *  Free resource for SAT intervally generated I/O that was previously
19183  *  allocated in satAllocIntIoResource().
19184  *
19185  *  \param   tiRoot:      Pointer to TISA driver/port instance.
19186  *  \param   satDevData:  Pointer to SAT specific device data.
19187  *  \param   satIntIo:    Pointer to context for SAT internal I/O that was
19188  *                        previously allocated in satAllocIntIoResource().
19189  *
19190  *  \return  None
19191  */
19192 /*****************************************************************************/
19193 GLOBAL void  satFreeIntIoResource(
19194                     tiRoot_t              *tiRoot,
19195                     satDeviceData_t       *satDevData,
19196                     satInternalIo_t       *satIntIo)
19197 {
19198   TI_DBG6(("satFreeIntIoResource: start\n"));
19199
19200   if (satIntIo == agNULL)
19201   {
19202     TI_DBG6(("satFreeIntIoResource: allowed call\n"));
19203     return;
19204   }
19205
19206   /* sets the original tiIOrequest to agNULL for internally generated ATA cmnd */
19207   satIntIo->satOrgTiIORequest = agNULL;
19208
19209   /*
19210    * Free DMA memory if previosly alocated
19211    */
19212   if (satIntIo->satIntTiScsiXchg.scsiCmnd.expDataLength != 0)
19213   {
19214     TI_DBG1(("satFreeIntIoResource: DMA len %d\n", satIntIo->satIntDmaMem.totalLength));
19215     TI_DBG6(("satFreeIntIoResource: pointer %p\n", satIntIo->satIntDmaMem.osHandle));
19216
19217     ostiFreeMemory( tiRoot,
19218                     satIntIo->satIntDmaMem.osHandle,
19219                     satIntIo->satIntDmaMem.totalLength);
19220     satIntIo->satIntTiScsiXchg.scsiCmnd.expDataLength = 0;
19221   }
19222
19223   if (satIntIo->satIntReqBodyMem.totalLength != 0)
19224   {
19225     TI_DBG1(("satFreeIntIoResource: req body len %d\n", satIntIo->satIntReqBodyMem.totalLength));
19226     /*
19227      * Free mem allocated for Req body
19228      */
19229     ostiFreeMemory( tiRoot,
19230                     satIntIo->satIntReqBodyMem.osHandle,
19231                     satIntIo->satIntReqBodyMem.totalLength);
19232
19233     satIntIo->satIntReqBodyMem.totalLength = 0;
19234   }
19235
19236   TI_DBG6(("satFreeIntIoResource: satDevData %p satIntIo id %d\n", satDevData, satIntIo->id));
19237   /*
19238    * Return satIntIo to the free list
19239    */
19240   tdsaSingleThreadedEnter(tiRoot, TD_SATA_LOCK);
19241   TDLIST_DEQUEUE_THIS (&(satIntIo->satIntIoLink));
19242   TDLIST_ENQUEUE_AT_TAIL (&(satIntIo->satIntIoLink), &(satDevData->satFreeIntIoLinkList));
19243   tdsaSingleThreadedLeave(tiRoot, TD_SATA_LOCK);
19244
19245 }
19246
19247
19248 /*****************************************************************************/
19249 /*! \brief SAT implementation for SCSI INQUIRY.
19250  *
19251  *  SAT implementation for SCSI INQUIRY.
19252  *  This function sends ATA Identify Device data command for SCSI INQUIRY
19253  *
19254  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
19255  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
19256  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
19257  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
19258  *  \param   satIOContext_t:   Pointer to the SAT IO Context
19259  *
19260  *  \return If command is started successfully
19261  *    - \e tiSuccess:     I/O request successfully initiated.
19262  *    - \e tiBusy:        No resources available, try again later.
19263  *    - \e tiIONoDevice:  Invalid device handle.
19264  *    - \e tiError:       Other errors.
19265  */
19266 /*****************************************************************************/
19267 GLOBAL bit32  satSendIDDev(
19268                            tiRoot_t                  *tiRoot,
19269                            tiIORequest_t             *tiIORequest,
19270                            tiDeviceHandle_t          *tiDeviceHandle,
19271                            tiScsiInitiatorRequest_t *tiScsiRequest,
19272                            satIOContext_t            *satIOContext)
19273
19274 {
19275   bit32                     status;
19276   bit32                     agRequestType;
19277   satDeviceData_t           *pSatDevData;
19278   agsaFisRegHostToDevice_t  *fis;
19279 #ifdef  TD_DEBUG_ENABLE
19280   satInternalIo_t           *satIntIoContext;
19281   tdsaDeviceData_t          *oneDeviceData;
19282   tdIORequestBody_t         *tdIORequestBody;
19283 #endif
19284
19285   pSatDevData   = satIOContext->pSatDevData;
19286   fis           = satIOContext->pFis;
19287
19288   TI_DBG5(("satSendIDDev: start\n"));
19289 #ifdef  TD_DEBUG_ENABLE
19290   oneDeviceData = (tdsaDeviceData_t *)tiDeviceHandle->tdData;
19291 #endif
19292   TI_DBG5(("satSendIDDev: did %d\n", oneDeviceData->id));
19293
19294
19295 #ifdef  TD_DEBUG_ENABLE
19296   satIntIoContext = satIOContext->satIntIoContext;
19297   tdIORequestBody = satIntIoContext->satIntRequestBody;
19298 #endif
19299
19300   TI_DBG5(("satSendIDDev: satIOContext %p tdIORequestBody %p\n", satIOContext, tdIORequestBody));
19301
19302   fis->h.fisType        = 0x27;                   /* Reg host to device */
19303   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
19304   if (pSatDevData->satDeviceType == SATA_ATAPI_DEVICE)
19305       fis->h.command    = SAT_IDENTIFY_PACKET_DEVICE;  /* 0x40 */
19306   else
19307       fis->h.command    = SAT_IDENTIFY_DEVICE;    /* 0xEC */
19308   fis->h.features       = 0;                      /* FIS reserve */
19309   fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
19310   fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
19311   fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
19312   fis->d.device         = 0;                      /* FIS LBA mode  */
19313   fis->d.lbaLowExp      = 0;
19314   fis->d.lbaMidExp      = 0;
19315   fis->d.lbaHighExp     = 0;
19316   fis->d.featuresExp    = 0;
19317   fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
19318   fis->d.sectorCountExp = 0;
19319   fis->d.reserved4      = 0;
19320   fis->d.control        = 0;                      /* FIS HOB bit clear */
19321   fis->d.reserved5      = 0;
19322
19323   agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
19324
19325   /* Initialize CB for SATA completion.
19326    */
19327   satIOContext->satCompleteCB = &satInquiryCB;
19328
19329   /*
19330    * Prepare SGL and send FIS to LL layer.
19331    */
19332   satIOContext->reqType = agRequestType;       /* Save it */
19333
19334 #ifdef TD_INTERNAL_DEBUG
19335   tdhexdump("satSendIDDev", (bit8 *)satIOContext->pFis, sizeof(agsaFisRegHostToDevice_t));
19336 #ifdef  TD_DEBUG_ENABLE
19337   tdhexdump("satSendIDDev LL", (bit8 *)&(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev), sizeof(agsaFisRegHostToDevice_t));
19338 #endif
19339 #endif
19340
19341   status = sataLLIOStart( tiRoot,
19342                           tiIORequest,
19343                           tiDeviceHandle,
19344                           tiScsiRequest,
19345                           satIOContext);
19346
19347   TI_DBG6(("satSendIDDev: end status %d\n", status));
19348   return status;
19349 }
19350
19351
19352 /*****************************************************************************/
19353 /*! \brief SAT implementation for SCSI INQUIRY.
19354  *
19355  *  SAT implementation for SCSI INQUIRY.
19356  *  This function prepares TD layer internal resource to send ATA
19357  *  Identify Device data command for SCSI INQUIRY
19358  *
19359  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
19360  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
19361  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
19362  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
19363  *  \param   satIOContext_t:   Pointer to the SAT IO Context
19364  *
19365  *  \return If command is started successfully
19366  *    - \e tiSuccess:     I/O request successfully initiated.
19367  *    - \e tiBusy:        No resources available, try again later.
19368  *    - \e tiIONoDevice:  Invalid device handle.
19369  *    - \e tiError:       Other errors.
19370  */
19371 /*****************************************************************************/
19372 /* prerequsite: tdsaDeviceData and agdevhandle must exist; in other words, LL discovered the device
19373    already */
19374 /*
19375   convert OS generated IO to TD generated IO due to difference in sgl
19376 */
19377 GLOBAL bit32  satStartIDDev(
19378                                tiRoot_t                  *tiRoot,
19379                                tiIORequest_t             *tiIORequest,
19380                                tiDeviceHandle_t          *tiDeviceHandle,
19381                                tiScsiInitiatorRequest_t *tiScsiRequest,
19382                                satIOContext_t            *satIOContext
19383                             )
19384 {
19385   satInternalIo_t           *satIntIo = agNULL;
19386   satDeviceData_t           *satDevData = agNULL;
19387   tdIORequestBody_t         *tdIORequestBody;
19388   satIOContext_t            *satNewIOContext;
19389   bit32                     status;
19390
19391   TI_DBG6(("satStartIDDev: start\n"));
19392
19393   satDevData = satIOContext->pSatDevData;
19394
19395   TI_DBG6(("satStartIDDev: before alloc\n"));
19396
19397   /* allocate identify device command */
19398   satIntIo = satAllocIntIoResource( tiRoot,
19399                                     tiIORequest,
19400                                     satDevData,
19401                                     sizeof(agsaSATAIdentifyData_t), /* 512; size of identify device data */
19402                                     satIntIo);
19403
19404   TI_DBG6(("satStartIDDev: before after\n"));
19405
19406   if (satIntIo == agNULL)
19407   {
19408     TI_DBG1(("satStartIDDev: can't alloacate\n"));
19409
19410 #if 0
19411     ostiInitiatorIOCompleted (
19412                               tiRoot,
19413                               tiIORequest,
19414                               tiIOFailed,
19415                               tiDetailOtherError,
19416                               agNULL,
19417                               satIOContext->interruptContext
19418                               );
19419 #endif
19420
19421     return tiError;
19422   }
19423
19424   /* fill in fields */
19425   /* real ttttttthe one worked and the same; 5/21/07/ */
19426   satIntIo->satOrgTiIORequest = tiIORequest; /* changed */
19427   tdIORequestBody = satIntIo->satIntRequestBody;
19428   satNewIOContext = &(tdIORequestBody->transport.SATA.satIOContext);
19429
19430   satNewIOContext->pSatDevData   = satDevData;
19431   satNewIOContext->pFis          = &(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev);
19432   satNewIOContext->pScsiCmnd     = &(satIntIo->satIntTiScsiXchg.scsiCmnd);
19433   satNewIOContext->pSense        = &(tdIORequestBody->transport.SATA.sensePayload);
19434   satNewIOContext->pTiSenseData  = &(tdIORequestBody->transport.SATA.tiSenseData);
19435   satNewIOContext->tiRequestBody = satIntIo->satIntRequestBody; /* key fix */
19436   satNewIOContext->interruptContext = tiInterruptContext;
19437   satNewIOContext->satIntIoContext  = satIntIo;
19438
19439   satNewIOContext->ptiDeviceHandle = agNULL;
19440   satNewIOContext->satOrgIOContext = satIOContext; /* changed */
19441
19442   /* this is valid only for TD layer generated (not triggered by OS at all) IO */
19443   satNewIOContext->tiScsiXchg = &(satIntIo->satIntTiScsiXchg);
19444
19445
19446   TI_DBG6(("satStartIDDev: OS satIOContext %p \n", satIOContext));
19447   TI_DBG6(("satStartIDDev: TD satNewIOContext %p \n", satNewIOContext));
19448   TI_DBG6(("satStartIDDev: OS tiScsiXchg %p \n", satIOContext->tiScsiXchg));
19449   TI_DBG6(("satStartIDDev: TD tiScsiXchg %p \n", satNewIOContext->tiScsiXchg));
19450
19451
19452
19453   TI_DBG1(("satStartIDDev: satNewIOContext %p tdIORequestBody %p\n", satNewIOContext, tdIORequestBody));
19454
19455   status = satSendIDDev( tiRoot,
19456                          &satIntIo->satIntTiIORequest, /* New tiIORequest */
19457                          tiDeviceHandle,
19458                          satNewIOContext->tiScsiXchg, /* New tiScsiInitiatorRequest_t *tiScsiRequest, */
19459                          satNewIOContext);
19460
19461   if (status != tiSuccess)
19462   {
19463     TI_DBG1(("satStartIDDev: failed in sending\n"));
19464
19465     satFreeIntIoResource( tiRoot,
19466                           satDevData,
19467                           satIntIo);
19468
19469 #if 0
19470     ostiInitiatorIOCompleted (
19471                               tiRoot,
19472                               tiIORequest,
19473                               tiIOFailed,
19474                               tiDetailOtherError,
19475                               agNULL,
19476                               satIOContext->interruptContext
19477                               );
19478 #endif
19479
19480     return tiError;
19481   }
19482
19483
19484   TI_DBG6(("satStartIDDev: end\n"));
19485
19486   return status;
19487
19488
19489 }
19490
19491 /*****************************************************************************/
19492 /*! \brief satComputeCDB10LBA.
19493  *
19494  *  This fuctions computes LBA of CDB10.
19495  *
19496  *  \param   satIOContext_t:   Pointer to the SAT IO Context
19497  *
19498  *  \return
19499  *    - \e LBA
19500  */
19501 /*****************************************************************************/
19502 bit32 satComputeCDB10LBA(satIOContext_t            *satIOContext)
19503 {
19504   tiIniScsiCmnd_t           *scsiCmnd;
19505   tiScsiInitiatorRequest_t *tiScsiRequest;
19506   bit32                     lba = 0;
19507
19508   TI_DBG5(("satComputeCDB10LBA: start\n"));
19509   tiScsiRequest = satIOContext->tiScsiXchg;
19510   scsiCmnd      = &(tiScsiRequest->scsiCmnd);
19511
19512   lba = (scsiCmnd->cdb[2] << (8*3)) + (scsiCmnd->cdb[3] << (8*2))
19513     + (scsiCmnd->cdb[4] << 8) + scsiCmnd->cdb[5];
19514
19515   return lba;
19516 }
19517
19518 /*****************************************************************************/
19519 /*! \brief satComputeCDB10TL.
19520  *
19521  *  This fuctions computes transfer length of CDB10.
19522  *
19523  *  \param   satIOContext_t:   Pointer to the SAT IO Context
19524  *
19525  *  \return
19526  *    - \e TL
19527  */
19528 /*****************************************************************************/
19529 bit32 satComputeCDB10TL(satIOContext_t            *satIOContext)
19530 {
19531
19532   tiIniScsiCmnd_t           *scsiCmnd;
19533   tiScsiInitiatorRequest_t *tiScsiRequest;
19534   bit32                     tl = 0;
19535
19536   TI_DBG5(("satComputeCDB10TL: start\n"));
19537   tiScsiRequest = satIOContext->tiScsiXchg;
19538   scsiCmnd      = &(tiScsiRequest->scsiCmnd);
19539
19540   tl = (scsiCmnd->cdb[7] << 8) + scsiCmnd->cdb[8];
19541   return tl;
19542 }
19543
19544 /*****************************************************************************/
19545 /*! \brief satComputeCDB12LBA.
19546  *
19547  *  This fuctions computes LBA of CDB12.
19548  *
19549  *  \param   satIOContext_t:   Pointer to the SAT IO Context
19550  *
19551  *  \return
19552  *    - \e LBA
19553  */
19554 /*****************************************************************************/
19555 bit32 satComputeCDB12LBA(satIOContext_t            *satIOContext)
19556 {
19557   tiIniScsiCmnd_t           *scsiCmnd;
19558   tiScsiInitiatorRequest_t *tiScsiRequest;
19559   bit32                     lba = 0;
19560
19561   TI_DBG5(("satComputeCDB10LBA: start\n"));
19562   tiScsiRequest = satIOContext->tiScsiXchg;
19563   scsiCmnd      = &(tiScsiRequest->scsiCmnd);
19564
19565   lba = (scsiCmnd->cdb[2] << (8*3)) + (scsiCmnd->cdb[3] << (8*2))
19566     + (scsiCmnd->cdb[4] << 8) + scsiCmnd->cdb[5];
19567
19568   return lba;
19569 }
19570
19571 /*****************************************************************************/
19572 /*! \brief satComputeCDB12TL.
19573  *
19574  *  This fuctions computes transfer length of CDB12.
19575  *
19576  *  \param   satIOContext_t:   Pointer to the SAT IO Context
19577  *
19578  *  \return
19579  *    - \e TL
19580  */
19581 /*****************************************************************************/
19582 bit32 satComputeCDB12TL(satIOContext_t            *satIOContext)
19583 {
19584
19585   tiIniScsiCmnd_t           *scsiCmnd;
19586   tiScsiInitiatorRequest_t *tiScsiRequest;
19587   bit32                     tl = 0;
19588
19589   TI_DBG5(("satComputeCDB10TL: start\n"));
19590   tiScsiRequest = satIOContext->tiScsiXchg;
19591   scsiCmnd      = &(tiScsiRequest->scsiCmnd);
19592
19593   tl = (scsiCmnd->cdb[6] << (8*3)) + (scsiCmnd->cdb[7] << (8*2))
19594     + (scsiCmnd->cdb[8] << 8) + scsiCmnd->cdb[9];
19595   return tl;
19596 }
19597
19598
19599 /*****************************************************************************/
19600 /*! \brief satComputeCDB16LBA.
19601  *
19602  *  This fuctions computes LBA of CDB16.
19603  *
19604  *  \param   satIOContext_t:   Pointer to the SAT IO Context
19605  *
19606  *  \return
19607  *    - \e LBA
19608  */
19609 /*****************************************************************************/
19610 /*
19611   CBD16 has bit64 LBA
19612   But it has to be less than (2^28 - 1)
19613   Therefore, use last four bytes to compute LBA is OK
19614 */
19615 bit32 satComputeCDB16LBA(satIOContext_t            *satIOContext)
19616 {
19617   tiIniScsiCmnd_t           *scsiCmnd;
19618   tiScsiInitiatorRequest_t *tiScsiRequest;
19619   bit32                     lba = 0;
19620
19621   TI_DBG5(("satComputeCDB10LBA: start\n"));
19622   tiScsiRequest = satIOContext->tiScsiXchg;
19623   scsiCmnd      = &(tiScsiRequest->scsiCmnd);
19624
19625   lba = (scsiCmnd->cdb[6] << (8*3)) + (scsiCmnd->cdb[7] << (8*2))
19626     + (scsiCmnd->cdb[8] << 8) + scsiCmnd->cdb[9];
19627
19628   return lba;
19629 }
19630
19631 /*****************************************************************************/
19632 /*! \brief satComputeCDB16TL.
19633  *
19634  *  This fuctions computes transfer length of CDB16.
19635  *
19636  *  \param   satIOContext_t:   Pointer to the SAT IO Context
19637  *
19638  *  \return
19639  *    - \e TL
19640  */
19641 /*****************************************************************************/
19642 bit32 satComputeCDB16TL(satIOContext_t            *satIOContext)
19643 {
19644
19645   tiIniScsiCmnd_t           *scsiCmnd;
19646   tiScsiInitiatorRequest_t *tiScsiRequest;
19647   bit32                     tl = 0;
19648
19649   TI_DBG5(("satComputeCDB10TL: start\n"));
19650   tiScsiRequest = satIOContext->tiScsiXchg;
19651   scsiCmnd      = &(tiScsiRequest->scsiCmnd);
19652
19653   tl = (scsiCmnd->cdb[10] << (8*3)) + (scsiCmnd->cdb[11] << (8*2))
19654     + (scsiCmnd->cdb[12] << 8) + scsiCmnd->cdb[13];
19655   return tl;
19656 }
19657
19658 /*****************************************************************************/
19659 /*! \brief satComputeLoopNum.
19660  *
19661  *  This fuctions computes the number of interation needed for a transfer
19662  *  length with a specific number.
19663  *
19664  *  \param   a:   a numerator
19665  *  \param   b:   a denominator
19666  *
19667  *  \return
19668  *    - \e number of interation
19669  */
19670 /*****************************************************************************/
19671 /*
19672   (tl, denom)
19673   tl can be upto bit32 because CDB16 has bit32 tl
19674   Therefore, fine
19675   either (tl, 0xFF) or (tl, 0xFFFF)
19676 */
19677 bit32 satComputeLoopNum(bit32 a, bit32 b)
19678 {
19679
19680   bit32 quo = 0, rem = 0;
19681   bit32 LoopNum = 0;
19682
19683   TI_DBG5(("satComputeLoopNum: start\n"));
19684
19685   quo = a/b;
19686
19687   if (quo == 0)
19688   {
19689     LoopNum = 1;
19690   }
19691   else
19692   {
19693     rem = a % b;
19694     if (rem == 0)
19695     {
19696       LoopNum = quo;
19697     }
19698     else
19699     {
19700       LoopNum = quo + 1;
19701     }
19702   }
19703
19704   return LoopNum;
19705 }
19706
19707 /*****************************************************************************/
19708 /*! \brief satAddNComparebit64.
19709  *
19710  *
19711  *
19712  *
19713  *  \param   a:   lba
19714  *  \param   b:   tl
19715  *
19716  *  \return
19717  *    - \e TRUE if (lba + tl > SAT_TR_LBA_LIMIT)
19718  *    - \e FALSE otherwise
19719  *  \note: a and b must be in the same length
19720  */
19721 /*****************************************************************************/
19722 /*
19723   input: bit8 a[8], bit8 b[8] (lba, tl) must be in same length
19724   if (lba + tl > SAT_TR_LBA_LIMIT)
19725   then returns true
19726   else returns false
19727   (LBA,TL)
19728 */
19729 bit32 satAddNComparebit64(bit8 *a, bit8 *b)
19730 {
19731   bit16 ans[8];       // 0 MSB, 8 LSB
19732   bit8  final_ans[9]; // 0 MSB, 9 LSB
19733   bit8  max[9];
19734   int i;
19735
19736   TI_DBG5(("satAddNComparebit64: start\n"));
19737
19738   osti_memset(ans, 0, sizeof(ans));
19739   osti_memset(final_ans, 0, sizeof(final_ans));
19740   osti_memset(max, 0, sizeof(max));
19741
19742   max[0] = 0x1; //max = 0x1 0000 0000 0000 0000
19743
19744   // adding from LSB to MSB
19745   for(i=7;i>=0;i--)
19746   {
19747     ans[i] = (bit16)(a[i] + b[i]);
19748     if (i != 7)
19749     {
19750       ans[i] = (bit16)(ans[i] + ((ans[i+1] & 0xFF00) >> 8));
19751     }
19752   }
19753
19754   /*
19755     filling in the final answer
19756    */
19757   final_ans[0] = (bit8)(((ans[0] & 0xFF00) >> 8));
19758   final_ans[1] = (bit8)(ans[0] & 0xFF);
19759
19760   for(i=2;i<=8;i++)
19761   {
19762     final_ans[i] = (bit8)(ans[i-1] & 0xFF);
19763   }
19764
19765   //compare final_ans to max
19766   for(i=0;i<=8;i++)
19767   {
19768     if (final_ans[i] > max[i])
19769     {
19770       TI_DBG5(("satAddNComparebit64: yes at %d\n", i));
19771       return agTRUE;
19772     }
19773     else if (final_ans[i] < max[i])
19774     {
19775       TI_DBG5(("satAddNComparebit64: no at %d\n", i));
19776       return agFALSE;
19777     }
19778     else
19779     {
19780       continue;
19781     }
19782   }
19783
19784
19785   return agFALSE;
19786 }
19787
19788 /*****************************************************************************/
19789 /*! \brief satAddNComparebit32.
19790  *
19791  *
19792  *
19793  *
19794  *  \param   a:   lba
19795  *  \param   b:   tl
19796  *
19797  *  \return
19798  *    - \e TRUE if (lba + tl > SAT_TR_LBA_LIMIT)
19799  *    - \e FALSE otherwise
19800  *  \note: a and b must be in the same length
19801  */
19802 /*****************************************************************************/
19803 /*
19804   input: bit8 a[4], bit8 b[4] (lba, tl) must be in same length
19805   if (lba + tl > SAT_TR_LBA_LIMIT)
19806   then returns true
19807   else returns false
19808   (LBA,TL)
19809 */
19810 bit32 satAddNComparebit32(bit8 *a, bit8 *b)
19811 {
19812   bit16 ans[4];       // 0 MSB, 4 LSB
19813   bit8  final_ans[5]; // 0 MSB, 5 LSB
19814   bit8   max[4];
19815   int i;
19816
19817   TI_DBG5(("satAddNComparebit32: start\n"));
19818
19819   osti_memset(ans, 0, sizeof(ans));
19820   osti_memset(final_ans, 0, sizeof(final_ans));
19821   osti_memset(max, 0, sizeof(max));
19822
19823   max[0] = 0x10; // max =0x1000 0000
19824
19825   // adding from LSB to MSB
19826   for(i=3;i>=0;i--)
19827   {
19828     ans[i] = (bit16)(a[i] + b[i]);
19829     if (i != 3)
19830     {
19831       ans[i] = (bit16)(ans[i] + ((ans[i+1] & 0xFF00) >> 8));
19832     }
19833   }
19834
19835
19836   /*
19837     filling in the final answer
19838    */
19839   final_ans[0] = (bit8)(((ans[0] & 0xFF00) >> 8));
19840   final_ans[1] = (bit8)(ans[0] & 0xFF);
19841
19842   for(i=2;i<=4;i++)
19843   {
19844     final_ans[i] = (bit8)(ans[i-1] & 0xFF);
19845   }
19846
19847   //compare final_ans to max
19848   if (final_ans[0] != 0)
19849   {
19850     TI_DBG5(("satAddNComparebit32: yes bigger and out of range\n"));
19851     return agTRUE;
19852   }
19853   for(i=1;i<=4;i++)
19854   {
19855     if (final_ans[i] > max[i-1])
19856     {
19857       TI_DBG5(("satAddNComparebit32: yes at %d\n", i));
19858       return agTRUE;
19859     }
19860     else if (final_ans[i] < max[i-1])
19861     {
19862       TI_DBG5(("satAddNComparebit32: no at %d\n", i));
19863       return agFALSE;
19864     }
19865     else
19866     {
19867       continue;
19868     }
19869   }
19870
19871
19872   return agFALSE;;
19873 }
19874
19875 /*****************************************************************************/
19876 /*! \brief satCompareLBALimitbit.
19877  *
19878  *
19879  *
19880  *
19881  *  \param   lba:   lba
19882  *
19883  *  \return
19884  *    - \e TRUE if (lba > SAT_TR_LBA_LIMIT - 1)
19885  *    - \e FALSE otherwise
19886  *  \note: a and b must be in the same length
19887  */
19888 /*****************************************************************************/
19889
19890 /*
19891   lba
19892 */
19893 /*
19894   input: bit8 lba[8]
19895   if (lba > SAT_TR_LBA_LIMIT - 1)
19896   then returns true
19897   else returns false
19898   (LBA,TL)
19899 */
19900 bit32 satCompareLBALimitbit(bit8 *lba)
19901 {
19902   bit32 i;
19903   bit8 limit[8];
19904
19905   /* limit is 0xF FF FF = 2^28 - 1 */
19906   limit[0] = 0x0;   /* MSB */
19907   limit[1] = 0x0;
19908   limit[2] = 0x0;
19909   limit[3] = 0x0;
19910   limit[4] = 0xF;
19911   limit[5] = 0xFF;
19912   limit[6] = 0xFF;
19913   limit[7] = 0xFF; /* LSB */
19914
19915   //compare lba to limit
19916   for(i=0;i<8;i++)
19917   {
19918     if (lba[i] > limit[i])
19919     {
19920       TI_DBG5(("satCompareLBALimitbit64: yes at %d\n", i));
19921       return agTRUE;
19922     }
19923     else if (lba[i] < limit[i])
19924     {
19925       TI_DBG5(("satCompareLBALimitbit64: no at %d\n", i));
19926       return agFALSE;
19927     }
19928     else
19929     {
19930       continue;
19931     }
19932   }
19933
19934
19935   return agFALSE;
19936
19937 }
19938 /*****************************************************************************
19939 *! \brief
19940 *  Purpose: bitwise set
19941 *
19942 *  Parameters:
19943 *   data        - input output buffer
19944 *   index       - bit to set
19945 *
19946 *  Return:
19947 *   none
19948 *
19949 *****************************************************************************/
19950 GLOBAL void
19951 satBitSet(bit8 *data, bit32 index)
19952 {
19953   data[index/8] |= (1 << (index%8));
19954 }
19955
19956 /*****************************************************************************
19957 *! \brief
19958 *  Purpose: bitwise clear
19959 *
19960 *  Parameters:
19961 *   data        - input output buffer
19962 *   index       - bit to clear
19963 *
19964 *  Return:
19965 *   none
19966 *
19967 *****************************************************************************/
19968 GLOBAL void
19969 satBitClear(bit8 *data, bit32 index)
19970 {
19971   data[index/8] &= ~(1 << (index%8));
19972 }
19973
19974 /*****************************************************************************
19975 *! \brief
19976 *  Purpose: bitwise test
19977 *
19978 *  Parameters:
19979 *   data        - input output buffer
19980 *   index       - bit to test
19981 *
19982 *  Return:
19983 *   0 - not set
19984 *   1 - set
19985 *
19986 *****************************************************************************/
19987 GLOBAL agBOOLEAN
19988 satBitTest(bit8 *data, bit32 index)
19989 {
19990   return ( (BOOLEAN)((data[index/8] & (1 << (index%8)) ) ? 1: 0));
19991 }
19992
19993
19994 /******************************************************************************/
19995 /*! \brief allocate an available SATA tag
19996  *
19997  *  allocate an available SATA tag
19998  *
19999  *  \param tiRoot           Pointer to TISA initiator driver/port instance.
20000  *  \param pSatDevData
20001  *  \param pTag
20002  *
20003  *  \return -Success or fail-
20004  */
20005 /*******************************************************************************/
20006 GLOBAL bit32 satTagAlloc(
20007                            tiRoot_t          *tiRoot,
20008                            satDeviceData_t   *pSatDevData,
20009                            bit8              *pTag
20010                            )
20011 {
20012   bit32             retCode = agFALSE;
20013   bit32             i;
20014
20015   tdsaSingleThreadedEnter(tiRoot, TD_SATA_LOCK);
20016   for ( i = 0; i < pSatDevData->satNCQMaxIO; i ++ )
20017   {
20018     if ( 0 == satBitTest((bit8 *)&pSatDevData->freeSATAFDMATagBitmap, i) )
20019     {
20020       satBitSet((bit8*)&pSatDevData->freeSATAFDMATagBitmap, i);
20021       *pTag = (bit8) i;
20022       retCode = agTRUE;
20023       break;
20024     }
20025   }
20026   tdsaSingleThreadedLeave(tiRoot, TD_SATA_LOCK);
20027   return retCode;
20028 }
20029
20030 /******************************************************************************/
20031 /*! \brief release an SATA tag
20032  *
20033  *  release an available SATA tag
20034  *
20035  *  \param tiRoot           Pointer to TISA initiator driver/port instance.
20036  *  \param pSatDevData
20037  *  \param Tag
20038  *
20039  *  \return -the tag-
20040  */
20041 /*******************************************************************************/
20042 GLOBAL bit32 satTagRelease(
20043                               tiRoot_t          *tiRoot,
20044                               satDeviceData_t   *pSatDevData,
20045                               bit8              tag
20046                               )
20047 {
20048   bit32             retCode = agFALSE;
20049
20050   tdsaSingleThreadedEnter(tiRoot, TD_SATA_LOCK);
20051   if ( tag < pSatDevData->satNCQMaxIO )
20052   {
20053     satBitClear( (bit8 *)&pSatDevData->freeSATAFDMATagBitmap, (bit32)tag);
20054     retCode = agTRUE;
20055   }
20056   tdsaSingleThreadedLeave(tiRoot, TD_SATA_LOCK);
20057   return retCode;
20058 }
20059
20060 /*****************************************************************************
20061  *! \brief  satSubTM
20062  *
20063  *   This routine is called to initiate a TM request to SATL.
20064  *   This routine is independent of HW/LL API.
20065  *
20066  *  \param  tiRoot:           Pointer to TISA initiator driver/port instance.
20067  *  \param  tiDeviceHandle:   Pointer to TISA device handle for this I/O.
20068  *  \param  task:             SAM-3 task management request.
20069  *  \param  lun:              Pointer to LUN.
20070  *  \param  taskTag:          Pointer to the associated task where the TM
20071  *                            command is to be applied.
20072  *  \param  currentTaskTag:   Pointer to tag/context for this TM request.
20073  *  \param  NotifyOS          flag determines whether notify OS layer or not
20074  *
20075  *  \return:
20076  *
20077  *  \e tiSuccess:     I/O request successfully initiated.
20078  *  \e tiBusy:        No resources available, try again later.
20079  *  \e tiIONoDevice:  Invalid device handle.
20080  *  \e tiError:       Other errors that prevent the I/O request to be started.
20081  *
20082  *  \note:
20083  *        This funcion is triggered bottom up. Not yet in use.
20084  *****************************************************************************/
20085 /* called for bottom up */
20086 osGLOBAL bit32 satSubTM(
20087                         tiRoot_t          *tiRoot,
20088                         tiDeviceHandle_t  *tiDeviceHandle,
20089                         bit32             task,
20090                         tiLUN_t           *lun,
20091                         tiIORequest_t     *taskTag,
20092                         tiIORequest_t     *currentTaskTag,
20093                         bit32              NotifyOS
20094                         )
20095 {
20096   void                        *osMemHandle;
20097   tdIORequestBody_t           *TMtdIORequestBody;
20098   bit32                       PhysUpper32;
20099   bit32                       PhysLower32;
20100   bit32                       memAllocStatus;
20101   agsaIORequest_t             *agIORequest = agNULL;
20102
20103   TI_DBG6(("satSubTM: start\n"));
20104
20105   /* allocation tdIORequestBody and pass it to satTM() */
20106   memAllocStatus = ostiAllocMemory(
20107                                    tiRoot,
20108                                    &osMemHandle,
20109                                    (void **)&TMtdIORequestBody,
20110                                    &PhysUpper32,
20111                                    &PhysLower32,
20112                                    8,
20113                                    sizeof(tdIORequestBody_t),
20114                                    agTRUE
20115                                    );
20116
20117   if (memAllocStatus != tiSuccess)
20118   {
20119     TI_DBG1(("satSubTM: ostiAllocMemory failed... \n"));
20120     return tiError;
20121   }
20122
20123   if (TMtdIORequestBody == agNULL)
20124   {
20125     TI_DBG1(("satSubTM: ostiAllocMemory returned NULL TMIORequestBody\n"));
20126     return tiError;
20127    }
20128
20129   /* setup task management structure */
20130   TMtdIORequestBody->IOType.InitiatorTMIO.osMemHandle = osMemHandle;
20131   TMtdIORequestBody->IOType.InitiatorTMIO.CurrentTaskTag = agNULL;
20132   TMtdIORequestBody->IOType.InitiatorTMIO.TaskTag = agNULL;
20133
20134   /* initialize tiDevhandle */
20135   TMtdIORequestBody->tiDevHandle = tiDeviceHandle;
20136
20137   /* initialize tiIORequest */
20138   TMtdIORequestBody->tiIORequest = agNULL;
20139
20140   /* initialize agIORequest */
20141   agIORequest = &(TMtdIORequestBody->agIORequest);
20142   agIORequest->osData = (void *) TMtdIORequestBody;
20143   agIORequest->sdkData = agNULL; /* SA takes care of this */
20144   satTM(tiRoot,
20145         tiDeviceHandle,
20146         task, /* TD_INTERNAL_TM_RESET */
20147         agNULL,
20148         agNULL,
20149         agNULL,
20150         TMtdIORequestBody,
20151         agFALSE);
20152
20153   return tiSuccess;
20154 }
20155
20156
20157 /*****************************************************************************/
20158 /*! \brief SAT implementation for satStartResetDevice.
20159  *
20160  *  SAT implementation for sending SRT and send FIS request to LL layer.
20161  *
20162  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
20163  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
20164  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
20165  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
20166  *  \param   satIOContext_t:   Pointer to the SAT IO Context
20167  *
20168  *  \return If command is started successfully
20169  *    - \e tiSuccess:     I/O request successfully initiated.
20170  *    - \e tiBusy:        No resources available, try again later.
20171  *    - \e tiIONoDevice:  Invalid device handle.
20172  *    - \e tiError:       Other errors.
20173  *  \note : triggerred by OS layer or bottom up
20174  */
20175 /*****************************************************************************/
20176 /* OS triggerred or bottom up */
20177 GLOBAL bit32
20178 satStartResetDevice(
20179                             tiRoot_t                  *tiRoot,
20180                             tiIORequest_t             *tiIORequest, /* currentTaskTag */
20181                             tiDeviceHandle_t          *tiDeviceHandle,
20182                             tiScsiInitiatorRequest_t *tiScsiRequest, /* should be NULL */
20183                             satIOContext_t            *satIOContext
20184                             )
20185 {
20186   satInternalIo_t           *satIntIo = agNULL;
20187   satDeviceData_t           *satDevData = agNULL;
20188   satIOContext_t            *satNewIOContext;
20189   bit32                     status;
20190   tiIORequest_t             *currentTaskTag = agNULL;
20191
20192   TI_DBG1(("satStartResetDevice: start\n"));
20193
20194   currentTaskTag = tiIORequest;
20195
20196   satDevData = satIOContext->pSatDevData;
20197
20198   TI_DBG6(("satStartResetDevice: before alloc\n"));
20199
20200   /* allocate any fis for seting SRT bit in device control */
20201   satIntIo = satAllocIntIoResource( tiRoot,
20202                                     tiIORequest,
20203                                     satDevData,
20204                                     0,
20205                                     satIntIo);
20206
20207   TI_DBG6(("satStartResetDevice: before after\n"));
20208
20209   if (satIntIo == agNULL)
20210   {
20211     TI_DBG1(("satStartResetDevice: can't alloacate\n"));
20212     if (satIOContext->NotifyOS)
20213     {
20214       ostiInitiatorEvent( tiRoot,
20215                           NULL,
20216                           NULL,
20217                           tiIntrEventTypeTaskManagement,
20218                           tiTMFailed,
20219                           currentTaskTag );
20220     }
20221     return tiError;
20222   }
20223
20224   satNewIOContext = satPrepareNewIO(satIntIo,
20225                                     tiIORequest,
20226                                     satDevData,
20227                                     agNULL,
20228                                     satIOContext);
20229
20230   TI_DBG6(("satStartResetDevice: OS satIOContext %p \n", satIOContext));
20231   TI_DBG6(("satStartResetDevice: TD satNewIOContext %p \n", satNewIOContext));
20232   TI_DBG6(("satStartResetDevice: OS tiScsiXchg %p \n", satIOContext->tiScsiXchg));
20233   TI_DBG6(("satStartResetDevice: TD tiScsiXchg %p \n", satNewIOContext->tiScsiXchg));
20234
20235
20236
20237   TI_DBG6(("satStartResetDevice: satNewIOContext %p \n", satNewIOContext));
20238
20239   if (satDevData->satDeviceType == SATA_ATAPI_DEVICE)
20240   {
20241     status = satDeviceReset(tiRoot,
20242                           &satIntIo->satIntTiIORequest, /* New tiIORequest */
20243                           tiDeviceHandle,
20244                           satNewIOContext->tiScsiXchg, /* New tiScsiInitiatorRequest_t *tiScsiRequest, */
20245                           satNewIOContext);
20246   }
20247   else
20248   {
20249     status = satResetDevice(tiRoot,
20250                           &satIntIo->satIntTiIORequest, /* New tiIORequest */
20251                           tiDeviceHandle,
20252                           satNewIOContext->tiScsiXchg, /* New tiScsiInitiatorRequest_t *tiScsiRequest, */
20253                           satNewIOContext);
20254   }
20255
20256   if (status != tiSuccess)
20257   {
20258     TI_DBG1(("satStartResetDevice: failed in sending\n"));
20259
20260     satFreeIntIoResource( tiRoot,
20261                           satDevData,
20262                           satIntIo);
20263     if (satIOContext->NotifyOS)
20264     {
20265       ostiInitiatorEvent( tiRoot,
20266                           NULL,
20267                           NULL,
20268                           tiIntrEventTypeTaskManagement,
20269                           tiTMFailed,
20270                           currentTaskTag );
20271     }
20272
20273     return tiError;
20274   }
20275
20276
20277   TI_DBG6(("satStartResetDevice: end\n"));
20278
20279   return status;
20280 }
20281
20282 /*****************************************************************************/
20283 /*! \brief SAT implementation for satResetDevice.
20284  *
20285  *  SAT implementation for building SRT FIS and sends the request to LL layer.
20286  *
20287  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
20288  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
20289  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
20290  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
20291  *  \param   satIOContext_t:   Pointer to the SAT IO Context
20292  *
20293  *  \return If command is started successfully
20294  *    - \e tiSuccess:     I/O request successfully initiated.
20295  *    - \e tiBusy:        No resources available, try again later.
20296  *    - \e tiIONoDevice:  Invalid device handle.
20297  *    - \e tiError:       Other errors.
20298  */
20299 /*****************************************************************************/
20300
20301 /*
20302   create any fis and set SRST bit in device control
20303 */
20304 GLOBAL bit32
20305 satResetDevice(
20306                             tiRoot_t                  *tiRoot,
20307                             tiIORequest_t             *tiIORequest,
20308                             tiDeviceHandle_t          *tiDeviceHandle,
20309                             tiScsiInitiatorRequest_t *tiScsiRequest,
20310                             satIOContext_t            *satIOContext
20311                             )
20312 {
20313   bit32                     status;
20314   bit32                     agRequestType;
20315   agsaFisRegHostToDevice_t  *fis;
20316 #ifdef  TD_DEBUG_ENABLE
20317   tdIORequestBody_t         *tdIORequestBody;
20318   satInternalIo_t           *satIntIoContext;
20319 #endif
20320
20321   fis           = satIOContext->pFis;
20322
20323   TI_DBG2(("satResetDevice: start\n"));
20324
20325 #ifdef  TD_DEBUG_ENABLE
20326   satIntIoContext = satIOContext->satIntIoContext;
20327   tdIORequestBody = satIntIoContext->satIntRequestBody;
20328 #endif
20329   TI_DBG5(("satResetDevice: satIOContext %p tdIORequestBody %p\n", satIOContext, tdIORequestBody));
20330   /* any fis should work */
20331   fis->h.fisType        = 0x27;                   /* Reg host to device */
20332   fis->h.c_pmPort       = 0;                      /* C Bit is not set */
20333   fis->h.command        = 0;                      /* any command */
20334   fis->h.features       = 0;                      /* FIS reserve */
20335   fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
20336   fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
20337   fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
20338   fis->d.device         = 0;                      /* FIS LBA mode  */
20339   fis->d.lbaLowExp      = 0;
20340   fis->d.lbaMidExp      = 0;
20341   fis->d.lbaHighExp     = 0;
20342   fis->d.featuresExp    = 0;
20343   fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
20344   fis->d.sectorCountExp = 0;
20345   fis->d.reserved4      = 0;
20346   fis->d.control        = 0x4;                    /* SRST bit is set  */
20347   fis->d.reserved5      = 0;
20348
20349   agRequestType = AGSA_SATA_PROTOCOL_SRST_ASSERT;
20350
20351   satIOContext->satCompleteCB = &satResetDeviceCB;
20352
20353   /*
20354    * Prepare SGL and send FIS to LL layer.
20355    */
20356   satIOContext->reqType = agRequestType;       /* Save it */
20357
20358 #ifdef TD_INTERNAL_DEBUG
20359   tdhexdump("satResetDevice", (bit8 *)satIOContext->pFis, sizeof(agsaFisRegHostToDevice_t));
20360 #ifdef  TD_DEBUG_ENABLE
20361   tdhexdump("satResetDevice LL", (bit8 *)&(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev), sizeof(agsaFisRegHostToDevice_t));
20362 #endif
20363 #endif
20364
20365   status = sataLLIOStart( tiRoot,
20366                           tiIORequest,
20367                           tiDeviceHandle,
20368                           tiScsiRequest,
20369                           satIOContext);
20370
20371   TI_DBG6(("satResetDevice: end status %d\n", status));
20372   return status;
20373 }
20374
20375 /*****************************************************************************
20376 *! \brief  satResetDeviceCB
20377 *
20378 *   This routine is a callback function called from ossaSATACompleted().
20379 *   This CB routine deals with SRT completion. This function send DSRT
20380 *
20381 *  \param   agRoot:      Handles for this instance of SAS/SATA hardware
20382 *  \param   agIORequest: Pointer to the LL I/O request context for this I/O.
20383 *  \param   agIOStatus:  Status of completed I/O.
20384 *  \param   agFirstDword:Pointer to the four bytes of FIS.
20385 *  \param   agIOInfoLen: Length in bytes of overrun/underrun residual or FIS
20386 *                        length.
20387 *  \param   agParam:     Additional info based on status.
20388 *  \param   ioContext:   Pointer to satIOContext_t.
20389 *
20390 *  \return: none
20391 *
20392 *****************************************************************************/
20393 GLOBAL void satResetDeviceCB(
20394                    agsaRoot_t        *agRoot,
20395                    agsaIORequest_t   *agIORequest,
20396                    bit32             agIOStatus,
20397                    agsaFisHeader_t   *agFirstDword,
20398                    bit32             agIOInfoLen,
20399                    agsaFrameHandle_t agFrameHandle,
20400                    void              *ioContext
20401                    )
20402 {
20403   /* callback for satResetDevice */
20404   tdsaRootOsData_t   *osData = (tdsaRootOsData_t *)agRoot->osData;
20405   tiRoot_t           *tiRoot = (tiRoot_t *)osData->tiRoot;
20406   tdsaRoot_t         *tdsaRoot        = (tdsaRoot_t *) tiRoot->tdData;
20407   tdsaContext_t      *tdsaAllShared = (tdsaContext_t *)&tdsaRoot->tdsaAllShared;
20408   tdIORequestBody_t  *tdIORequestBody;
20409   tdIORequestBody_t  *tdOrgIORequestBody;
20410   satIOContext_t     *satIOContext;
20411   satIOContext_t     *satOrgIOContext;
20412   satIOContext_t     *satNewIOContext;
20413   satInternalIo_t    *satIntIo;
20414   satInternalIo_t    *satNewIntIo = agNULL;
20415   satDeviceData_t    *satDevData;
20416   tiIORequest_t      *tiOrgIORequest;
20417 #ifdef  TD_DEBUG_ENABLE
20418   bit32                     ataStatus = 0;
20419   bit32                     ataError;
20420   agsaFisPioSetupHeader_t  *satPIOSetupHeader = agNULL;
20421 #endif
20422   bit32                     status;
20423
20424   TI_DBG1(("satResetDeviceCB: start\n"));
20425   TI_DBG6(("satResetDeviceCB: agIORequest=%p agIOStatus=0x%x agIOInfoLen %d\n", agIORequest, agIOStatus, agIOInfoLen));
20426
20427   tdIORequestBody        = (tdIORequestBody_t *)agIORequest->osData;
20428   satIOContext           = (satIOContext_t *) ioContext;
20429   satIntIo               = satIOContext->satIntIoContext;
20430   satDevData             = satIOContext->pSatDevData;
20431   if (satIntIo == agNULL)
20432   {
20433     TI_DBG6(("satResetDeviceCB: External, OS generated\n"));
20434     satOrgIOContext      = satIOContext;
20435     tiOrgIORequest       = tdIORequestBody->tiIORequest;
20436   }
20437   else
20438   {
20439     TI_DBG6(("satResetDeviceCB: Internal, TD generated\n"));
20440     satOrgIOContext        = satIOContext->satOrgIOContext;
20441     if (satOrgIOContext == agNULL)
20442     {
20443       TI_DBG6(("satResetDeviceCB: satOrgIOContext is NULL, wrong\n"));
20444       return;
20445     }
20446     else
20447     {
20448       TI_DBG6(("satResetDeviceCB: satOrgIOContext is NOT NULL\n"));
20449     }
20450     tdOrgIORequestBody    = (tdIORequestBody_t *)satOrgIOContext->tiRequestBody;
20451     tiOrgIORequest        = (tiIORequest_t *)tdOrgIORequestBody->tiIORequest;
20452   }
20453
20454   tdIORequestBody->ioCompleted = agTRUE;
20455   tdIORequestBody->ioStarted = agFALSE;
20456
20457   if (agFirstDword == agNULL && agIOStatus != OSSA_IO_SUCCESS)
20458   {
20459     TI_DBG1(("satResetDeviceCB: wrong. agFirstDword is NULL when error, status %d\n", agIOStatus));
20460     if (satOrgIOContext->NotifyOS == agTRUE)
20461     {
20462       ostiInitiatorEvent( tiRoot,
20463                           NULL,
20464                           NULL,
20465                           tiIntrEventTypeTaskManagement,
20466                           tiTMFailed,
20467                           tiOrgIORequest );
20468     }
20469
20470     satDevData->satTmTaskTag = agNULL;
20471
20472     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
20473
20474     satFreeIntIoResource( tiRoot,
20475                           satDevData,
20476                           satIntIo);
20477     return;
20478   }
20479
20480   if (agIOStatus == OSSA_IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED ||
20481       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_ZONE_VIOLATION ||
20482       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_BREAK ||
20483       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS ||
20484       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_BAD_DESTINATION ||
20485       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED ||
20486       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_WRONG_DESTINATION ||
20487       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_UNKNOWN_ERROR ||
20488       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_STP_RESOURCES_BUSY
20489       )
20490   {
20491     TI_DBG1(("satResetDeviceCB: OSSA_IO_OPEN_CNX_ERROR\n"));
20492
20493     if (satOrgIOContext->NotifyOS == agTRUE)
20494     {
20495       ostiInitiatorEvent( tiRoot,
20496                           NULL,
20497                           NULL,
20498                           tiIntrEventTypeTaskManagement,
20499                           tiTMFailed,
20500                           tiOrgIORequest );
20501     }
20502
20503     satDevData->satTmTaskTag = agNULL;
20504
20505     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
20506
20507     satFreeIntIoResource( tiRoot,
20508                          satDevData,
20509                          satIntIo);
20510     return;
20511   }
20512
20513  if (agIOStatus != OSSA_IO_SUCCESS)
20514   {
20515 #ifdef  TD_DEBUG_ENABLE
20516     /* only agsaFisPioSetup_t is expected */
20517     satPIOSetupHeader = (agsaFisPioSetupHeader_t *)&(agFirstDword->PioSetup);
20518     ataStatus     = satPIOSetupHeader->status;   /* ATA Status register */
20519     ataError      = satPIOSetupHeader->error;    /* ATA Eror register   */
20520 #endif
20521     TI_DBG1(("satResetDeviceCB: ataStatus 0x%x ataError 0x%x\n", ataStatus, ataError));
20522
20523      if (satOrgIOContext->NotifyOS == agTRUE)
20524      {
20525       ostiInitiatorEvent( tiRoot,
20526                           NULL,
20527                           NULL,
20528                           tiIntrEventTypeTaskManagement,
20529                           tiTMFailed,
20530                           tiOrgIORequest );
20531      }
20532
20533     satDevData->satTmTaskTag = agNULL;
20534
20535     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
20536
20537     satFreeIntIoResource( tiRoot,
20538                           satDevData,
20539                           satIntIo);
20540     return;
20541   }
20542
20543   /* success */
20544
20545   satNewIntIo = satAllocIntIoResource( tiRoot,
20546                                        tiOrgIORequest,
20547                                        satDevData,
20548                                        0,
20549                                        satNewIntIo);
20550   if (satNewIntIo == agNULL)
20551   {
20552     satDevData->satTmTaskTag = agNULL;
20553
20554     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
20555
20556     /* memory allocation failure */
20557     satFreeIntIoResource( tiRoot,
20558                           satDevData,
20559                           satNewIntIo);
20560
20561     if (satOrgIOContext->NotifyOS == agTRUE)
20562     {
20563       ostiInitiatorEvent( tiRoot,
20564                           NULL,
20565                           NULL,
20566                           tiIntrEventTypeTaskManagement,
20567                           tiTMFailed,
20568                           tiOrgIORequest );
20569     }
20570
20571
20572       TI_DBG1(("satResetDeviceCB: momory allocation fails\n"));
20573       return;
20574     } /* end of memory allocation failure */
20575
20576     /*
20577      * Need to initialize all the fields within satIOContext
20578      */
20579
20580     satNewIOContext = satPrepareNewIO(
20581                                       satNewIntIo,
20582                                       tiOrgIORequest,
20583                                       satDevData,
20584                                       agNULL,
20585                                       satOrgIOContext
20586                                       );
20587
20588
20589
20590
20591     /* send AGSA_SATA_PROTOCOL_SRST_DEASSERT */
20592     status = satDeResetDevice(tiRoot,
20593                               tiOrgIORequest,
20594                               satOrgIOContext->ptiDeviceHandle,
20595                               agNULL,
20596                               satNewIOContext
20597                               );
20598
20599     if (status != tiSuccess)
20600     {
20601       if (satOrgIOContext->NotifyOS == agTRUE)
20602       {
20603         ostiInitiatorEvent( tiRoot,
20604                             NULL,
20605                             NULL,
20606                             tiIntrEventTypeTaskManagement,
20607                             tiTMFailed,
20608                             tiOrgIORequest );
20609       }
20610
20611       /* sending AGSA_SATA_PROTOCOL_SRST_DEASSERT fails */
20612
20613       satDevData->satTmTaskTag = agNULL;
20614
20615       satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
20616
20617       satFreeIntIoResource( tiRoot,
20618                           satDevData,
20619                           satNewIntIo);
20620       return;
20621
20622     }
20623
20624   satDevData->satTmTaskTag = agNULL;
20625
20626   satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
20627
20628   satFreeIntIoResource( tiRoot,
20629                         satDevData,
20630                         satIntIo);
20631   TI_DBG5(("satResetDeviceCB: device %p pending IO %d\n", satDevData, satDevData->satPendingIO));
20632   TI_DBG6(("satResetDeviceCB: end\n"));
20633   return;
20634
20635 }
20636
20637
20638 /*****************************************************************************/
20639 /*! \brief SAT implementation for satDeResetDevice.
20640  *
20641  *  SAT implementation for building DSRT FIS and sends the request to LL layer.
20642  *
20643  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
20644  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
20645  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
20646  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
20647  *  \param   satIOContext_t:   Pointer to the SAT IO Context
20648  *
20649  *  \return If command is started successfully
20650  *    - \e tiSuccess:     I/O request successfully initiated.
20651  *    - \e tiBusy:        No resources available, try again later.
20652  *    - \e tiIONoDevice:  Invalid device handle.
20653  *    - \e tiError:       Other errors.
20654  */
20655 /*****************************************************************************/
20656 GLOBAL bit32  satDeResetDevice(
20657                             tiRoot_t                  *tiRoot,
20658                             tiIORequest_t             *tiIORequest,
20659                             tiDeviceHandle_t          *tiDeviceHandle,
20660                             tiScsiInitiatorRequest_t *tiScsiRequest,
20661                             satIOContext_t            *satIOContext
20662                             )
20663 {
20664   bit32                     status;
20665   bit32                     agRequestType;
20666   agsaFisRegHostToDevice_t  *fis;
20667 #ifdef  TD_DEBUG_ENABLE
20668   tdIORequestBody_t         *tdIORequestBody;
20669   satInternalIo_t           *satIntIoContext;
20670 #endif
20671   fis           = satIOContext->pFis;
20672
20673   TI_DBG6(("satDeResetDevice: start\n"));
20674
20675 #ifdef  TD_DEBUG_ENABLE
20676   satIntIoContext = satIOContext->satIntIoContext;
20677   tdIORequestBody = satIntIoContext->satIntRequestBody;
20678   TI_DBG5(("satDeResetDevice: satIOContext %p tdIORequestBody %p\n", satIOContext, tdIORequestBody));
20679 #endif
20680   /* any fis should work */
20681   fis->h.fisType        = 0x27;                   /* Reg host to device */
20682   fis->h.c_pmPort       = 0;                      /* C Bit is not set */
20683   fis->h.command        = 0;                      /* any command */
20684   fis->h.features       = 0;                      /* FIS reserve */
20685   fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
20686   fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
20687   fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
20688   fis->d.device         = 0;                      /* FIS LBA mode  */
20689   fis->d.lbaLowExp      = 0;
20690   fis->d.lbaMidExp      = 0;
20691   fis->d.lbaHighExp     = 0;
20692   fis->d.featuresExp    = 0;
20693   fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
20694   fis->d.sectorCountExp = 0;
20695   fis->d.reserved4      = 0;
20696   fis->d.control        = 0;                    /* SRST bit is not set  */
20697   fis->d.reserved5      = 0;
20698
20699   agRequestType = AGSA_SATA_PROTOCOL_SRST_DEASSERT;
20700
20701   satIOContext->satCompleteCB = &satDeResetDeviceCB;
20702
20703   /*
20704    * Prepare SGL and send FIS to LL layer.
20705    */
20706   satIOContext->reqType = agRequestType;       /* Save it */
20707
20708 #ifdef TD_INTERNAL_DEBUG
20709   tdhexdump("satDeResetDevice", (bit8 *)satIOContext->pFis, sizeof(agsaFisRegHostToDevice_t));
20710 #ifdef  TD_DEBUG_ENABLE
20711   tdhexdump("satDeResetDevice LL", (bit8 *)&(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev), sizeof(agsaFisRegHostToDevice_t));
20712 #endif
20713 #endif
20714
20715   status = sataLLIOStart( tiRoot,
20716                           tiIORequest,
20717                           tiDeviceHandle,
20718                           tiScsiRequest,
20719                           satIOContext);
20720
20721   TI_DBG6(("satDeResetDevice: end status %d\n", status));
20722   return status;
20723
20724 }
20725
20726 /*****************************************************************************
20727 *! \brief  satDeResetDeviceCB
20728 *
20729 *   This routine is a callback function called from ossaSATACompleted().
20730 *   This CB routine deals with DSRT completion.
20731 *
20732 *  \param   agRoot:      Handles for this instance of SAS/SATA hardware
20733 *  \param   agIORequest: Pointer to the LL I/O request context for this I/O.
20734 *  \param   agIOStatus:  Status of completed I/O.
20735 *  \param   agFirstDword:Pointer to the four bytes of FIS.
20736 *  \param   agIOInfoLen: Length in bytes of overrun/underrun residual or FIS
20737 *                        length.
20738 *  \param   agParam:     Additional info based on status.
20739 *  \param   ioContext:   Pointer to satIOContext_t.
20740 *
20741 *  \return: none
20742 *
20743 *****************************************************************************/
20744 GLOBAL void satDeResetDeviceCB(
20745                    agsaRoot_t        *agRoot,
20746                    agsaIORequest_t   *agIORequest,
20747                    bit32             agIOStatus,
20748                    agsaFisHeader_t   *agFirstDword,
20749                    bit32             agIOInfoLen,
20750                    agsaFrameHandle_t agFrameHandle,
20751                    void              *ioContext
20752                    )
20753 {
20754   /* callback for satDeResetDevice */
20755   tdsaRootOsData_t        *osData = (tdsaRootOsData_t *)agRoot->osData;
20756   tiRoot_t                *tiRoot = (tiRoot_t *)osData->tiRoot;
20757   tdsaRoot_t              *tdsaRoot        = (tdsaRoot_t *) tiRoot->tdData;
20758   tdsaContext_t           *tdsaAllShared = (tdsaContext_t *)&tdsaRoot->tdsaAllShared;
20759   tdIORequestBody_t       *tdIORequestBody;
20760   tdIORequestBody_t       *tdOrgIORequestBody = agNULL;
20761   satIOContext_t          *satIOContext;
20762   satIOContext_t          *satOrgIOContext;
20763   satInternalIo_t         *satIntIo;
20764   satDeviceData_t         *satDevData;
20765   tiIORequest_t           *tiOrgIORequest;
20766 #ifdef  TD_DEBUG_ENABLE
20767   bit32                    ataStatus = 0;
20768   bit32                    ataError;
20769   agsaFisPioSetupHeader_t *satPIOSetupHeader = agNULL;
20770 #endif
20771   bit32                     report = agFALSE;
20772   bit32                     AbortTM = agFALSE;
20773
20774   TI_DBG1(("satDeResetDeviceCB: start\n"));
20775   TI_DBG6(("satDeResetDeviceCB: agIORequest=%p agIOStatus=0x%x agIOInfoLen %d\n", agIORequest, agIOStatus, agIOInfoLen));
20776   tdIORequestBody        = (tdIORequestBody_t *)agIORequest->osData;
20777   satIOContext           = (satIOContext_t *) ioContext;
20778   satIntIo               = satIOContext->satIntIoContext;
20779   satDevData             = satIOContext->pSatDevData;
20780   if (satIntIo == agNULL)
20781   {
20782     TI_DBG6(("satDeResetDeviceCB: External, OS generated\n"));
20783     satOrgIOContext      = satIOContext;
20784     tiOrgIORequest       = tdIORequestBody->tiIORequest;
20785   }
20786   else
20787   {
20788     TI_DBG6(("satDeResetDeviceCB: Internal, TD generated\n"));
20789     satOrgIOContext        = satIOContext->satOrgIOContext;
20790     if (satOrgIOContext == agNULL)
20791     {
20792       TI_DBG6(("satDeResetDeviceCB: satOrgIOContext is NULL, wrong\n"));
20793       return;
20794     }
20795     else
20796     {
20797       TI_DBG6(("satDeResetDeviceCB: satOrgIOContext is NOT NULL\n"));
20798     }
20799     tdOrgIORequestBody     = (tdIORequestBody_t *)satOrgIOContext->tiRequestBody;
20800     tiOrgIORequest         = (tiIORequest_t *)tdOrgIORequestBody->tiIORequest;
20801   }
20802
20803   tdIORequestBody->ioCompleted = agTRUE;
20804   tdIORequestBody->ioStarted = agFALSE;
20805
20806   if (agFirstDword == agNULL && agIOStatus != OSSA_IO_SUCCESS)
20807   {
20808     TI_DBG1(("satDeResetDeviceCB: wrong. agFirstDword is NULL when error, status %d\n", agIOStatus));
20809     if (satOrgIOContext->NotifyOS == agTRUE)
20810     {
20811       ostiInitiatorEvent( tiRoot,
20812                           NULL,
20813                           NULL,
20814                           tiIntrEventTypeTaskManagement,
20815                           tiTMFailed,
20816                           tiOrgIORequest );
20817     }
20818
20819     satDevData->satTmTaskTag = agNULL;
20820     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
20821
20822     satFreeIntIoResource( tiRoot,
20823                           satDevData,
20824                           satIntIo);
20825     return;
20826   }
20827
20828   if (agIOStatus == OSSA_IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED ||
20829       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_ZONE_VIOLATION ||
20830       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_BREAK ||
20831       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS ||
20832       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_BAD_DESTINATION ||
20833       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED ||
20834       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_WRONG_DESTINATION ||
20835       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_UNKNOWN_ERROR ||
20836       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_STP_RESOURCES_BUSY
20837       )
20838   {
20839     TI_DBG1(("satDeResetDeviceCB: OSSA_IO_OPEN_CNX_ERROR\n"));
20840
20841     if (satOrgIOContext->NotifyOS == agTRUE)
20842     {
20843       ostiInitiatorEvent( tiRoot,
20844                           NULL,
20845                           NULL,
20846                           tiIntrEventTypeTaskManagement,
20847                           tiTMFailed,
20848                           tiOrgIORequest );
20849     }
20850
20851     satDevData->satTmTaskTag = agNULL;
20852
20853     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
20854
20855     satFreeIntIoResource( tiRoot,
20856                          satDevData,
20857                          satIntIo);
20858     return;
20859   }
20860
20861  if (agIOStatus != OSSA_IO_SUCCESS)
20862   {
20863 #ifdef  TD_DEBUG_ENABLE
20864     /* only agsaFisPioSetup_t is expected */
20865     satPIOSetupHeader = (agsaFisPioSetupHeader_t *)&(agFirstDword->PioSetup);
20866     ataStatus     = satPIOSetupHeader->status;   /* ATA Status register */
20867     ataError      = satPIOSetupHeader->error;    /* ATA Eror register   */
20868 #endif
20869     TI_DBG1(("satDeResetDeviceCB: ataStatus 0x%x ataError 0x%x\n", ataStatus, ataError));
20870
20871      if (satOrgIOContext->NotifyOS == agTRUE)
20872      {
20873       ostiInitiatorEvent( tiRoot,
20874                           NULL,
20875                           NULL,
20876                           tiIntrEventTypeTaskManagement,
20877                           tiTMFailed,
20878                           tiOrgIORequest );
20879      }
20880
20881     satDevData->satTmTaskTag = agNULL;
20882
20883     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
20884
20885     satFreeIntIoResource( tiRoot,
20886                           satDevData,
20887                           satIntIo);
20888     return;
20889   }
20890
20891   /* success */
20892   TI_DBG1(("satDeResetDeviceCB: success \n"));
20893   TI_DBG1(("satDeResetDeviceCB: TMF %d\n", satOrgIOContext->TMF));
20894
20895   if (satOrgIOContext->TMF == AG_ABORT_TASK)
20896   {
20897     AbortTM = agTRUE;
20898   }
20899
20900   if (satOrgIOContext->NotifyOS == agTRUE)
20901   {
20902     report = agTRUE;
20903   }
20904
20905   if (AbortTM == agTRUE)
20906   {
20907     TI_DBG1(("satDeResetDeviceCB: calling satAbort\n"));
20908     satAbort(agRoot, satOrgIOContext->satToBeAbortedIOContext);
20909   }
20910   satDevData->satTmTaskTag = agNULL;
20911
20912   satDevData->satDriveState = SAT_DEV_STATE_NORMAL;
20913
20914   satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
20915
20916   TI_DBG1(("satDeResetDeviceCB: satPendingIO %d satNCQMaxIO %d\n", satDevData->satPendingIO, satDevData->satNCQMaxIO ));
20917   TI_DBG1(("satDeResetDeviceCB: satPendingNCQIO %d satPendingNONNCQIO %d\n", satDevData->satPendingNCQIO, satDevData->satPendingNONNCQIO));
20918
20919   satFreeIntIoResource( tiRoot,
20920                         satDevData,
20921                         satIntIo);
20922
20923   /* clean up TD layer's IORequestBody */
20924   if (tdOrgIORequestBody != agNULL)
20925   {
20926     ostiFreeMemory(
20927                    tiRoot,
20928                    tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
20929                    sizeof(tdIORequestBody_t)
20930                    );
20931   }
20932   else
20933   {
20934     TI_DBG1(("satDeResetDeviceCB: tdOrgIORequestBody is NULL, wrong\n"));
20935   }
20936
20937
20938   if (report)
20939   {
20940     ostiInitiatorEvent( tiRoot,
20941                         NULL,
20942                         NULL,
20943                         tiIntrEventTypeTaskManagement,
20944                         tiTMOK,
20945                         tiOrgIORequest );
20946   }
20947
20948
20949   TI_DBG5(("satDeResetDeviceCB: device %p pending IO %d\n", satDevData, satDevData->satPendingIO));
20950   TI_DBG6(("satDeResetDeviceCB: end\n"));
20951   return;
20952
20953 }
20954
20955 /*****************************************************************************/
20956 /*! \brief SAT implementation for satStartCheckPowerMode.
20957  *
20958  *  SAT implementation for abort task management for non-ncq sata disk.
20959  *  This function sends CHECK POWER MODE
20960  *
20961  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
20962  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
20963  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
20964  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
20965  *  \param   satIOContext_t:   Pointer to the SAT IO Context
20966  *
20967  *  \return If command is started successfully
20968  *    - \e tiSuccess:     I/O request successfully initiated.
20969  *    - \e tiBusy:        No resources available, try again later.
20970  *    - \e tiIONoDevice:  Invalid device handle.
20971  *    - \e tiError:       Other errors.
20972  */
20973 /*****************************************************************************/
20974 GLOBAL bit32  satStartCheckPowerMode(
20975                             tiRoot_t                  *tiRoot,
20976                             tiIORequest_t             *tiIORequest,
20977                             tiDeviceHandle_t          *tiDeviceHandle,
20978                             tiScsiInitiatorRequest_t  *tiScsiRequest, /* NULL */
20979                             satIOContext_t            *satIOContext
20980                             )
20981 {
20982   satInternalIo_t           *satIntIo = agNULL;
20983   satDeviceData_t           *satDevData = agNULL;
20984   satIOContext_t            *satNewIOContext;
20985   bit32                     status;
20986   tiIORequest_t             *currentTaskTag = agNULL;
20987
20988   TI_DBG6(("satStartCheckPowerMode: start\n"));
20989
20990   currentTaskTag = tiIORequest;
20991
20992   satDevData = satIOContext->pSatDevData;
20993
20994   TI_DBG6(("satStartCheckPowerMode: before alloc\n"));
20995
20996   /* allocate any fis for seting SRT bit in device control */
20997   satIntIo = satAllocIntIoResource( tiRoot,
20998                                     tiIORequest,
20999                                     satDevData,
21000                                     0,
21001                                     satIntIo);
21002
21003   TI_DBG6(("satStartCheckPowerMode: before after\n"));
21004
21005   if (satIntIo == agNULL)
21006   {
21007     TI_DBG1(("satStartCheckPowerMode: can't alloacate\n"));
21008     if (satIOContext->NotifyOS)
21009     {
21010       ostiInitiatorEvent( tiRoot,
21011                           NULL,
21012                           NULL,
21013                           tiIntrEventTypeTaskManagement,
21014                           tiTMFailed,
21015                           currentTaskTag );
21016     }
21017     return tiError;
21018   }
21019
21020   satNewIOContext = satPrepareNewIO(satIntIo,
21021                                     tiIORequest,
21022                                     satDevData,
21023                                     agNULL,
21024                                     satIOContext);
21025
21026   TI_DBG6(("satStartCheckPowerMode: OS satIOContext %p \n", satIOContext));
21027   TI_DBG6(("satStartCheckPowerMode: TD satNewIOContext %p \n", satNewIOContext));
21028   TI_DBG6(("satStartCheckPowerMode: OS tiScsiXchg %p \n", satIOContext->tiScsiXchg));
21029   TI_DBG6(("satStartCheckPowerMode: TD tiScsiXchg %p \n", satNewIOContext->tiScsiXchg));
21030
21031
21032
21033   TI_DBG1(("satStartCheckPowerMode: satNewIOContext %p \n", satNewIOContext));
21034
21035   status = satCheckPowerMode(tiRoot,
21036                              &satIntIo->satIntTiIORequest, /* New tiIORequest */
21037                              tiDeviceHandle,
21038                              satNewIOContext->tiScsiXchg, /* New tiScsiInitiatorRequest_t *tiScsiRequest, */
21039                              satNewIOContext);
21040
21041   if (status != tiSuccess)
21042   {
21043     TI_DBG1(("satStartCheckPowerMode: failed in sending\n"));
21044
21045     satFreeIntIoResource( tiRoot,
21046                           satDevData,
21047                           satIntIo);
21048     if (satIOContext->NotifyOS)
21049     {
21050       ostiInitiatorEvent( tiRoot,
21051                           NULL,
21052                           NULL,
21053                           tiIntrEventTypeTaskManagement,
21054                           tiTMFailed,
21055                           currentTaskTag );
21056     }
21057
21058     return tiError;
21059   }
21060
21061
21062   TI_DBG6(("satStartCheckPowerMode: end\n"));
21063
21064   return status;
21065 }
21066
21067 /*****************************************************************************/
21068 /*! \brief SAT implementation for satCheckPowerMode.
21069  *
21070  *  This function creates CHECK POWER MODE fis and sends the request to LL layer
21071  *
21072  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
21073  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
21074  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
21075  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
21076  *  \param   satIOContext_t:   Pointer to the SAT IO Context
21077  *
21078  *  \return If command is started successfully
21079  *    - \e tiSuccess:     I/O request successfully initiated.
21080  *    - \e tiBusy:        No resources available, try again later.
21081  *    - \e tiIONoDevice:  Invalid device handle.
21082  *    - \e tiError:       Other errors.
21083  */
21084 /*****************************************************************************/
21085 GLOBAL bit32  satCheckPowerMode(
21086                             tiRoot_t                  *tiRoot,
21087                             tiIORequest_t             *tiIORequest,
21088                             tiDeviceHandle_t          *tiDeviceHandle,
21089                             tiScsiInitiatorRequest_t *tiScsiRequest,
21090                             satIOContext_t            *satIOContext
21091                             )
21092 {
21093   /*
21094     sends SAT_CHECK_POWER_MODE as a part of ABORT TASKMANGEMENT for NCQ commands
21095     internally generated - no directly corresponding scsi
21096   */
21097   bit32                     status;
21098   bit32                     agRequestType;
21099   agsaFisRegHostToDevice_t  *fis;
21100
21101   fis           = satIOContext->pFis;
21102   TI_DBG5(("satCheckPowerMode: start\n"));
21103   /*
21104    * Send the ATA CHECK POWER MODE command.
21105    */
21106   fis->h.fisType        = 0x27;                   /* Reg host to device */
21107   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
21108   fis->h.command        = SAT_CHECK_POWER_MODE;   /* 0xE5 */
21109   fis->h.features       = 0;
21110   fis->d.lbaLow         = 0;
21111   fis->d.lbaMid         = 0;
21112   fis->d.lbaHigh        = 0;
21113   fis->d.device         = 0;
21114   fis->d.lbaLowExp      = 0;
21115   fis->d.lbaMidExp      = 0;
21116   fis->d.lbaHighExp     = 0;
21117   fis->d.featuresExp    = 0;
21118   fis->d.sectorCount    = 0;
21119   fis->d.sectorCountExp = 0;
21120   fis->d.reserved4      = 0;
21121   fis->d.control        = 0;                      /* FIS HOB bit clear */
21122   fis->d.reserved5      = 0;
21123
21124   agRequestType = AGSA_SATA_PROTOCOL_NON_DATA;
21125
21126   /* Initialize CB for SATA completion.
21127    */
21128   satIOContext->satCompleteCB = &satCheckPowerModeCB;
21129
21130   /*
21131    * Prepare SGL and send FIS to LL layer.
21132    */
21133   satIOContext->reqType = agRequestType;       /* Save it */
21134
21135   status = sataLLIOStart( tiRoot,
21136                           tiIORequest,
21137                           tiDeviceHandle,
21138                           tiScsiRequest,
21139                           satIOContext);
21140
21141   TI_DBG5(("satCheckPowerMode: return\n"));
21142
21143   return status;
21144 }
21145
21146 /*****************************************************************************
21147 *! \brief  satCheckPowerModeCB
21148 *
21149 *   This routine is a callback function called from ossaSATACompleted().
21150 *   This CB routine deals with CHECK POWER MODE completion as abort task
21151 *   management.
21152 *
21153 *  \param   agRoot:      Handles for this instance of SAS/SATA hardware
21154 *  \param   agIORequest: Pointer to the LL I/O request context for this I/O.
21155 *  \param   agIOStatus:  Status of completed I/O.
21156 *  \param   agFirstDword:Pointer to the four bytes of FIS.
21157 *  \param   agIOInfoLen: Length in bytes of overrun/underrun residual or FIS
21158 *                        length.
21159 *  \param   agParam:     Additional info based on status.
21160 *  \param   ioContext:   Pointer to satIOContext_t.
21161 *
21162 *  \return: none
21163 *
21164 *****************************************************************************/
21165 GLOBAL void satCheckPowerModeCB(
21166                    agsaRoot_t        *agRoot,
21167                    agsaIORequest_t   *agIORequest,
21168                    bit32             agIOStatus,
21169                    agsaFisHeader_t   *agFirstDword,
21170                    bit32             agIOInfoLen,
21171                    agsaFrameHandle_t agFrameHandle,
21172                    void              *ioContext
21173                    )
21174 {
21175   /* callback for satDeResetDevice */
21176   tdsaRootOsData_t        *osData = (tdsaRootOsData_t *)agRoot->osData;
21177   tiRoot_t                *tiRoot = (tiRoot_t *)osData->tiRoot;
21178   tdsaRoot_t              *tdsaRoot        = (tdsaRoot_t *) tiRoot->tdData;
21179   tdsaContext_t           *tdsaAllShared = (tdsaContext_t *)&tdsaRoot->tdsaAllShared;
21180   tdIORequestBody_t       *tdIORequestBody;
21181   tdIORequestBody_t       *tdOrgIORequestBody = agNULL;
21182   satIOContext_t          *satIOContext;
21183   satIOContext_t          *satOrgIOContext;
21184   satInternalIo_t         *satIntIo;
21185   satDeviceData_t         *satDevData;
21186
21187   tiIORequest_t             *tiOrgIORequest;
21188 #ifdef  TD_DEBUG_ENABLE
21189   bit32                     ataStatus = 0;
21190   bit32                     ataError;
21191   agsaFisPioSetupHeader_t   *satPIOSetupHeader = agNULL;
21192 #endif
21193   bit32                     report = agFALSE;
21194   bit32                     AbortTM = agFALSE;
21195
21196
21197   TI_DBG1(("satCheckPowerModeCB: start\n"));
21198
21199   TI_DBG1(("satCheckPowerModeCB: agIORequest=%p agIOStatus=0x%x agIOInfoLen %d\n", agIORequest, agIOStatus, agIOInfoLen));
21200
21201   tdIORequestBody        = (tdIORequestBody_t *)agIORequest->osData;
21202   satIOContext           = (satIOContext_t *) ioContext;
21203   satIntIo               = satIOContext->satIntIoContext;
21204   satDevData             = satIOContext->pSatDevData;
21205   if (satIntIo == agNULL)
21206   {
21207     TI_DBG6(("satCheckPowerModeCB: External, OS generated\n"));
21208     satOrgIOContext      = satIOContext;
21209     tiOrgIORequest       = tdIORequestBody->tiIORequest;
21210   }
21211   else
21212   {
21213     TI_DBG6(("satCheckPowerModeCB: Internal, TD generated\n"));
21214     satOrgIOContext        = satIOContext->satOrgIOContext;
21215     if (satOrgIOContext == agNULL)
21216     {
21217       TI_DBG6(("satCheckPowerModeCB: satOrgIOContext is NULL, wrong\n"));
21218       return;
21219     }
21220     else
21221     {
21222       TI_DBG6(("satCheckPowerModeCB: satOrgIOContext is NOT NULL\n"));
21223     }
21224     tdOrgIORequestBody     = (tdIORequestBody_t *)satOrgIOContext->tiRequestBody;
21225     tiOrgIORequest         = (tiIORequest_t *)tdOrgIORequestBody->tiIORequest;
21226   }
21227
21228
21229   tdIORequestBody->ioCompleted = agTRUE;
21230   tdIORequestBody->ioStarted = agFALSE;
21231
21232   if (agFirstDword == agNULL && agIOStatus != OSSA_IO_SUCCESS)
21233   {
21234     TI_DBG1(("satCheckPowerModeCB: wrong. agFirstDword is NULL when error, status %d\n", agIOStatus));
21235
21236     if (satOrgIOContext->NotifyOS == agTRUE)
21237     {
21238       ostiInitiatorEvent( tiRoot,
21239                           NULL,
21240                           NULL,
21241                           tiIntrEventTypeTaskManagement,
21242                           tiTMFailed,
21243                           tiOrgIORequest );
21244     }
21245
21246     satDevData->satTmTaskTag = agNULL;
21247
21248     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
21249
21250     satFreeIntIoResource( tiRoot,
21251                           satDevData,
21252                           satIntIo);
21253     return;
21254   }
21255
21256   if (agIOStatus == OSSA_IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED ||
21257       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_ZONE_VIOLATION ||
21258       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_BREAK ||
21259       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS ||
21260       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_BAD_DESTINATION ||
21261       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED ||
21262       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_WRONG_DESTINATION ||
21263       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_UNKNOWN_ERROR ||
21264       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_STP_RESOURCES_BUSY
21265       )
21266   {
21267     TI_DBG1(("satCheckPowerModeCB: OSSA_IO_OPEN_CNX_ERROR\n"));
21268
21269     if (satOrgIOContext->NotifyOS == agTRUE)
21270     {
21271       ostiInitiatorEvent( tiRoot,
21272                           NULL,
21273                           NULL,
21274                           tiIntrEventTypeTaskManagement,
21275                           tiTMFailed,
21276                           tiOrgIORequest );
21277     }
21278
21279     satDevData->satTmTaskTag = agNULL;
21280
21281     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
21282
21283     satFreeIntIoResource( tiRoot,
21284                          satDevData,
21285                          satIntIo);
21286     return;
21287   }
21288
21289  if (agIOStatus != OSSA_IO_SUCCESS)
21290   {
21291 #ifdef  TD_DEBUG_ENABLE
21292     /* only agsaFisPioSetup_t is expected */
21293     satPIOSetupHeader = (agsaFisPioSetupHeader_t *)&(agFirstDword->PioSetup);
21294     ataStatus     = satPIOSetupHeader->status;   /* ATA Status register */
21295     ataError      = satPIOSetupHeader->error;    /* ATA Eror register   */
21296 #endif
21297     TI_DBG1(("satCheckPowerModeCB: ataStatus 0x%x ataError 0x%x\n", ataStatus, ataError));
21298
21299      if (satOrgIOContext->NotifyOS == agTRUE)
21300      {
21301       ostiInitiatorEvent( tiRoot,
21302                           NULL,
21303                           NULL,
21304                           tiIntrEventTypeTaskManagement,
21305                           tiTMFailed,
21306                           tiOrgIORequest );
21307      }
21308
21309     satDevData->satTmTaskTag = agNULL;
21310
21311     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
21312
21313     satFreeIntIoResource( tiRoot,
21314                           satDevData,
21315                           satIntIo);
21316     return;
21317   }
21318
21319   /* success */
21320   TI_DBG1(("satCheckPowerModeCB: success\n"));
21321   TI_DBG1(("satCheckPowerModeCB: TMF %d\n", satOrgIOContext->TMF));
21322
21323   if (satOrgIOContext->TMF == AG_ABORT_TASK)
21324   {
21325     AbortTM = agTRUE;
21326   }
21327
21328   if (satOrgIOContext->NotifyOS == agTRUE)
21329   {
21330     report = agTRUE;
21331   }
21332   if (AbortTM == agTRUE)
21333   {
21334     TI_DBG1(("satCheckPowerModeCB: calling satAbort\n"));
21335     satAbort(agRoot, satOrgIOContext->satToBeAbortedIOContext);
21336   }
21337   satDevData->satTmTaskTag = agNULL;
21338
21339   satDevData->satDriveState = SAT_DEV_STATE_NORMAL;
21340
21341   satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
21342
21343   TI_DBG1(("satCheckPowerModeCB: satPendingIO %d satNCQMaxIO %d\n", satDevData->satPendingIO, satDevData->satNCQMaxIO ));
21344   TI_DBG1(("satCheckPowerModeCB: satPendingNCQIO %d satPendingNONNCQIO %d\n", satDevData->satPendingNCQIO, satDevData->satPendingNONNCQIO));
21345
21346   satFreeIntIoResource( tiRoot,
21347                         satDevData,
21348                         satIntIo);
21349
21350   /* clean up TD layer's IORequestBody */
21351   if (tdOrgIORequestBody != agNULL)
21352   {
21353     ostiFreeMemory(
21354                    tiRoot,
21355                    tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
21356                    sizeof(tdIORequestBody_t)
21357                    );
21358   }
21359   else
21360   {
21361     TI_DBG1(("satCheckPowerModeCB: tdOrgIORequestBody is NULL, wrong\n"));
21362   }
21363   if (report)
21364   {
21365     ostiInitiatorEvent( tiRoot,
21366                         NULL,
21367                         NULL,
21368                         tiIntrEventTypeTaskManagement,
21369                         tiTMOK,
21370                         tiOrgIORequest );
21371   }
21372
21373   TI_DBG5(("satCheckPowerModeCB: device %p pending IO %d\n", satDevData, satDevData->satPendingIO));
21374   TI_DBG2(("satCheckPowerModeCB: end\n"));
21375   return;
21376
21377 }
21378
21379 /*****************************************************************************/
21380 /*! \brief SAT implementation for satAddSATAStartIDDev.
21381  *
21382  *  This function sends identify device data to find out the uniqueness
21383  *  of device.
21384  *
21385  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
21386  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
21387  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
21388  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
21389  *  \param   satIOContext_t:   Pointer to the SAT IO Context
21390  *
21391  *  \return If command is started successfully
21392  *    - \e tiSuccess:     I/O request successfully initiated.
21393  *    - \e tiBusy:        No resources available, try again later.
21394  *    - \e tiIONoDevice:  Invalid device handle.
21395  *    - \e tiError:       Other errors.
21396  */
21397 /*****************************************************************************/
21398 GLOBAL bit32  satAddSATAStartIDDev(
21399                                tiRoot_t                  *tiRoot,
21400                                tiIORequest_t             *tiIORequest,
21401                                tiDeviceHandle_t          *tiDeviceHandle,
21402                                tiScsiInitiatorRequest_t  *tiScsiRequest, // NULL
21403                                satIOContext_t            *satIOContext
21404                             )
21405 {
21406   satInternalIo_t           *satIntIo = agNULL;
21407   satDeviceData_t           *satDevData = agNULL;
21408   tdIORequestBody_t         *tdIORequestBody;
21409   satIOContext_t            *satNewIOContext;
21410   bit32                     status;
21411
21412   TI_DBG2(("satAddSATAStartIDDev: start\n"));
21413
21414   satDevData = satIOContext->pSatDevData;
21415
21416   TI_DBG2(("satAddSATAStartIDDev: before alloc\n"));
21417
21418   /* allocate identify device command */
21419   satIntIo = satAllocIntIoResource( tiRoot,
21420                                     tiIORequest,
21421                                     satDevData,
21422                                     sizeof(agsaSATAIdentifyData_t), /* 512; size of identify device data */
21423                                     satIntIo);
21424
21425   TI_DBG2(("satAddSATAStartIDDev: after alloc\n"));
21426
21427   if (satIntIo == agNULL)
21428   {
21429     TI_DBG1(("satAddSATAStartIDDev: can't alloacate\n"));
21430
21431     return tiError;
21432   }
21433
21434   /* fill in fields */
21435   /* real ttttttthe one worked and the same; 5/21/07/ */
21436   satIntIo->satOrgTiIORequest = tiIORequest; /* changed */
21437   tdIORequestBody = satIntIo->satIntRequestBody;
21438   satNewIOContext = &(tdIORequestBody->transport.SATA.satIOContext);
21439
21440   satNewIOContext->pSatDevData   = satDevData;
21441   satNewIOContext->pFis          = &(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev);
21442   satNewIOContext->pScsiCmnd     = &(satIntIo->satIntTiScsiXchg.scsiCmnd);
21443   satNewIOContext->pSense        = &(tdIORequestBody->transport.SATA.sensePayload);
21444   satNewIOContext->pTiSenseData  = &(tdIORequestBody->transport.SATA.tiSenseData);
21445   satNewIOContext->tiRequestBody = satIntIo->satIntRequestBody; /* key fix */
21446   satNewIOContext->interruptContext = tiInterruptContext;
21447   satNewIOContext->satIntIoContext  = satIntIo;
21448
21449   satNewIOContext->ptiDeviceHandle = agNULL;
21450   satNewIOContext->satOrgIOContext = satIOContext; /* changed */
21451
21452   /* this is valid only for TD layer generated (not triggered by OS at all) IO */
21453   satNewIOContext->tiScsiXchg = &(satIntIo->satIntTiScsiXchg);
21454
21455
21456   TI_DBG6(("satAddSATAStartIDDev: OS satIOContext %p \n", satIOContext));
21457   TI_DBG6(("satAddSATAStartIDDev: TD satNewIOContext %p \n", satNewIOContext));
21458   TI_DBG6(("satAddSATAStartIDDev: OS tiScsiXchg %p \n", satIOContext->tiScsiXchg));
21459   TI_DBG6(("satAddSATAStartIDDev: TD tiScsiXchg %p \n", satNewIOContext->tiScsiXchg));
21460
21461
21462
21463   TI_DBG2(("satAddSATAStartIDDev: satNewIOContext %p tdIORequestBody %p\n", satNewIOContext, tdIORequestBody));
21464
21465   status = satAddSATASendIDDev( tiRoot,
21466                                 &satIntIo->satIntTiIORequest, /* New tiIORequest */
21467                                 tiDeviceHandle,
21468                                 satNewIOContext->tiScsiXchg, /* New tiScsiInitiatorRequest_t *tiScsiRequest, */
21469                                 satNewIOContext);
21470
21471   if (status != tiSuccess)
21472   {
21473     TI_DBG1(("satAddSATAStartIDDev: failed in sending\n"));
21474
21475     satFreeIntIoResource( tiRoot,
21476                           satDevData,
21477                           satIntIo);
21478
21479     return tiError;
21480   }
21481
21482
21483   TI_DBG6(("satAddSATAStartIDDev: end\n"));
21484
21485   return status;
21486
21487
21488 }
21489
21490 /*****************************************************************************/
21491 /*! \brief SAT implementation for satAddSATASendIDDev.
21492  *
21493  *  This function creates identify device data fis and send it to LL
21494  *
21495  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
21496  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
21497  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
21498  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
21499  *  \param   satIOContext_t:   Pointer to the SAT IO Context
21500  *
21501  *  \return If command is started successfully
21502  *    - \e tiSuccess:     I/O request successfully initiated.
21503  *    - \e tiBusy:        No resources available, try again later.
21504  *    - \e tiIONoDevice:  Invalid device handle.
21505  *    - \e tiError:       Other errors.
21506  */
21507 /*****************************************************************************/
21508 GLOBAL bit32  satAddSATASendIDDev(
21509                            tiRoot_t                  *tiRoot,
21510                            tiIORequest_t             *tiIORequest,
21511                            tiDeviceHandle_t          *tiDeviceHandle,
21512                            tiScsiInitiatorRequest_t  *tiScsiRequest,
21513                            satIOContext_t            *satIOContext)
21514 {
21515   bit32                     status;
21516   bit32                     agRequestType;
21517   satDeviceData_t           *pSatDevData;
21518   agsaFisRegHostToDevice_t  *fis;
21519 #ifdef  TD_DEBUG_ENABLE
21520   tdIORequestBody_t         *tdIORequestBody;
21521   satInternalIo_t           *satIntIoContext;
21522 #endif
21523
21524   pSatDevData   = satIOContext->pSatDevData;
21525   fis           = satIOContext->pFis;
21526   TI_DBG2(("satAddSATASendIDDev: start\n"));
21527 #ifdef  TD_DEBUG_ENABLE
21528   satIntIoContext = satIOContext->satIntIoContext;
21529   tdIORequestBody = satIntIoContext->satIntRequestBody;
21530 #endif
21531   TI_DBG5(("satAddSATASendIDDev: satIOContext %p tdIORequestBody %p\n", satIOContext, tdIORequestBody));
21532
21533   fis->h.fisType        = 0x27;                   /* Reg host to device */
21534   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
21535   if (pSatDevData->satDeviceType == SATA_ATAPI_DEVICE)
21536       fis->h.command    = SAT_IDENTIFY_PACKET_DEVICE;  /* 0x40 */
21537   else
21538       fis->h.command    = SAT_IDENTIFY_DEVICE;    /* 0xEC */
21539   fis->h.features       = 0;                      /* FIS reserve */
21540   fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
21541   fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
21542   fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
21543   fis->d.device         = 0;                      /* FIS LBA mode  */
21544   fis->d.lbaLowExp      = 0;
21545   fis->d.lbaMidExp      = 0;
21546   fis->d.lbaHighExp     = 0;
21547   fis->d.featuresExp    = 0;
21548   fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
21549   fis->d.sectorCountExp = 0;
21550   fis->d.reserved4      = 0;
21551   fis->d.control        = 0;                      /* FIS HOB bit clear */
21552   fis->d.reserved5      = 0;
21553
21554   agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
21555
21556   /* Initialize CB for SATA completion.
21557    */
21558   satIOContext->satCompleteCB = &satAddSATAIDDevCB;
21559
21560   /*
21561    * Prepare SGL and send FIS to LL layer.
21562    */
21563   satIOContext->reqType = agRequestType;       /* Save it */
21564
21565 #ifdef TD_INTERNAL_DEBUG
21566   tdhexdump("satAddSATASendIDDev", (bit8 *)satIOContext->pFis, sizeof(agsaFisRegHostToDevice_t));
21567 #ifdef  TD_DEBUG_ENABLE
21568   tdhexdump("satAddSATASendIDDev LL", (bit8 *)&(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev), sizeof(agsaFisRegHostToDevice_t));
21569 #endif
21570 #endif
21571
21572   status = sataLLIOStart( tiRoot,
21573                           tiIORequest,
21574                           tiDeviceHandle,
21575                           tiScsiRequest,
21576                           satIOContext);
21577
21578   TI_DBG2(("satAddSATASendIDDev: end status %d\n", status));
21579   return status;
21580 }
21581
21582 /*****************************************************************************
21583 *! \brief  satAddSATAIDDevCB
21584 *
21585 *   This routine is a callback function for satAddSATASendIDDev()
21586 *   Using Identify Device Data, this function finds whether devicedata is
21587 *   new or old. If new, add it to the devicelist.
21588 *
21589 *  \param   agRoot:      Handles for this instance of SAS/SATA hardware
21590 *  \param   agIORequest: Pointer to the LL I/O request context for this I/O.
21591 *  \param   agIOStatus:  Status of completed I/O.
21592 *  \param   agFirstDword:Pointer to the four bytes of FIS.
21593 *  \param   agIOInfoLen: Length in bytes of overrun/underrun residual or FIS
21594 *                        length.
21595 *  \param   agParam:     Additional info based on status.
21596 *  \param   ioContext:   Pointer to satIOContext_t.
21597 *
21598 *  \return: none
21599 *
21600 *****************************************************************************/
21601 void satAddSATAIDDevCB(
21602                    agsaRoot_t        *agRoot,
21603                    agsaIORequest_t   *agIORequest,
21604                    bit32             agIOStatus,
21605                    agsaFisHeader_t   *agFirstDword,
21606                    bit32             agIOInfoLen,
21607                    void              *agParam,
21608                    void              *ioContext
21609                    )
21610 {
21611
21612   /*
21613     In the process of Inquiry
21614     Process SAT_IDENTIFY_DEVICE
21615   */
21616   tdsaRootOsData_t        *osData = (tdsaRootOsData_t *)agRoot->osData;
21617   tiRoot_t                *tiRoot = (tiRoot_t *)osData->tiRoot;
21618   tdsaRoot_t              *tdsaRoot        = (tdsaRoot_t *) tiRoot->tdData;
21619   tdsaContext_t           *tdsaAllShared = (tdsaContext_t *)&tdsaRoot->tdsaAllShared;
21620   tdIORequestBody_t       *tdIORequestBody;
21621   tdIORequestBody_t       *tdOrgIORequestBody;
21622   satIOContext_t          *satIOContext;
21623   satIOContext_t          *satOrgIOContext;
21624   satIOContext_t          *satNewIOContext;
21625   satInternalIo_t         *satIntIo;
21626   satInternalIo_t         *satNewIntIo = agNULL;
21627   satDeviceData_t         *satDevData;
21628   tiIORequest_t           *tiOrgIORequest = agNULL;
21629   agsaSATAIdentifyData_t    *pSATAIdData;
21630   bit16                     *tmpptr, tmpptr_tmp;
21631   bit32                     x;
21632   tdsaDeviceData_t          *NewOneDeviceData = agNULL;
21633   tdsaDeviceData_t          *oneDeviceData = agNULL;
21634   tdList_t                  *DeviceListList;
21635   int                       new_device = agTRUE;
21636   bit8                      PhyID;
21637   void                      *sglVirtualAddr;
21638   bit32                     retry_status;
21639   agsaContext_t             *agContext;
21640   tdsaPortContext_t         *onePortContext;
21641   bit32                     status = 0;
21642
21643   TI_DBG2(("satAddSATAIDDevCB: start\n"));
21644   TI_DBG6(("satAddSATAIDDevCB: agIORequest=%p agIOStatus=0x%x agIOInfoLen %d\n", agIORequest, agIOStatus, agIOInfoLen));
21645   tdIORequestBody        = (tdIORequestBody_t *)agIORequest->osData;
21646   satIOContext           = (satIOContext_t *) ioContext;
21647   satIntIo               = satIOContext->satIntIoContext;
21648   satDevData             = satIOContext->pSatDevData;
21649
21650   NewOneDeviceData = (tdsaDeviceData_t *)tdIORequestBody->tiDevHandle->tdData;
21651   TI_DBG2(("satAddSATAIDDevCB: NewOneDeviceData %p did %d\n", NewOneDeviceData, NewOneDeviceData->id));
21652   PhyID = NewOneDeviceData->phyID;
21653   TI_DBG2(("satAddSATAIDDevCB: phyID %d\n", PhyID));
21654   agContext = &(NewOneDeviceData->agDeviceResetContext);
21655   agContext->osData = agNULL;
21656   if (satIntIo == agNULL)
21657   {
21658     TI_DBG1(("satAddSATAIDDevCB: External, OS generated\n"));
21659     TI_DBG1(("satAddSATAIDDevCB: Not possible case\n"));
21660     satOrgIOContext      = satIOContext;
21661     tdOrgIORequestBody     = (tdIORequestBody_t *)satOrgIOContext->tiRequestBody;
21662     tdsaAbortAll(tiRoot, agRoot, NewOneDeviceData);
21663
21664     /* put onedevicedata back to free list */
21665     osti_memset(&(NewOneDeviceData->satDevData.satIdentifyData), 0xFF, sizeof(agsaSATAIdentifyData_t));
21666     TDLIST_DEQUEUE_THIS(&(NewOneDeviceData->MainLink));
21667     TDLIST_ENQUEUE_AT_TAIL(&(NewOneDeviceData->FreeLink), &(tdsaAllShared->FreeDeviceList));
21668
21669     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
21670
21671     satFreeIntIoResource( tiRoot,
21672                           satDevData,
21673                           satIntIo);
21674     /* clean up TD layer's IORequestBody */
21675     ostiFreeMemory(
21676                    tiRoot,
21677                    tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
21678                    sizeof(tdIORequestBody_t)
21679                    );
21680
21681     /* notifying link up */
21682     ostiPortEvent (
21683                    tiRoot,
21684                    tiPortLinkUp,
21685                    tiSuccess,
21686                    (void *)tdsaAllShared->Ports[PhyID].tiPortalContext
21687                    );
21688 #ifdef INITIATOR_DRIVER
21689     /* triggers discovery */
21690     ostiPortEvent(
21691                   tiRoot,
21692                   tiPortDiscoveryReady,
21693                   tiSuccess,
21694                   (void *) tdsaAllShared->Ports[PhyID].tiPortalContext
21695                   );
21696 #endif
21697     return;
21698   }
21699   else
21700   {
21701     TI_DBG1(("satAddSATAIDDevCB: Internal, TD generated\n"));
21702     satOrgIOContext        = satIOContext->satOrgIOContext;
21703     if (satOrgIOContext == agNULL)
21704     {
21705       TI_DBG6(("satAddSATAIDDevCB: satOrgIOContext is NULL\n"));
21706       return;
21707     }
21708     else
21709     {
21710       TI_DBG6(("satAddSATAIDDevCB: satOrgIOContext is NOT NULL\n"));
21711       tdOrgIORequestBody     = (tdIORequestBody_t *)satOrgIOContext->tiRequestBody;
21712       sglVirtualAddr         = satIntIo->satIntTiScsiXchg.sglVirtualAddr;
21713     }
21714   }
21715   tiOrgIORequest           = tdIORequestBody->tiIORequest;
21716
21717   tdIORequestBody->ioCompleted = agTRUE;
21718   tdIORequestBody->ioStarted = agFALSE;
21719   TI_DBG2(("satAddSATAIDDevCB: satOrgIOContext->pid %d\n", satOrgIOContext->pid));
21720   /* protect against double completion for old port */
21721   if (satOrgIOContext->pid != tdsaAllShared->Ports[PhyID].portContext->id)
21722   {
21723     TI_DBG2(("satAddSATAIDDevCB: incorrect pid\n"));
21724     TI_DBG2(("satAddSATAIDDevCB: satOrgIOContext->pid %d\n", satOrgIOContext->pid));
21725     TI_DBG2(("satAddSATAIDDevCB: tiPortalContext pid %d\n", tdsaAllShared->Ports[PhyID].portContext->id));
21726     tdsaAbortAll(tiRoot, agRoot, NewOneDeviceData);
21727     /* put onedevicedata back to free list */
21728     osti_memset(&(NewOneDeviceData->satDevData.satIdentifyData), 0xFF, sizeof(agsaSATAIdentifyData_t));
21729     TDLIST_DEQUEUE_THIS(&(NewOneDeviceData->MainLink));
21730     TDLIST_ENQUEUE_AT_TAIL(&(NewOneDeviceData->FreeLink), &(tdsaAllShared->FreeDeviceList));
21731     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
21732
21733     satFreeIntIoResource( tiRoot,
21734                           satDevData,
21735                           satIntIo);
21736     /* clean up TD layer's IORequestBody */
21737     ostiFreeMemory(
21738                    tiRoot,
21739                    tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
21740                    sizeof(tdIORequestBody_t)
21741                    );
21742     /* no notification to OS layer */
21743     return;
21744   }
21745   /* completion after portcontext is invalidated */
21746   onePortContext = NewOneDeviceData->tdPortContext;
21747   if (onePortContext != agNULL)
21748   {
21749     if (onePortContext->valid == agFALSE)
21750     {
21751       TI_DBG1(("satAddSATAIDDevCB: portcontext is invalid\n"));
21752       TI_DBG1(("satAddSATAIDDevCB: onePortContext->id pid %d\n", onePortContext->id));
21753       satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
21754
21755       satFreeIntIoResource( tiRoot,
21756                             satDevData,
21757                             satIntIo);
21758       /* clean up TD layer's IORequestBody */
21759       ostiFreeMemory(
21760                      tiRoot,
21761                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
21762                      sizeof(tdIORequestBody_t)
21763                      );
21764       /* no notification to OS layer */
21765       return;
21766     }
21767   }
21768   else
21769   {
21770     TI_DBG1(("satAddSATAIDDevCB: onePortContext is NULL!!!\n"));
21771     return;
21772   }
21773   if (agFirstDword == agNULL && agIOStatus != OSSA_IO_SUCCESS)
21774   {
21775     TI_DBG1(("satAddSATAIDDevCB: wrong. agFirstDword is NULL when error, status %d\n", agIOStatus));
21776     if (tdsaAllShared->ResetInDiscovery != 0 && satDevData->ID_Retries < SATA_ID_DEVICE_DATA_RETRIES)
21777     {
21778       satDevData->satPendingNONNCQIO--;
21779       satDevData->satPendingIO--;
21780       retry_status = sataLLIOStart(tiRoot,
21781                                    &satIntIo->satIntTiIORequest,
21782                                    &(NewOneDeviceData->tiDeviceHandle),
21783                                    satIOContext->tiScsiXchg,
21784                                    satIOContext);
21785       if (retry_status != tiSuccess)
21786       {
21787         /* simply give up */
21788         satDevData->ID_Retries = 0;
21789         satAddSATAIDDevCBCleanup(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21790         return;
21791       }
21792       satDevData->ID_Retries++;
21793       tdIORequestBody->ioCompleted = agFALSE;
21794       tdIORequestBody->ioStarted = agTRUE;
21795       return;
21796     }
21797     else
21798     {
21799       if (tdsaAllShared->ResetInDiscovery == 0)
21800       {
21801         satAddSATAIDDevCBCleanup(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21802       }
21803       else /* ResetInDiscovery in on */
21804       {
21805         /* RESET only one after ID retries */
21806         if (satDevData->NumOfIDRetries <= 0)
21807         {
21808           satDevData->NumOfIDRetries++;
21809           satDevData->ID_Retries = 0;
21810           satAddSATAIDDevCBReset(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21811           /* send link reset */
21812           saLocalPhyControl(agRoot,
21813                             agContext,
21814                             tdsaRotateQnumber(tiRoot, NewOneDeviceData),
21815                             PhyID,
21816                             AGSA_PHY_HARD_RESET,
21817                             agNULL);
21818         }
21819         else
21820         {
21821           satDevData->ID_Retries = 0;
21822           satAddSATAIDDevCBCleanup(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21823         }
21824       }
21825       return;
21826     }
21827   }
21828   if (agIOStatus == OSSA_IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED ||
21829       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_ZONE_VIOLATION ||
21830       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_BREAK ||
21831       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS ||
21832       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_BAD_DESTINATION ||
21833       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED ||
21834       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_WRONG_DESTINATION ||
21835       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_UNKNOWN_ERROR ||
21836       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_STP_RESOURCES_BUSY
21837       )
21838   {
21839     TI_DBG1(("satAddSATAIDDevCB: OSSA_IO_OPEN_CNX_ERROR\n"));
21840     if (tdsaAllShared->ResetInDiscovery != 0 && satDevData->ID_Retries < SATA_ID_DEVICE_DATA_RETRIES)
21841     {
21842       satDevData->satPendingNONNCQIO--;
21843       satDevData->satPendingIO--;
21844       retry_status = sataLLIOStart(tiRoot,
21845                                    &satIntIo->satIntTiIORequest,
21846                                    &(NewOneDeviceData->tiDeviceHandle),
21847                                    satIOContext->tiScsiXchg,
21848                                    satIOContext);
21849       if (retry_status != tiSuccess)
21850       {
21851         /* simply give up */
21852         satDevData->ID_Retries = 0;
21853         satAddSATAIDDevCBCleanup(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21854         return;
21855       }
21856       satDevData->ID_Retries++;
21857       tdIORequestBody->ioCompleted = agFALSE;
21858       tdIORequestBody->ioStarted = agTRUE;
21859       return;
21860     }
21861     else
21862     {
21863       if (tdsaAllShared->ResetInDiscovery == 0)
21864       {
21865         satAddSATAIDDevCBCleanup(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21866       }
21867       else /* ResetInDiscovery in on */
21868       {
21869         /* RESET only one after ID retries */
21870         if (satDevData->NumOfIDRetries <= 0)
21871         {
21872           satDevData->NumOfIDRetries++;
21873           satDevData->ID_Retries = 0;
21874           satAddSATAIDDevCBReset(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21875           /* send link reset */
21876           saLocalPhyControl(agRoot,
21877                             agContext,
21878                             tdsaRotateQnumber(tiRoot, NewOneDeviceData),
21879                             PhyID,
21880                             AGSA_PHY_HARD_RESET,
21881                             agNULL);
21882         }
21883         else
21884         {
21885           satDevData->ID_Retries = 0;
21886           satAddSATAIDDevCBCleanup(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21887         }
21888       }
21889       return;
21890     }
21891   }
21892
21893   if ( agIOStatus != OSSA_IO_SUCCESS ||
21894       (agIOStatus == OSSA_IO_SUCCESS && agFirstDword != agNULL && agIOInfoLen != 0)
21895     )
21896   {
21897     if (tdsaAllShared->ResetInDiscovery != 0 && satDevData->ID_Retries < SATA_ID_DEVICE_DATA_RETRIES)
21898     {
21899       satIOContext->pSatDevData->satPendingNONNCQIO--;
21900       satIOContext->pSatDevData->satPendingIO--;
21901       retry_status = sataLLIOStart(tiRoot,
21902                                    &satIntIo->satIntTiIORequest,
21903                                    &(NewOneDeviceData->tiDeviceHandle),
21904                                    satIOContext->tiScsiXchg,
21905                                    satIOContext);
21906       if (retry_status != tiSuccess)
21907       {
21908         /* simply give up */
21909         satDevData->ID_Retries = 0;
21910         satAddSATAIDDevCBCleanup(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21911         return;
21912       }
21913       satDevData->ID_Retries++;
21914       tdIORequestBody->ioCompleted = agFALSE;
21915       tdIORequestBody->ioStarted = agTRUE;
21916       return;
21917     }
21918     else
21919     {
21920       if (tdsaAllShared->ResetInDiscovery == 0)
21921       {
21922         satAddSATAIDDevCBCleanup(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21923       }
21924       else /* ResetInDiscovery in on */
21925       {
21926         /* RESET only one after ID retries */
21927         if (satDevData->NumOfIDRetries <= 0)
21928         {
21929           satDevData->NumOfIDRetries++;
21930           satDevData->ID_Retries = 0;
21931           satAddSATAIDDevCBReset(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21932           /* send link reset */
21933           saLocalPhyControl(agRoot,
21934                             agContext,
21935                             tdsaRotateQnumber(tiRoot, NewOneDeviceData),
21936                             PhyID,
21937                             AGSA_PHY_HARD_RESET,
21938                             agNULL);
21939         }
21940         else
21941         {
21942           satDevData->ID_Retries = 0;
21943           satAddSATAIDDevCBCleanup(agRoot, NewOneDeviceData, satIOContext, tdOrgIORequestBody);
21944         }
21945       }
21946       return;
21947     }
21948   }
21949
21950   /* success */
21951   TI_DBG2(("satAddSATAIDDevCB: Success\n"));
21952   /* Convert to host endian */
21953   tmpptr = (bit16*)sglVirtualAddr;
21954   //tdhexdump("satAddSATAIDDevCB before", (bit8 *)sglVirtualAddr, sizeof(agsaSATAIdentifyData_t));
21955   for (x=0; x < sizeof(agsaSATAIdentifyData_t)/sizeof(bit16); x++)
21956   {
21957    OSSA_READ_LE_16(AGROOT, &tmpptr_tmp, tmpptr, 0);
21958    *tmpptr = tmpptr_tmp;
21959    tmpptr++;
21960     /*Print tmpptr_tmp here for debugging purpose*/
21961   }
21962
21963   pSATAIdData = (agsaSATAIdentifyData_t *)sglVirtualAddr;
21964   //tdhexdump("satAddSATAIDDevCB after", (bit8 *)pSATAIdData, sizeof(agsaSATAIdentifyData_t));
21965
21966   TI_DBG5(("satAddSATAIDDevCB: OS satOrgIOContext %p \n", satOrgIOContext));
21967   TI_DBG5(("satAddSATAIDDevCB: TD satIOContext %p \n", satIOContext));
21968   TI_DBG5(("satAddSATAIDDevCB: OS tiScsiXchg %p \n", satOrgIOContext->tiScsiXchg));
21969   TI_DBG5(("satAddSATAIDDevCB: TD tiScsiXchg %p \n", satIOContext->tiScsiXchg));
21970
21971
21972   /* compare idenitfy device data to the exiting list */
21973   DeviceListList = tdsaAllShared->MainDeviceList.flink;
21974   while (DeviceListList != &(tdsaAllShared->MainDeviceList))
21975   {
21976     oneDeviceData = TDLIST_OBJECT_BASE(tdsaDeviceData_t, MainLink, DeviceListList);
21977     TI_DBG1(("satAddSATAIDDevCB: LOOP oneDeviceData %p did %d\n", oneDeviceData, oneDeviceData->id));
21978     //tdhexdump("satAddSATAIDDevCB LOOP", (bit8 *)&oneDeviceData->satDevData.satIdentifyData, sizeof(agsaSATAIdentifyData_t));
21979
21980     /* what is unique ID for sata device -> response of identify devicedata; not really
21981        Let's compare serial number, firmware version, model number
21982     */
21983     if ( oneDeviceData->DeviceType == TD_SATA_DEVICE &&
21984          (osti_memcmp (oneDeviceData->satDevData.satIdentifyData.serialNumber,
21985                        pSATAIdData->serialNumber,
21986                        20) == 0) &&
21987          (osti_memcmp (oneDeviceData->satDevData.satIdentifyData.firmwareVersion,
21988                        pSATAIdData->firmwareVersion,
21989                        8) == 0) &&
21990          (osti_memcmp (oneDeviceData->satDevData.satIdentifyData.modelNumber,
21991                        pSATAIdData->modelNumber,
21992                        40) == 0)
21993        )
21994     {
21995       TI_DBG2(("satAddSATAIDDevCB: did %d\n", oneDeviceData->id));
21996       new_device = agFALSE;
21997       break;
21998     }
21999     DeviceListList = DeviceListList->flink;
22000   }
22001
22002   if (new_device == agFALSE)
22003   {
22004     TI_DBG2(("satAddSATAIDDevCB: old device data\n"));
22005     oneDeviceData->valid = agTRUE;
22006     oneDeviceData->valid2 = agTRUE;
22007     /* save data field from new device data */
22008     oneDeviceData->agRoot = agRoot;
22009     oneDeviceData->agDevHandle = NewOneDeviceData->agDevHandle;
22010     oneDeviceData->agDevHandle->osData = oneDeviceData; /* TD layer */
22011     oneDeviceData->tdPortContext = NewOneDeviceData->tdPortContext;
22012     oneDeviceData->phyID = NewOneDeviceData->phyID;
22013
22014     /*
22015       one SATA directly attached device per phy;
22016       Therefore, deregister then register
22017     */
22018     saDeregisterDeviceHandle(agRoot, agNULL, NewOneDeviceData->agDevHandle, 0);
22019
22020     if (oneDeviceData->registered == agFALSE)
22021     {
22022       TI_DBG2(("satAddSATAIDDevCB: re-registering old device data\n"));
22023       /* already has old information; just register it again */
22024       saRegisterNewDevice( /* satAddSATAIDDevCB */
22025                           agRoot,
22026                           &oneDeviceData->agContext,
22027                           tdsaRotateQnumber(tiRoot, oneDeviceData),
22028                           &oneDeviceData->agDeviceInfo,
22029                           oneDeviceData->tdPortContext->agPortContext,
22030                           0
22031                           );
22032     }
22033
22034 //    tdsaAbortAll(tiRoot, agRoot, NewOneDeviceData);
22035     /* put onedevicedata back to free list */
22036     osti_memset(&(NewOneDeviceData->satDevData.satIdentifyData), 0xFF, sizeof(agsaSATAIdentifyData_t));
22037     TDLIST_DEQUEUE_THIS(&(NewOneDeviceData->MainLink));
22038     TDLIST_ENQUEUE_AT_TAIL(&(NewOneDeviceData->FreeLink), &(tdsaAllShared->FreeDeviceList));
22039     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
22040
22041     satFreeIntIoResource( tiRoot,
22042                           satDevData,
22043                           satIntIo);
22044
22045     if (satDevData->satDeviceType == SATA_ATAPI_DEVICE)
22046     {
22047       /* send the Set Feature ATA command to ATAPI device for enbling PIO and DMA transfer mode*/
22048       satNewIntIo = satAllocIntIoResource( tiRoot,
22049                                        tiOrgIORequest,
22050                                        satDevData,
22051                                        0,
22052                                        satNewIntIo);
22053
22054       if (satNewIntIo == agNULL)
22055       {
22056         TI_DBG1(("tdsaDiscoveryStartIDDevCB: momory allocation fails\n"));
22057           /* clean up TD layer's IORequestBody */
22058         ostiFreeMemory(
22059                      tiRoot,
22060                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22061                      sizeof(tdIORequestBody_t)
22062                      );
22063         return;
22064       } /* end memory allocation */
22065
22066       satNewIOContext = satPrepareNewIO(satNewIntIo,
22067                                         tiOrgIORequest,
22068                                         satDevData,
22069                                         agNULL,
22070                                         satOrgIOContext
22071                                         );
22072       /* enable PIO mode, then enable Ultra DMA mode in the satSetFeaturesCB callback function*/
22073       status = satSetFeatures(tiRoot,
22074                      &satNewIntIo->satIntTiIORequest,
22075                      satNewIOContext->ptiDeviceHandle,
22076                      &satNewIntIo->satIntTiScsiXchg, /* orginal from OS layer */
22077                      satNewIOContext,
22078                      agFALSE);
22079       if (status != tiSuccess)
22080       {
22081            satFreeIntIoResource( tiRoot,
22082                         satDevData,
22083                         satIntIo);
22084            /* clean up TD layer's IORequestBody */
22085            ostiFreeMemory(
22086                      tiRoot,
22087                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22088                      sizeof(tdIORequestBody_t)
22089                      );
22090       }
22091     }
22092     else
22093     {
22094       /* clean up TD layer's IORequestBody */
22095       ostiFreeMemory(
22096                    tiRoot,
22097                    tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22098                    sizeof(tdIORequestBody_t)
22099                    );
22100       TI_DBG2(("satAddSATAIDDevCB: pid %d\n", tdsaAllShared->Ports[PhyID].portContext->id));
22101       /* notifying link up */
22102       ostiPortEvent(
22103                    tiRoot,
22104                    tiPortLinkUp,
22105                    tiSuccess,
22106                    (void *)tdsaAllShared->Ports[PhyID].tiPortalContext
22107                    );
22108
22109
22110     #ifdef INITIATOR_DRIVER
22111         /* triggers discovery */
22112         ostiPortEvent(
22113                   tiRoot,
22114                   tiPortDiscoveryReady,
22115                   tiSuccess,
22116                   (void *) tdsaAllShared->Ports[PhyID].tiPortalContext
22117                   );
22118     #endif
22119     }
22120     return;
22121   }
22122
22123   TI_DBG2(("satAddSATAIDDevCB: new device data\n"));
22124   /* copy ID Dev data to satDevData */
22125   satDevData->satIdentifyData = *pSATAIdData;
22126
22127
22128   satDevData->IDDeviceValid = agTRUE;
22129 #ifdef TD_INTERNAL_DEBUG
22130   tdhexdump("satAddSATAIDDevCB ID Dev data",(bit8 *)pSATAIdData, sizeof(agsaSATAIdentifyData_t));
22131   tdhexdump("satAddSATAIDDevCB Device ID Dev data",(bit8 *)&satDevData->satIdentifyData, sizeof(agsaSATAIdentifyData_t));
22132 #endif
22133
22134   /* set satDevData fields from IndentifyData */
22135   satSetDevInfo(satDevData,pSATAIdData);
22136   satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
22137
22138   satFreeIntIoResource( tiRoot,
22139                         satDevData,
22140                         satIntIo);
22141
22142   if (satDevData->satDeviceType == SATA_ATAPI_DEVICE)
22143   {
22144       /* send the Set Feature ATA command to ATAPI device for enbling PIO and DMA transfer mode*/
22145       satNewIntIo = satAllocIntIoResource( tiRoot,
22146                                        tiOrgIORequest,
22147                                        satDevData,
22148                                        0,
22149                                        satNewIntIo);
22150
22151       if (satNewIntIo == agNULL)
22152       {
22153         TI_DBG1(("tdsaDiscoveryStartIDDevCB: momory allocation fails\n"));
22154           /* clean up TD layer's IORequestBody */
22155         ostiFreeMemory(
22156                      tiRoot,
22157                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22158                      sizeof(tdIORequestBody_t)
22159                      );
22160         return;
22161       } /* end memory allocation */
22162
22163       satNewIOContext = satPrepareNewIO(satNewIntIo,
22164                                         tiOrgIORequest,
22165                                         satDevData,
22166                                         agNULL,
22167                                         satOrgIOContext
22168                                         );
22169       /* enable PIO mode, then enable Ultra DMA mode in the satSetFeaturesCB callback function*/
22170       status = satSetFeatures(tiRoot,
22171                      &satNewIntIo->satIntTiIORequest,
22172                      satNewIOContext->ptiDeviceHandle,
22173                      &satNewIntIo->satIntTiScsiXchg, /* orginal from OS layer */
22174                      satNewIOContext,
22175                      agFALSE);
22176       if (status != tiSuccess)
22177       {
22178            satFreeIntIoResource( tiRoot,
22179                         satDevData,
22180                         satIntIo);
22181            /* clean up TD layer's IORequestBody */
22182            ostiFreeMemory(
22183                      tiRoot,
22184                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22185                      sizeof(tdIORequestBody_t)
22186                      );
22187       }
22188
22189   }
22190   else
22191   {
22192        /* clean up TD layer's IORequestBody */
22193       ostiFreeMemory(
22194                      tiRoot,
22195                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22196                      sizeof(tdIORequestBody_t)
22197                      );
22198
22199       TI_DBG2(("satAddSATAIDDevCB: pid %d\n", tdsaAllShared->Ports[PhyID].portContext->id));
22200       /* notifying link up */
22201       ostiPortEvent (
22202                      tiRoot,
22203                      tiPortLinkUp,
22204                      tiSuccess,
22205                      (void *)tdsaAllShared->Ports[PhyID].tiPortalContext
22206                      );
22207     #ifdef INITIATOR_DRIVER
22208       /* triggers discovery */
22209       ostiPortEvent(
22210                     tiRoot,
22211                     tiPortDiscoveryReady,
22212                     tiSuccess,
22213                     (void *) tdsaAllShared->Ports[PhyID].tiPortalContext
22214                     );
22215     #endif
22216   }
22217
22218  TI_DBG2(("satAddSATAIDDevCB: end\n"));
22219  return;
22220
22221 }
22222
22223 /*****************************************************************************
22224 *! \brief  satAddSATAIDDevCBReset
22225 *
22226 *   This routine cleans up IOs for failed Identify device data
22227 *
22228 *  \param   agRoot:           Handles for this instance of SAS/SATA hardware
22229 *  \param   oneDeviceData:    Pointer to the device data.
22230 *  \param   ioContext:        Pointer to satIOContext_t.
22231 *  \param   tdIORequestBody:  Pointer to the request body
22232 *  \param   flag:             Decrement pending io or not
22233 *
22234 *  \return: none
22235 *
22236 *****************************************************************************/
22237 void satAddSATAIDDevCBReset(
22238                    agsaRoot_t        *agRoot,
22239                    tdsaDeviceData_t  *oneDeviceData,
22240                    satIOContext_t    *satIOContext,
22241                    tdIORequestBody_t *tdIORequestBody
22242                    )
22243 {
22244   tdsaRootOsData_t   *osData = (tdsaRootOsData_t *)agRoot->osData;
22245   tiRoot_t           *tiRoot = (tiRoot_t *)osData->tiRoot;
22246   tdsaRoot_t         *tdsaRoot        = (tdsaRoot_t *) tiRoot->tdData;
22247   tdsaContext_t      *tdsaAllShared = (tdsaContext_t *)&tdsaRoot->tdsaAllShared;
22248   satInternalIo_t    *satIntIo;
22249   satDeviceData_t    *satDevData;
22250
22251   TI_DBG2(("satAddSATAIDDevCBReset: start\n"));
22252   satIntIo           = satIOContext->satIntIoContext;
22253   satDevData         = satIOContext->pSatDevData;
22254   satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
22255
22256   satFreeIntIoResource( tiRoot,
22257                         satDevData,
22258                         satIntIo);
22259   /* clean up TD layer's IORequestBody */
22260   ostiFreeMemory(
22261                  tiRoot,
22262                  tdIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22263                  sizeof(tdIORequestBody_t)
22264                 );
22265   return;
22266 }
22267
22268
22269 /*****************************************************************************
22270 *! \brief  satAddSATAIDDevCBCleanup
22271 *
22272 *   This routine cleans up IOs for failed Identify device data
22273 *
22274 *  \param   agRoot:           Handles for this instance of SAS/SATA hardware
22275 *  \param   oneDeviceData:    Pointer to the device data.
22276 *  \param   ioContext:        Pointer to satIOContext_t.
22277 *  \param   tdIORequestBody:  Pointer to the request body
22278 *
22279 *  \return: none
22280 *
22281 *****************************************************************************/
22282 void satAddSATAIDDevCBCleanup(
22283                    agsaRoot_t        *agRoot,
22284                    tdsaDeviceData_t  *oneDeviceData,
22285                    satIOContext_t    *satIOContext,
22286                    tdIORequestBody_t *tdIORequestBody
22287                    )
22288 {
22289   tdsaRootOsData_t        *osData = (tdsaRootOsData_t *)agRoot->osData;
22290   tiRoot_t                *tiRoot = (tiRoot_t *)osData->tiRoot;
22291   tdsaRoot_t              *tdsaRoot        = (tdsaRoot_t *) tiRoot->tdData;
22292   tdsaContext_t           *tdsaAllShared = (tdsaContext_t *)&tdsaRoot->tdsaAllShared;
22293   satInternalIo_t         *satIntIo;
22294   satDeviceData_t         *satDevData;
22295   bit8                    PhyID;
22296
22297   TI_DBG2(("satAddSATAIDDevCBCleanup: start\n"));
22298   satIntIo               = satIOContext->satIntIoContext;
22299   satDevData             = satIOContext->pSatDevData;
22300   PhyID                  = oneDeviceData->phyID;
22301   tdsaAbortAll(tiRoot, agRoot, oneDeviceData);
22302   /* put onedevicedata back to free list */
22303   osti_memset(&(oneDeviceData->satDevData.satIdentifyData), 0xFF, sizeof(agsaSATAIdentifyData_t));
22304   TDLIST_DEQUEUE_THIS(&(oneDeviceData->MainLink));
22305   TDLIST_ENQUEUE_AT_TAIL(&(oneDeviceData->FreeLink), &(tdsaAllShared->FreeDeviceList));
22306
22307   satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
22308
22309
22310   satFreeIntIoResource( tiRoot,
22311                         satDevData,
22312                         satIntIo);
22313
22314   /* clean up TD layer's IORequestBody */
22315   ostiFreeMemory(
22316                  tiRoot,
22317                  tdIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22318                  sizeof(tdIORequestBody_t)
22319                 );
22320
22321   /* notifying link up */
22322   ostiPortEvent (
22323                  tiRoot,
22324                  tiPortLinkUp,
22325                  tiSuccess,
22326                  (void *)tdsaAllShared->Ports[PhyID].tiPortalContext
22327                 );
22328 #ifdef INITIATOR_DRIVER
22329   /* triggers discovery */
22330   ostiPortEvent(
22331                 tiRoot,
22332                 tiPortDiscoveryReady,
22333                 tiSuccess,
22334                 (void *) tdsaAllShared->Ports[PhyID].tiPortalContext
22335                 );
22336 #endif
22337
22338   return;
22339 }
22340
22341 /*****************************************************************************/
22342 /*! \brief SAT implementation for tdsaDiscoveryStartIDDev.
22343  *
22344  *  This function sends identify device data to SATA device in discovery
22345  *
22346  *
22347  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
22348  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
22349  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
22350  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
22351  *  \param   oneDeviceData :   Pointer to the device data.
22352  *
22353  *  \return If command is started successfully
22354  *    - \e tiSuccess:     I/O request successfully initiated.
22355  *    - \e tiBusy:        No resources available, try again later.
22356  *    - \e tiIONoDevice:  Invalid device handle.
22357  *    - \e tiError:       Other errors.
22358  */
22359 /*****************************************************************************/
22360 GLOBAL bit32
22361 tdsaDiscoveryStartIDDev(tiRoot_t                  *tiRoot,
22362                         tiIORequest_t             *tiIORequest, /* agNULL */
22363                         tiDeviceHandle_t          *tiDeviceHandle,
22364                         tiScsiInitiatorRequest_t *tiScsiRequest, /* agNULL */
22365                         tdsaDeviceData_t          *oneDeviceData
22366                         )
22367 {
22368   void                        *osMemHandle;
22369   tdIORequestBody_t           *tdIORequestBody;
22370   bit32                       PhysUpper32;
22371   bit32                       PhysLower32;
22372   bit32                       memAllocStatus;
22373   agsaIORequest_t             *agIORequest = agNULL; /* identify device data itself */
22374   satIOContext_t              *satIOContext = agNULL;
22375   bit32                       status;
22376
22377   /* allocate tdiorequestbody and call tdsaDiscoveryIntStartIDDev
22378   tdsaDiscoveryIntStartIDDev(tiRoot, agNULL, tiDeviceHandle, satIOContext);
22379
22380   */
22381
22382   TI_DBG3(("tdsaDiscoveryStartIDDev: start\n"));
22383   TI_DBG3(("tdsaDiscoveryStartIDDev: did %d\n", oneDeviceData->id));
22384
22385   /* allocation tdIORequestBody and pass it to satTM() */
22386   memAllocStatus = ostiAllocMemory(
22387                                    tiRoot,
22388                                    &osMemHandle,
22389                                    (void **)&tdIORequestBody,
22390                                    &PhysUpper32,
22391                                    &PhysLower32,
22392                                    8,
22393                                    sizeof(tdIORequestBody_t),
22394                                    agTRUE
22395                                    );
22396
22397   if (memAllocStatus != tiSuccess)
22398   {
22399     TI_DBG1(("tdsaDiscoveryStartIDDev: ostiAllocMemory failed... loc 1\n"));
22400     return tiError;
22401   }
22402   if (tdIORequestBody == agNULL)
22403   {
22404     TI_DBG1(("tdsaDiscoveryStartIDDev: ostiAllocMemory returned NULL tdIORequestBody loc 2\n"));
22405     return tiError;
22406   }
22407
22408   /* setup identify device data IO structure */
22409   tdIORequestBody->IOType.InitiatorTMIO.osMemHandle = osMemHandle;
22410   tdIORequestBody->IOType.InitiatorTMIO.CurrentTaskTag = agNULL;
22411   tdIORequestBody->IOType.InitiatorTMIO.TaskTag = agNULL;
22412
22413   /* initialize tiDevhandle */
22414   tdIORequestBody->tiDevHandle = &(oneDeviceData->tiDeviceHandle);
22415   tdIORequestBody->tiDevHandle->tdData = oneDeviceData;
22416
22417   /* initialize tiIORequest */
22418   tdIORequestBody->tiIORequest = agNULL;
22419
22420   /* initialize agIORequest */
22421   agIORequest = &(tdIORequestBody->agIORequest);
22422   agIORequest->osData = (void *) tdIORequestBody;
22423   agIORequest->sdkData = agNULL; /* SA takes care of this */
22424
22425   /* set up satIOContext */
22426   satIOContext = &(tdIORequestBody->transport.SATA.satIOContext);
22427   satIOContext->pSatDevData   = &(oneDeviceData->satDevData);
22428   satIOContext->pFis          =
22429     &(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev);
22430
22431   satIOContext->tiRequestBody = tdIORequestBody;
22432   satIOContext->ptiDeviceHandle = &(oneDeviceData->tiDeviceHandle);
22433   satIOContext->tiScsiXchg = agNULL;
22434   satIOContext->satIntIoContext  = agNULL;
22435   satIOContext->satOrgIOContext  = agNULL;
22436   /* followings are used only for internal IO */
22437   satIOContext->currentLBA = 0;
22438   satIOContext->OrgTL = 0;
22439   satIOContext->satToBeAbortedIOContext = agNULL;
22440   satIOContext->NotifyOS = agFALSE;
22441
22442   /* saving port ID just in case of full discovery to full discovery transition */
22443   satIOContext->pid = oneDeviceData->tdPortContext->id;
22444   osti_memset(&(oneDeviceData->satDevData.satIdentifyData), 0x0, sizeof(agsaSATAIdentifyData_t));
22445   status = tdsaDiscoveryIntStartIDDev(tiRoot,
22446                                       tiIORequest, /* agNULL */
22447                                       tiDeviceHandle, /* &(oneDeviceData->tiDeviceHandle)*/
22448                                       agNULL,
22449                                       satIOContext
22450                                       );
22451   if (status != tiSuccess)
22452   {
22453     TI_DBG1(("tdsaDiscoveryStartIDDev: failed in sending %d\n", status));
22454     ostiFreeMemory(tiRoot, osMemHandle, sizeof(tdIORequestBody_t));
22455   }
22456   return status;
22457 }
22458
22459 /*****************************************************************************/
22460 /*! \brief SAT implementation for tdsaDiscoveryIntStartIDDev.
22461  *
22462  *  This function sends identify device data to SATA device.
22463  *
22464  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
22465  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
22466  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
22467  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
22468  *  \param   satIOContext_t:   Pointer to the SAT IO Context
22469  *
22470  *  \return If command is started successfully
22471  *    - \e tiSuccess:     I/O request successfully initiated.
22472  *    - \e tiBusy:        No resources available, try again later.
22473  *    - \e tiIONoDevice:  Invalid device handle.
22474  *    - \e tiError:       Other errors.
22475  */
22476 /*****************************************************************************/
22477 GLOBAL bit32
22478 tdsaDiscoveryIntStartIDDev(tiRoot_t                  *tiRoot,
22479                            tiIORequest_t             *tiIORequest, /* agNULL */
22480                            tiDeviceHandle_t          *tiDeviceHandle,
22481                            tiScsiInitiatorRequest_t  *tiScsiRequest, /* agNULL */
22482                            satIOContext_t            *satIOContext
22483                            )
22484 {
22485   satInternalIo_t           *satIntIo = agNULL;
22486   satDeviceData_t           *satDevData = agNULL;
22487   tdIORequestBody_t         *tdIORequestBody;
22488   satIOContext_t            *satNewIOContext;
22489   bit32                     status;
22490
22491   TI_DBG3(("tdsaDiscoveryIntStartIDDev: start\n"));
22492
22493   satDevData = satIOContext->pSatDevData;
22494
22495   /* allocate identify device command */
22496   satIntIo = satAllocIntIoResource( tiRoot,
22497                                     tiIORequest,
22498                                     satDevData,
22499                                     sizeof(agsaSATAIdentifyData_t), /* 512; size of identify device data */
22500                                     satIntIo);
22501
22502   if (satIntIo == agNULL)
22503   {
22504     TI_DBG2(("tdsaDiscoveryIntStartIDDev: can't alloacate\n"));
22505
22506     return tiError;
22507   }
22508
22509   /* fill in fields */
22510   /* real ttttttthe one worked and the same; 5/21/07/ */
22511   satIntIo->satOrgTiIORequest = tiIORequest; /* changed */
22512   tdIORequestBody = satIntIo->satIntRequestBody;
22513   satNewIOContext = &(tdIORequestBody->transport.SATA.satIOContext);
22514
22515   satNewIOContext->pSatDevData   = satDevData;
22516   satNewIOContext->pFis          = &(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev);
22517   satNewIOContext->pScsiCmnd     = &(satIntIo->satIntTiScsiXchg.scsiCmnd);
22518   satNewIOContext->pSense        = &(tdIORequestBody->transport.SATA.sensePayload);
22519   satNewIOContext->pTiSenseData  = &(tdIORequestBody->transport.SATA.tiSenseData);
22520   satNewIOContext->tiRequestBody = satIntIo->satIntRequestBody; /* key fix */
22521   satNewIOContext->interruptContext = tiInterruptContext;
22522   satNewIOContext->satIntIoContext  = satIntIo;
22523
22524   satNewIOContext->ptiDeviceHandle = agNULL;
22525   satNewIOContext->satOrgIOContext = satIOContext; /* changed */
22526
22527   /* this is valid only for TD layer generated (not triggered by OS at all) IO */
22528   satNewIOContext->tiScsiXchg = &(satIntIo->satIntTiScsiXchg);
22529
22530
22531   TI_DBG6(("tdsaDiscoveryIntStartIDDev: OS satIOContext %p \n", satIOContext));
22532   TI_DBG6(("tdsaDiscoveryIntStartIDDev: TD satNewIOContext %p \n", satNewIOContext));
22533   TI_DBG6(("tdsaDiscoveryIntStartIDDev: OS tiScsiXchg %p \n", satIOContext->tiScsiXchg));
22534   TI_DBG6(("tdsaDiscoveryIntStartIDDev: TD tiScsiXchg %p \n", satNewIOContext->tiScsiXchg));
22535
22536
22537
22538   TI_DBG3(("tdsaDiscoveryIntStartIDDev: satNewIOContext %p tdIORequestBody %p\n", satNewIOContext, tdIORequestBody));
22539
22540   status = tdsaDiscoverySendIDDev(tiRoot,
22541                                   &satIntIo->satIntTiIORequest, /* New tiIORequest */
22542                                   tiDeviceHandle,
22543                                   satNewIOContext->tiScsiXchg, /* New tiScsiInitiatorRequest_t *tiScsiRequest, */
22544                                   satNewIOContext);
22545
22546   if (status != tiSuccess)
22547   {
22548     TI_DBG1(("tdsaDiscoveryIntStartIDDev: failed in sending %d\n", status));
22549
22550     satFreeIntIoResource( tiRoot,
22551                           satDevData,
22552                           satIntIo);
22553
22554     return tiError;
22555   }
22556
22557
22558   TI_DBG6(("tdsaDiscoveryIntStartIDDev: end\n"));
22559
22560   return status;
22561 }
22562
22563
22564 /*****************************************************************************/
22565 /*! \brief SAT implementation for tdsaDiscoverySendIDDev.
22566  *
22567  *  This function prepares identify device data FIS and sends it to SATA device.
22568  *
22569  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
22570  *  \param   tiIORequest:      Pointer to TISA I/O request context for this I/O.
22571  *  \param   tiDeviceHandle:   Pointer to TISA device handle for this I/O.
22572  *  \param   tiScsiRequest:    Pointer to TISA SCSI I/O request and SGL list.
22573  *  \param   satIOContext_t:   Pointer to the SAT IO Context
22574  *
22575  *  \return If command is started successfully
22576  *    - \e tiSuccess:     I/O request successfully initiated.
22577  *    - \e tiBusy:        No resources available, try again later.
22578  *    - \e tiIONoDevice:  Invalid device handle.
22579  *    - \e tiError:       Other errors.
22580  */
22581 /*****************************************************************************/
22582 GLOBAL bit32
22583 tdsaDiscoverySendIDDev(tiRoot_t                  *tiRoot,
22584                        tiIORequest_t             *tiIORequest,
22585                        tiDeviceHandle_t          *tiDeviceHandle,
22586                        tiScsiInitiatorRequest_t  *tiScsiRequest,
22587                        satIOContext_t            *satIOContext
22588                        )
22589 {
22590   bit32                     status;
22591   bit32                     agRequestType;
22592   satDeviceData_t           *pSatDevData;
22593   agsaFisRegHostToDevice_t  *fis;
22594 #ifdef  TD_DEBUG_ENABLE
22595   tdIORequestBody_t         *tdIORequestBody;
22596   satInternalIo_t           *satIntIoContext;
22597 #endif
22598
22599   pSatDevData   = satIOContext->pSatDevData;
22600   fis           = satIOContext->pFis;
22601   TI_DBG3(("tdsaDiscoverySendIDDev: start\n"));
22602 #ifdef  TD_DEBUG_ENABLE
22603   satIntIoContext = satIOContext->satIntIoContext;
22604   tdIORequestBody = satIntIoContext->satIntRequestBody;
22605 #endif
22606   TI_DBG5(("tdsaDiscoverySendIDDev: satIOContext %p tdIORequestBody %p\n", satIOContext, tdIORequestBody));
22607
22608   fis->h.fisType        = 0x27;                   /* Reg host to device */
22609   fis->h.c_pmPort       = 0x80;                   /* C Bit is set */
22610   if (pSatDevData->satDeviceType == SATA_ATAPI_DEVICE)
22611       fis->h.command    = SAT_IDENTIFY_PACKET_DEVICE;  /* 0xA1 */
22612   else
22613       fis->h.command    = SAT_IDENTIFY_DEVICE;    /* 0xEC */
22614   fis->h.features       = 0;                      /* FIS reserve */
22615   fis->d.lbaLow         = 0;                      /* FIS LBA (7 :0 ) */
22616   fis->d.lbaMid         = 0;                      /* FIS LBA (15:8 ) */
22617   fis->d.lbaHigh        = 0;                      /* FIS LBA (23:16) */
22618   fis->d.device         = 0;                      /* FIS LBA mode  */
22619   fis->d.lbaLowExp      = 0;
22620   fis->d.lbaMidExp      = 0;
22621   fis->d.lbaHighExp     = 0;
22622   fis->d.featuresExp    = 0;
22623   fis->d.sectorCount    = 0;                      /* FIS sector count (7:0) */
22624   fis->d.sectorCountExp = 0;
22625   fis->d.reserved4      = 0;
22626   fis->d.control        = 0;                      /* FIS HOB bit clear */
22627   fis->d.reserved5      = 0;
22628
22629   agRequestType = AGSA_SATA_PROTOCOL_PIO_READ;
22630
22631   /* Initialize CB for SATA completion.
22632    */
22633   satIOContext->satCompleteCB = &tdsaDiscoveryStartIDDevCB;
22634
22635   /*
22636    * Prepare SGL and send FIS to LL layer.
22637    */
22638   satIOContext->reqType = agRequestType;       /* Save it */
22639
22640 #ifdef TD_INTERNAL_DEBUG
22641   tdhexdump("tdsaDiscoverySendIDDev", (bit8 *)satIOContext->pFis, sizeof(agsaFisRegHostToDevice_t));
22642 #ifdef  TD_DEBUG_ENABLE
22643   tdhexdump("tdsaDiscoverySendIDDev LL", (bit8 *)&(tdIORequestBody->transport.SATA.agSATARequestBody.fis.fisRegHostToDev), sizeof(agsaFisRegHostToDevice_t));
22644 #endif
22645 #endif
22646   status = sataLLIOStart( tiRoot,
22647                           tiIORequest,
22648                           tiDeviceHandle,
22649                           tiScsiRequest,
22650                           satIOContext);
22651   TI_DBG3(("tdsaDiscoverySendIDDev: end status %d\n", status));
22652   return status;
22653 }
22654
22655
22656 /*****************************************************************************
22657 *! \brief  tdsaDiscoveryStartIDDevCB
22658 *
22659 *   This routine is a callback function for tdsaDiscoverySendIDDev()
22660 *   Using Identify Device Data, this function finds whether devicedata is
22661 *   new or old. If new, add it to the devicelist. This is done as a part
22662 *   of discovery.
22663 *
22664 *  \param   agRoot:      Handles for this instance of SAS/SATA hardware
22665 *  \param   agIORequest: Pointer to the LL I/O request context for this I/O.
22666 *  \param   agIOStatus:  Status of completed I/O.
22667 *  \param   agFirstDword:Pointer to the four bytes of FIS.
22668 *  \param   agIOInfoLen: Length in bytes of overrun/underrun residual or FIS
22669 *                        length.
22670 *  \param   agParam:     Additional info based on status.
22671 *  \param   ioContext:   Pointer to satIOContext_t.
22672 *
22673 *  \return: none
22674 *
22675 *****************************************************************************/
22676 void tdsaDiscoveryStartIDDevCB(
22677                                agsaRoot_t        *agRoot,
22678                                agsaIORequest_t   *agIORequest,
22679                                 bit32             agIOStatus,
22680                                 agsaFisHeader_t   *agFirstDword,
22681                                 bit32             agIOInfoLen,
22682                                 void              *agParam,
22683                                 void              *ioContext
22684                                 )
22685 {
22686  /*
22687     In the process of SAT_IDENTIFY_DEVICE during discovery
22688   */
22689   tdsaRootOsData_t        *osData = (tdsaRootOsData_t *)agRoot->osData;
22690   tiRoot_t                *tiRoot = (tiRoot_t *)osData->tiRoot;
22691   tdsaRoot_t              *tdsaRoot        = (tdsaRoot_t *) tiRoot->tdData;
22692   tdsaContext_t           *tdsaAllShared = (tdsaContext_t *)&tdsaRoot->tdsaAllShared;
22693   tdIORequestBody_t       *tdIORequestBody;
22694   tdIORequestBody_t       *tdOrgIORequestBody;
22695   satIOContext_t          *satIOContext;
22696   satIOContext_t          *satOrgIOContext;
22697   satIOContext_t          *satNewIOContext;
22698   satInternalIo_t         *satIntIo;
22699   satInternalIo_t         *satNewIntIo = agNULL;
22700   satDeviceData_t         *satDevData;
22701   tiIORequest_t           *tiOrgIORequest = agNULL;
22702
22703 #ifdef  TD_DEBUG_ENABLE
22704   bit32                     ataStatus = 0;
22705   bit32                     ataError;
22706   agsaFisPioSetupHeader_t   *satPIOSetupHeader = agNULL;
22707 #endif
22708   agsaSATAIdentifyData_t    *pSATAIdData;
22709   bit16                     *tmpptr, tmpptr_tmp;
22710   bit32                     x;
22711   tdsaDeviceData_t          *oneDeviceData = agNULL;
22712   void                      *sglVirtualAddr;
22713   tdsaPortContext_t         *onePortContext = agNULL;
22714   tiPortalContext_t         *tiPortalContext = agNULL;
22715   bit32                     retry_status;
22716
22717   TI_DBG3(("tdsaDiscoveryStartIDDevCB: start\n"));
22718
22719   tdIORequestBody        = (tdIORequestBody_t *)agIORequest->osData;
22720   satIOContext           = (satIOContext_t *) ioContext;
22721   satIntIo               = satIOContext->satIntIoContext;
22722   satDevData             = satIOContext->pSatDevData;
22723   oneDeviceData = (tdsaDeviceData_t *)tdIORequestBody->tiDevHandle->tdData;
22724   TI_DBG3(("tdsaDiscoveryStartIDDevCB: did %d\n", oneDeviceData->id));
22725   onePortContext = oneDeviceData->tdPortContext;
22726   if (onePortContext == agNULL)
22727   {
22728       TI_DBG1(("tdsaDiscoveryStartIDDevCB: onePortContext is NULL\n"));
22729       return;
22730   }
22731   tiPortalContext= onePortContext->tiPortalContext;
22732
22733   satDevData->IDDeviceValid = agFALSE;
22734
22735   if (satIntIo == agNULL)
22736   {
22737     TI_DBG1(("tdsaDiscoveryStartIDDevCB: External, OS generated\n"));
22738     TI_DBG1(("tdsaDiscoveryStartIDDevCB: Not possible case\n"));
22739     satOrgIOContext      = satIOContext;
22740     tdOrgIORequestBody     = (tdIORequestBody_t *)satOrgIOContext->tiRequestBody;
22741
22742     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
22743
22744     satFreeIntIoResource( tiRoot,
22745                           satDevData,
22746                           satIntIo);
22747
22748     /* clean up TD layer's IORequestBody */
22749     ostiFreeMemory(
22750                    tiRoot,
22751                    tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22752                    sizeof(tdIORequestBody_t)
22753                    );
22754     return;
22755   }
22756   else
22757   {
22758     TI_DBG3(("tdsaDiscoveryStartIDDevCB: Internal, TD generated\n"));
22759     satOrgIOContext        = satIOContext->satOrgIOContext;
22760     if (satOrgIOContext == agNULL)
22761     {
22762       TI_DBG6(("tdsaDiscoveryStartIDDevCB: satOrgIOContext is NULL\n"));
22763       return;
22764     }
22765     else
22766     {
22767       TI_DBG6(("tdsaDiscoveryStartIDDevCB: satOrgIOContext is NOT NULL\n"));
22768       tdOrgIORequestBody     = (tdIORequestBody_t *)satOrgIOContext->tiRequestBody;
22769       sglVirtualAddr         = satIntIo->satIntTiScsiXchg.sglVirtualAddr;
22770     }
22771   }
22772
22773   tiOrgIORequest           = tdIORequestBody->tiIORequest;
22774   tdIORequestBody->ioCompleted = agTRUE;
22775   tdIORequestBody->ioStarted = agFALSE;
22776
22777   TI_DBG3(("tdsaDiscoveryStartIDDevCB: satOrgIOContext->pid %d\n", satOrgIOContext->pid));
22778
22779   /* protect against double completion for old port */
22780   if (satOrgIOContext->pid != oneDeviceData->tdPortContext->id)
22781   {
22782     TI_DBG3(("tdsaDiscoveryStartIDDevCB: incorrect pid\n"));
22783     TI_DBG3(("tdsaDiscoveryStartIDDevCB: satOrgIOContext->pid %d\n", satOrgIOContext->pid));
22784     TI_DBG3(("tdsaDiscoveryStartIDDevCB: tiPortalContext pid %d\n", oneDeviceData->tdPortContext->id));
22785
22786     satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
22787
22788     satFreeIntIoResource( tiRoot,
22789                           satDevData,
22790                           satIntIo);
22791
22792     /* clean up TD layer's IORequestBody */
22793     ostiFreeMemory(
22794                    tiRoot,
22795                    tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22796                    sizeof(tdIORequestBody_t)
22797                    );
22798
22799     return;
22800   }
22801
22802   /* completion after portcontext is invalidated */
22803   if (onePortContext != agNULL)
22804   {
22805     if (onePortContext->valid == agFALSE)
22806     {
22807       TI_DBG1(("tdsaDiscoveryStartIDDevCB: portcontext is invalid\n"));
22808       TI_DBG1(("tdsaDiscoveryStartIDDevCB: onePortContext->id pid %d\n", onePortContext->id));
22809       satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
22810
22811       satFreeIntIoResource( tiRoot,
22812                             satDevData,
22813                             satIntIo);
22814
22815       /* clean up TD layer's IORequestBody */
22816       ostiFreeMemory(
22817                      tiRoot,
22818                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22819                      sizeof(tdIORequestBody_t)
22820                      );
22821
22822       /* no notification to OS layer */
22823       return;
22824     }
22825   }
22826
22827   if (agFirstDword == agNULL && agIOStatus != OSSA_IO_SUCCESS)
22828   {
22829     TI_DBG1(("tdsaDiscoveryStartIDDevCB: agFirstDword is NULL when error, status %d\n", agIOStatus));
22830     TI_DBG1(("tdsaDiscoveryStartIDDevCB: did %d\n", oneDeviceData->id));
22831
22832     if (tdsaAllShared->ResetInDiscovery != 0 && satDevData->ID_Retries < SATA_ID_DEVICE_DATA_RETRIES)
22833     {
22834       satIOContext->pSatDevData->satPendingNONNCQIO--;
22835       satIOContext->pSatDevData->satPendingIO--;
22836       retry_status = sataLLIOStart(tiRoot,
22837                                    &satIntIo->satIntTiIORequest,
22838            &(oneDeviceData->tiDeviceHandle),
22839            satIOContext->tiScsiXchg,
22840            satIOContext);
22841       if (retry_status != tiSuccess)
22842       {
22843         /* simply give up */
22844         satDevData->ID_Retries = 0;
22845         satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
22846
22847         satFreeIntIoResource( tiRoot,
22848                               satDevData,
22849                               satIntIo);
22850
22851         /* clean up TD layer's IORequestBody */
22852         ostiFreeMemory(
22853                        tiRoot,
22854                        tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22855                        sizeof(tdIORequestBody_t)
22856                        );
22857         return;
22858       }
22859       satDevData->ID_Retries++;
22860       tdIORequestBody->ioCompleted = agFALSE;
22861       tdIORequestBody->ioStarted = agTRUE;
22862       return;
22863     }
22864     else
22865     {
22866       satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
22867       satFreeIntIoResource( tiRoot,
22868                             satDevData,
22869                             satIntIo);
22870
22871       /* clean up TD layer's IORequestBody */
22872       ostiFreeMemory(
22873                      tiRoot,
22874                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22875                      sizeof(tdIORequestBody_t)
22876                      );
22877       if (tdsaAllShared->ResetInDiscovery != 0)
22878       {
22879         /* ResetInDiscovery in on */
22880         if (satDevData->NumOfIDRetries <= 0)
22881         {
22882           satDevData->NumOfIDRetries++;
22883           satDevData->ID_Retries = 0;
22884           /* send link reset */
22885           tdsaPhyControlSend(tiRoot,
22886                              oneDeviceData,
22887                              SMP_PHY_CONTROL_HARD_RESET,
22888                              agNULL,
22889                              tdsaRotateQnumber(tiRoot, oneDeviceData)
22890                             );
22891         }
22892       }
22893       return;
22894     }
22895   }
22896
22897   if (agIOStatus == OSSA_IO_ABORTED ||
22898       agIOStatus == OSSA_IO_UNDERFLOW ||
22899       agIOStatus == OSSA_IO_XFER_ERROR_BREAK ||
22900       agIOStatus == OSSA_IO_XFER_ERROR_PHY_NOT_READY ||
22901       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED ||
22902       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_BREAK ||
22903       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS ||
22904       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_BAD_DESTINATION ||
22905       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED ||
22906       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_STP_RESOURCES_BUSY ||
22907       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_WRONG_DESTINATION ||
22908       agIOStatus == OSSA_IO_XFER_ERROR_NAK_RECEIVED ||
22909       agIOStatus == OSSA_IO_XFER_ERROR_DMA ||
22910       agIOStatus == OSSA_IO_XFER_ERROR_SATA_LINK_TIMEOUT ||
22911       agIOStatus == OSSA_IO_XFER_ERROR_REJECTED_NCQ_MODE ||
22912       agIOStatus == OSSA_IO_XFER_OPEN_RETRY_TIMEOUT ||
22913       agIOStatus == OSSA_IO_NO_DEVICE ||
22914       agIOStatus == OSSA_IO_OPEN_CNX_ERROR_ZONE_VIOLATION ||
22915       agIOStatus == OSSA_IO_PORT_IN_RESET ||
22916       agIOStatus == OSSA_IO_DS_NON_OPERATIONAL ||
22917       agIOStatus == OSSA_IO_DS_IN_RECOVERY ||
22918       agIOStatus == OSSA_IO_DS_IN_ERROR
22919       )
22920   {
22921     TI_DBG1(("tdsaDiscoveryStartIDDevCB: OSSA_IO_OPEN_CNX_ERROR 0x%x\n", agIOStatus));
22922     if (tdsaAllShared->ResetInDiscovery != 0 && satDevData->ID_Retries < SATA_ID_DEVICE_DATA_RETRIES)
22923     {
22924       satIOContext->pSatDevData->satPendingNONNCQIO--;
22925       satIOContext->pSatDevData->satPendingIO--;
22926       retry_status = sataLLIOStart(tiRoot,
22927                                    &satIntIo->satIntTiIORequest,
22928            &(oneDeviceData->tiDeviceHandle),
22929            satIOContext->tiScsiXchg,
22930            satIOContext);
22931       if (retry_status != tiSuccess)
22932       {
22933         /* simply give up */
22934         satDevData->ID_Retries = 0;
22935         satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
22936
22937         satFreeIntIoResource( tiRoot,
22938                               satDevData,
22939                               satIntIo);
22940
22941         /* clean up TD layer's IORequestBody */
22942         ostiFreeMemory(
22943                        tiRoot,
22944                        tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22945                        sizeof(tdIORequestBody_t)
22946                        );
22947         return;
22948       }
22949       satDevData->ID_Retries++;
22950       tdIORequestBody->ioCompleted = agFALSE;
22951       tdIORequestBody->ioStarted = agTRUE;
22952       return;
22953     }
22954     else
22955     {
22956       satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
22957       satFreeIntIoResource( tiRoot,
22958                             satDevData,
22959                             satIntIo);
22960
22961       /* clean up TD layer's IORequestBody */
22962       ostiFreeMemory(
22963                      tiRoot,
22964                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
22965                      sizeof(tdIORequestBody_t)
22966                      );
22967       if (tdsaAllShared->ResetInDiscovery != 0)
22968       {
22969         /* ResetInDiscovery in on */
22970         if (satDevData->NumOfIDRetries <= 0)
22971         {
22972           satDevData->NumOfIDRetries++;
22973           satDevData->ID_Retries = 0;
22974           /* send link reset */
22975           tdsaPhyControlSend(tiRoot,
22976                              oneDeviceData,
22977                              SMP_PHY_CONTROL_HARD_RESET,
22978                              agNULL,
22979                              tdsaRotateQnumber(tiRoot, oneDeviceData)
22980                             );
22981         }
22982       }
22983       return;
22984     }
22985   }
22986
22987   if ( agIOStatus != OSSA_IO_SUCCESS ||
22988        (agIOStatus == OSSA_IO_SUCCESS && agFirstDword != agNULL && agIOInfoLen != 0)
22989      )
22990   {
22991 #ifdef  TD_DEBUG_ENABLE
22992     /* only agsaFisPioSetup_t is expected */
22993     satPIOSetupHeader = (agsaFisPioSetupHeader_t *)&(agFirstDword->PioSetup);
22994     ataStatus     = satPIOSetupHeader->status;   /* ATA Status register */
22995     ataError      = satPIOSetupHeader->error;    /* ATA Eror register   */
22996 #endif
22997     TI_DBG1(("tdsaDiscoveryStartIDDevCB: ataStatus 0x%x ataError 0x%x\n", ataStatus, ataError));
22998
22999     if (tdsaAllShared->ResetInDiscovery != 0 && satDevData->ID_Retries < SATA_ID_DEVICE_DATA_RETRIES)
23000     {
23001       satIOContext->pSatDevData->satPendingNONNCQIO--;
23002       satIOContext->pSatDevData->satPendingIO--;
23003       retry_status = sataLLIOStart(tiRoot,
23004                                    &satIntIo->satIntTiIORequest,
23005            &(oneDeviceData->tiDeviceHandle),
23006            satIOContext->tiScsiXchg,
23007            satIOContext);
23008       if (retry_status != tiSuccess)
23009       {
23010         /* simply give up */
23011         satDevData->ID_Retries = 0;
23012         satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
23013
23014         satFreeIntIoResource( tiRoot,
23015                               satDevData,
23016                               satIntIo);
23017
23018         /* clean up TD layer's IORequestBody */
23019         ostiFreeMemory(
23020                        tiRoot,
23021                        tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
23022                        sizeof(tdIORequestBody_t)
23023                        );
23024         return;
23025       }
23026       satDevData->ID_Retries++;
23027       tdIORequestBody->ioCompleted = agFALSE;
23028       tdIORequestBody->ioStarted = agTRUE;
23029       return;
23030     }
23031     else
23032     {
23033       satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
23034       satFreeIntIoResource( tiRoot,
23035                             satDevData,
23036                             satIntIo);
23037
23038       /* clean up TD layer's IORequestBody */
23039       ostiFreeMemory(
23040                      tiRoot,
23041                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
23042                      sizeof(tdIORequestBody_t)
23043                      );
23044       if (tdsaAllShared->ResetInDiscovery != 0)
23045       {
23046         /* ResetInDiscovery in on */
23047         if (satDevData->NumOfIDRetries <= 0)
23048         {
23049           satDevData->NumOfIDRetries++;
23050           satDevData->ID_Retries = 0;
23051           /* send link reset */
23052           tdsaPhyControlSend(tiRoot,
23053                              oneDeviceData,
23054                              SMP_PHY_CONTROL_HARD_RESET,
23055                              agNULL,
23056                              tdsaRotateQnumber(tiRoot, oneDeviceData)
23057                             );
23058         }
23059       }
23060       return;
23061     }
23062   }
23063
23064
23065   /* success */
23066   TI_DBG3(("tdsaDiscoveryStartIDDevCB: Success\n"));
23067   TI_DBG3(("tdsaDiscoveryStartIDDevCB: Success did %d\n", oneDeviceData->id));
23068
23069   /* Convert to host endian */
23070   tmpptr = (bit16*)sglVirtualAddr;
23071   for (x=0; x < sizeof(agsaSATAIdentifyData_t)/sizeof(bit16); x++)
23072   {
23073     OSSA_READ_LE_16(AGROOT, &tmpptr_tmp, tmpptr, 0);
23074     *tmpptr = tmpptr_tmp;
23075     tmpptr++;
23076   }
23077
23078   pSATAIdData = (agsaSATAIdentifyData_t *)sglVirtualAddr;
23079   //tdhexdump("satAddSATAIDDevCB before", (bit8 *)pSATAIdData, sizeof(agsaSATAIdentifyData_t));
23080
23081   TI_DBG5(("tdsaDiscoveryStartIDDevCB: OS satOrgIOContext %p \n", satOrgIOContext));
23082   TI_DBG5(("tdsaDiscoveryStartIDDevCB: TD satIOContext %p \n", satIOContext));
23083   TI_DBG5(("tdsaDiscoveryStartIDDevCB: OS tiScsiXchg %p \n", satOrgIOContext->tiScsiXchg));
23084   TI_DBG5(("tdsaDiscoveryStartIDDevCB: TD tiScsiXchg %p \n", satIOContext->tiScsiXchg));
23085
23086
23087    /* copy ID Dev data to satDevData */
23088   satDevData->satIdentifyData = *pSATAIdData;
23089   satDevData->IDDeviceValid = agTRUE;
23090
23091 #ifdef TD_INTERNAL_DEBUG
23092   tdhexdump("tdsaDiscoveryStartIDDevCB ID Dev data",(bit8 *)pSATAIdData, sizeof(agsaSATAIdentifyData_t));
23093   tdhexdump("tdsaDiscoveryStartIDDevCB Device ID Dev data",(bit8 *)&satDevData->satIdentifyData, sizeof(agsaSATAIdentifyData_t));
23094 #endif
23095
23096   /* set satDevData fields from IndentifyData */
23097   satSetDevInfo(satDevData,pSATAIdData);
23098   satDecrementPendingIO(tiRoot, tdsaAllShared, satIOContext);
23099
23100   satFreeIntIoResource( tiRoot,
23101                         satDevData,
23102                         satIntIo);
23103
23104   if (satDevData->satDeviceType == SATA_ATAPI_DEVICE)
23105   {
23106       /* send the Set Feature ATA command to ATAPI device for enbling PIO and DMA transfer mode*/
23107       satNewIntIo = satAllocIntIoResource( tiRoot,
23108                                        tiOrgIORequest,
23109                                        satDevData,
23110                                        0,
23111                                        satNewIntIo);
23112
23113       if (satNewIntIo == agNULL)
23114       {
23115         TI_DBG1(("tdsaDiscoveryStartIDDevCB: momory allocation fails\n"));
23116           /* clean up TD layer's IORequestBody */
23117         ostiFreeMemory(
23118                      tiRoot,
23119                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
23120                      sizeof(tdIORequestBody_t)
23121                      );
23122         return;
23123       } /* end memory allocation */
23124
23125       satNewIOContext = satPrepareNewIO(satNewIntIo,
23126                                         tiOrgIORequest,
23127                                         satDevData,
23128                                         agNULL,
23129                                         satOrgIOContext
23130                                         );
23131       /* enable PIO mode, then enable Ultra DMA mode in the satSetFeaturesCB callback function*/
23132       retry_status = satSetFeatures(tiRoot,
23133                                  &satNewIntIo->satIntTiIORequest,
23134                                  satNewIOContext->ptiDeviceHandle,
23135                                  &satNewIntIo->satIntTiScsiXchg, /* orginal from OS layer */
23136                                  satNewIOContext,
23137                                  agFALSE);
23138       if (retry_status != tiSuccess)
23139       {
23140           satFreeIntIoResource(tiRoot, satDevData, satIntIo);
23141           /* clean up TD layer's IORequestBody */
23142           ostiFreeMemory(
23143                  tiRoot,
23144                  tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
23145                  sizeof(tdIORequestBody_t)
23146                  );
23147       }
23148   }
23149   else
23150   {
23151       /* clean up TD layer's IORequestBody */
23152       ostiFreeMemory(
23153                      tiRoot,
23154                      tdOrgIORequestBody->IOType.InitiatorTMIO.osMemHandle,
23155                      sizeof(tdIORequestBody_t)
23156                      );
23157       if (onePortContext != agNULL)
23158       {
23159         if (onePortContext->DiscoveryState == ITD_DSTATE_COMPLETED)
23160         {
23161           TI_DBG1(("tdsaDiscoveryStartIDDevCB: ID completed after discovery is done; tiDeviceArrival\n"));
23162           /* in case registration is finished after discovery is finished */
23163           ostiInitiatorEvent(
23164                              tiRoot,
23165                              tiPortalContext,
23166                              agNULL,
23167                              tiIntrEventTypeDeviceChange,
23168                              tiDeviceArrival,
23169                              agNULL
23170                              );
23171         }
23172       }
23173       else
23174       {
23175         TI_DBG1(("tdsaDiscoveryStartIDDevCB: onePortContext is NULL, wrong\n"));
23176       }
23177   }
23178   TI_DBG3(("tdsaDiscoveryStartIDDevCB: end\n"));
23179   return;
23180 }
23181 /*****************************************************************************
23182 *! \brief  satAbort
23183 *
23184 *   This routine does local abort for outstanding FIS.
23185 *
23186 *  \param   agRoot:         Handles for this instance of SAS/SATA hardware
23187 *  \param   satIOContext:   Pointer to satIOContext_t.
23188 *
23189 *  \return: none
23190 *
23191 *****************************************************************************/
23192 GLOBAL void satAbort(agsaRoot_t        *agRoot,
23193                      satIOContext_t    *satIOContext)
23194 {
23195   tdsaRootOsData_t        *osData = (tdsaRootOsData_t *)agRoot->osData;
23196   tiRoot_t                *tiRoot = (tiRoot_t *)osData->tiRoot;
23197   tdIORequestBody_t       *tdIORequestBody; /* io to be aborted */
23198   tdIORequestBody_t       *tdAbortIORequestBody; /* abort io itself */
23199   agsaIORequest_t         *agToBeAbortedIORequest; /* io to be aborted */
23200   agsaIORequest_t         *agAbortIORequest;  /* abort io itself */
23201   bit32                   PhysUpper32;
23202   bit32                   PhysLower32;
23203   bit32                   memAllocStatus;
23204   void                    *osMemHandle;
23205
23206   TI_DBG1(("satAbort: start\n"));
23207
23208   if (satIOContext == agNULL)
23209   {
23210     TI_DBG1(("satAbort: satIOContext is NULL, wrong\n"));
23211     return;
23212   }
23213   tdIORequestBody = (tdIORequestBody_t *)satIOContext->tiRequestBody;
23214   agToBeAbortedIORequest = (agsaIORequest_t *)&(tdIORequestBody->agIORequest);
23215   /* allocating agIORequest for abort itself */
23216   memAllocStatus = ostiAllocMemory(
23217                                    tiRoot,
23218                                    &osMemHandle,
23219                                    (void **)&tdAbortIORequestBody,
23220                                    &PhysUpper32,
23221                                    &PhysLower32,
23222                                    8,
23223                                    sizeof(tdIORequestBody_t),
23224                                    agTRUE
23225                                    );
23226
23227   if (memAllocStatus != tiSuccess)
23228   {
23229     /* let os process IO */
23230     TI_DBG1(("satAbort: ostiAllocMemory failed...\n"));
23231     return;
23232   }
23233
23234   if (tdAbortIORequestBody == agNULL)
23235   {
23236     /* let os process IO */
23237     TI_DBG1(("satAbort: ostiAllocMemory returned NULL tdAbortIORequestBody\n"));
23238     return;
23239   }
23240   /* setup task management structure */
23241   tdAbortIORequestBody->IOType.InitiatorTMIO.osMemHandle = osMemHandle;
23242   tdAbortIORequestBody->tiDevHandle = tdIORequestBody->tiDevHandle;
23243
23244   /* initialize agIORequest */
23245   agAbortIORequest = &(tdAbortIORequestBody->agIORequest);
23246   agAbortIORequest->osData = (void *) tdAbortIORequestBody;
23247   agAbortIORequest->sdkData = agNULL; /* LL takes care of this */
23248
23249
23250   /*
23251    * Issue abort
23252    */
23253   saSATAAbort( agRoot, agAbortIORequest, 0, agNULL, 0, agToBeAbortedIORequest, agNULL );
23254
23255
23256   TI_DBG1(("satAbort: end\n"));
23257   return;
23258 }
23259
23260 /*****************************************************************************
23261  *! \brief  satSATADeviceReset
23262  *
23263  *   This routine is called to reset all phys of port which a device belongs to
23264  *
23265  *  \param   tiRoot:           Pointer to TISA initiator driver/port instance.
23266  *  \param   oneDeviceData:    Pointer to the device data.
23267  *  \param   flag:             reset flag
23268  *
23269  *  \return:
23270  *
23271  *  none
23272  *
23273  *****************************************************************************/
23274 osGLOBAL void
23275 satSATADeviceReset(                                                                                                  tiRoot_t            *tiRoot,
23276                 tdsaDeviceData_t    *oneDeviceData,
23277                 bit32               flag)
23278 {
23279   agsaRoot_t              *agRoot;
23280   tdsaPortContext_t       *onePortContext;
23281   bit32                   i;
23282
23283   TI_DBG1(("satSATADeviceReset: start\n"));
23284   agRoot         = oneDeviceData->agRoot;
23285   onePortContext = oneDeviceData->tdPortContext;
23286
23287   if (agRoot == agNULL)
23288   {
23289     TI_DBG1(("satSATADeviceReset: Error!!! agRoot is NULL\n"));
23290     return;
23291   }
23292   if (onePortContext == agNULL)
23293   {
23294     TI_DBG1(("satSATADeviceReset: Error!!! onePortContext is NULL\n"));
23295     return;
23296   }
23297
23298    for(i=0;i<TD_MAX_NUM_PHYS;i++)
23299   {
23300     if (onePortContext->PhyIDList[i] == agTRUE)
23301     {
23302       saLocalPhyControl(agRoot, agNULL, tdsaRotateQnumber(tiRoot, agNULL), i, flag, agNULL);
23303     }
23304   }
23305
23306   return;
23307 }
23308
23309 #endif  /* #ifdef SATA_ENABLE */