原创 DOS下BIOS中断INT13H、IO端口直接编程读取IDE、SATA硬盘的参数和TC语言程序5

     if (ctemp>=0x30 && ctemp<=0x39)

     {

         ctemp=ctemp-0x30;

     }

     else if (ctemp>=0x41 && ctemp<=0x46)

     {

         ctemp=ctemp-55;

     }

     else

     { printf("HBA ADDR char error");       return 0;  }

     HBA_addr+=((unsigned long)ctemp) << (4*(7-i));

  }

  //得到命令行的PORT口

  myPORTnum= atoi(argv[2]);

  if(myPORTnum<0 || myPORTnum>31 ) {printf("PORT NUMBER error!"); return 0; }

  PORT_addr= HBA_addr + 256 + myPORTnum*128;

  printf ("HBA addr=%08lXH  PORT addr=%08lXH \n",HBA_addr,  PORT_addr);

  //读和显示MEM

  memmove( HBA_addr ,   (unsigned long)FP_SEG(&myHBAMEM)*16+(unsigned long)FP_OFF(&myHBAMEM), 256 );  //源，目的，字节数（应为偶数）

  memmove( PORT_addr ,  (unsigned long)FP_SEG(&myHBAPORT)*16+(unsigned long)FP_OFF(&myHBAPORT), 128 );  //源，目的，字节数（应为偶数）

  printf("HBA MEM in hex is:\n");

  mydisplay( (unsigned char *)&myHBAMEM,  256);

  printf("press a key...\n");getchar();

  printf("PORT MEM in hex is:\n");

  mydisplay( (unsigned char *)&myHBAPORT,  128);

  printf("press a key...\n");getchar();

//判断各个取值是否正常 

  if( !(myHBAMEM.ghc >> 31) ) { printf(" ERROR, AHCI NOT ENABLE "); return 0;}

  if( myHBAMEM.bohc ) { printf(" ERROR, BIOS OR OS is controling HBA"); return 0;}

  if( !( myHBAMEM.pi & ((DWORD)1 << myPORTnum) ) ) { printf(" ERROR, NO DEVICE ON THAT PORT"); return 0;}

  if( myHBAPORT.clbu || myHBAPORT.fbu ) { printf(" ERROR, clbu or fbu ERROR"); return 0;}

  if( (!myHBAPORT.clb) || (!myHBAPORT.fb) ) { printf(" ERROR, clb or fb ERROR"); return 0;}

  if( myHBAPORT.is ) { printf(" ERROR, PxIS NOT ZERO"); return 0;}

  if( myHBAPORT.serr ) { printf(" ERROR, PxSERR NOT ZERO"); return 0;}

  if( myHBAPORT.tfd & 0x89 ) { printf(" ERROR, ERR or DRQ or BSY NOT ZERO"); return 0;} 

                          //PxTFD.STS.BSY（bit7）=0，PxTFD.STS.DRQ（bit3）=0，PxTFD.STS.ERR（bit0）＝0

  if( (myHBAPORT.ssts & 0x0f) !=3  ) { printf(" ERROR, PxSSTS.DET is not 3"); return 0;}      //PxSSTS.DET（bit3:0） = 3

  if( (myHBAPORT.cmd & 0x8000)   ) { printf(" ERROR, PxCMD.CR a command is running"); return 0;}    //PxCMD.CR（bit15）=0，FR（bit14）=0

  if( (myHBAPORT.cmd & 0x4000)   ) { printf(" ERROR, PxCMD.FR RFIS is receiving"); return 0;}

  if( myHBAPORT.ci || myHBAPORT.sact   ) { printf(" ERROR, command slot is not all free"); return 0;}

            //这里为简单起见，需SLOT全部空闲！即要使用SLOT0

//把COMMAND HEADER拷入SLOT

  memmove( (unsigned long)FP_SEG(&myCMDHEADER)*16+(unsigned long)FP_OFF(&myCMDHEADER) ,   myHBAPORT.clb,  32 );  //源，目的，字节数（应为偶数）

  printf("HAVE COPY COMMAND HEADER TO SLOT0     press a key...\n");   getchar();

//发送命令

  myWRITEMEM_DWORD( PORT_addr+0x18,  myREADMEM_DWORD( PORT_addr+0x18) | 0x10   );  //设置PxCMD.FRE（bit4）＝1  使能接收FIS 

  printf("HAVE SET PxCMD.FRE     press a key...\n");   getchar();

  printf("PxCMD is %08lX\n",  myREADMEM_DWORD( PORT_addr+0x18));

  myWRITEMEM_DWORD( PORT_addr+0x18,  myREADMEM_DWORD( PORT_addr+0x18) | 0x01   );  //设置PxCMD.ST（bit0）＝1  使能命令运行

  printf("HAVE SET PxCMD.ST      press a key...\n");   getchar();

  printf("PxCMD is %08lX\n",  myREADMEM_DWORD( PORT_addr+0x18));

  myWRITEMEM_DWORD( PORT_addr+0x38,  myHBAPORT.ci | 0x01   );  //写PxCI.CI相应位，让HBA发送命令。这里是SLOT0

//判断命令完成

  delay(1000);  //延时1S

  if( myREADMEM_DWORD(PORT_addr+0x38) )  {printf(" ERROR, PxCI.CI not return zero"); return 0; }  //PxCI.CI必须清零

  if( myREADMEM_DWORD(PORT_addr+0x10) & 0x40000000  ) {printf(" ERROR, PxIS.TFES is 1"); return 0; } //PxIS.TFES（bit30） 不能为1

//显示收到的数据

  printf("data buff in hex is:\n");

  mydisplay(databuff, 256);

  printf("press a key...\n");getchar(); 

  mydisplay(databuff+256, 256);

  return 0;

}