//#define mDelay1uS( )   /* 对于MCS51单片机,通常不需要1uS延时 */

/* 延时2微秒,请根据单片机速度 */
//void mDelay1uS( )
//{
// unsigned char i;
// for ( i = 1; i != 0; i -- );
//}

/* 延时2微秒,请根据单片机速度 */
void mDelayms(UINT32 ms)
{
  UINT32 i;
  while(ms--)for(i=2500;i!=0;i--);
}
void    Delay2us( ){
    UINT8 i;
    for(i=0;i!=8;i++);
}
void   Delay1us( ){
    UINT8 i;
    for(i=0;i!=4;i++);
}
/* 向CH375命令端口写命令数据 */
void CH375_CMD_PORT_d_out( INT8 d_out )
{
 
   Delay2us( );
   IO0DIR|=USB_DATA;//P0.16~P0.23口设置为OUT
   IO0CLR|=0xff<<16;
   IO0SET|=((UINT32) d_out<<16)|USB_A|USB_RD;
   //IO0SET|=USB_A;
   //IO0SET|=USB_RD|USB_A;
   IO0CLR|=USB_WR|USB_CS;
   IO0DIR=IO0DIR;IO0DIR=IO0DIR;
   
   //mDelayms(1);
   
   
   IO0SET=(IO1SET&0xffffffff)|USB_WR|USB_CS|USB_RD;//WR(P0.12)为1,RD(P0.11)=1,CS(P0.13)=1,A0(P0.10)=1;
   IO0CLR|=USB_A;
   IO0DIR &= 0xFF00FFFF;
   Delay2us( );
}

/* 向CH375数据端口写数据 */
void CH375_DAT_PORT_d_out( INT8 d_out )
{
   Delay2us();
   IO0DIR|=USB_DATA;//P0.16~P0.23口设置为OUT
   IO0CLR|=0xff<<16;
   IO0SET|=((UINT32) d_out<<16)|USB_RD;
   IO0CLR|=USB_WR|USB_A|USB_CS;//设置WR(P0.12)为1,RD(P0.11)=0,CS(P0.13)=0,A0(P0.10)=0
   IO0DIR=IO0DIR;IO0DIR=IO0DIR;
   
   IO0SET=(IO1SET&0xffffffff)|USB_WR|USB_CS|USB_RD;//WR(P0.12)为1,RD(P0.11)=1,CS(P0.13)=1,A0(P0.10)=1;
   IO0CLR|=USB_A;
   IO0DIR &= 0xFF00FFFF;
   Delay2us();
}

/* 从CH375命令端口读数据 */
INT8 CH375_DAT_PORT_in( )
{   UINT8 temp;
   Delay2us( );
   
   IO0DIR&=~USB_DATA;//设置P0.16~P0.23口为IN
   IO0SET|=USB_WR;
   IO0CLR|=USB_A|USB_RD|USB_CS;
   
   //IO0CLR|=;
   //IO0DIR=IO0DIR;IO0DIR=IO0DIR;IO0DIR=IO0DIR;
   IO0DIR=IO0DIR;IO0DIR=IO0DIR;
   temp=(IO0PIN&0x00ff0000)>>16;
  
     //delay100ns;
   
   IO0SET|=USB_WR|USB_RD|USB_CS;
   IO0CLR|=USB_A;
   Delay1us( );
   
   return temp;

}

/* 等待CH375中断并获取状态 */
unsigned char mWaitInterrupt( )
{
 unsigned char c;
 while ( CH375_INT_WIRE );  /* 如果CH375的中断引脚输出高电平则等待 */
 CH375_CMD_PORT_d_out( CMD_GET_STATUS);  /* 获取当前中断状态 */
 c = CH375_DAT_PORT_in();  /* 返回中断状态 */
///* if ( c == USB_INT_DISCONNECT )  /* 检测到USB设备断开事件 */
///* else if ( c == USB_INT_CONNECT )  /* 检测到USB设备连接事件 */
 return( c );
}

/* 设置CH375为USB主机方式 */
unsigned char mCH375Init( )
{
 UINT8 i;
//#ifdef TEST_CH375_PORT
 UINT8 c;
 CH375_CMD_PORT_d_out(CMD_CHECK_EXIST);  /* 测试工作状态 */
 CH375_DAT_PORT_d_out( 0x55);  /* 测试数据 */
 c = CH375_DAT_PORT_in();  /* 返回数据应该是测试数据取反 */
 if ( c != 0xaa ) {  /* CH375出错 */
  for ( i = 100; i != 0; i -- ) {  /* 强制数据同步 */
   CH375_CMD_PORT_d_out( CMD_RESET_ALL );  /* CH375执行硬件复位 */
   c = CH375_DAT_PORT_in();  /* 延时 */
  }
  mDelayms( 50 );  /* 延时至少30mS */
 }
//#endif
 CH375_CMD_PORT_d_out( CMD_SET_USB_MODE);  /* 设置USB工作模式 */
 CH375_DAT_PORT_d_out( 6);  /* 模式代码,自动检测USB设备连接 */
 mDelayms(50);
 
 for ( i = 0xff; i != 0; i -- ) {  /* 等待操作成功,通常需要等待10uS-20uS */
  if ( CH375_DAT_PORT_in() == CMD_RET_SUCCESS ) break;  /* 操作成功 */
 }
 if ( i != 0 ) return( 0 );  /* 操作成功 */
 else return( 0xff );  /* CH375出错,例如芯片型号错或者处于串口方式或者不支持 */
}

/* 初始化磁盘 */
unsigned char mInitDisk( )
{
 UINT8 mIntStatus;
 CH375_CMD_PORT_d_out( CMD_DISK_INIT);  /* 初始化USB存储器 */
 mIntStatus = mWaitInterrupt( );  /* 等待中断并获取状态 */
 //if ( mIntStatus == USB_INT_SUCCESS ) return( 0 );  /* U盘已经成功初始化 */
  return  mIntStatus ;  /* 出现错误 */
}

UINT8 ReadCapacity(void)
{
 UINT8 *mBufferPoint;
 UINT8  mIntStatus,mLength;
 CH375_CMD_PORT_d_out( CMD_DISK_SIZE);  /* 读取容量 */
 mBufferPoint=DBUF;
 mIntStatus = mWaitInterrupt( );
 if ( mIntStatus == USB_INT_SUCCESS)
 {  /* USB存储器读数据块,请求数据读出 */
   CH375_CMD_PORT_d_out( CMD_RD_USB_DATA);  /* 从CH375缓冲区读取数据块 */
   mLength = CH375_DAT_PORT_in();  /* 后续数据的长度 */
   while ( mLength ) {  /* 根据长度读取数据 */
    *mBufferPoint = CH375_DAT_PORT_in();  /* 读出数据并保存 */
    mBufferPoint ++;
    mLength --;
   }
  return 1;
    }
    return 0;
}

UINT32 SwapINT32(UINT32 dData)
{
    dData = (dData&0xff)<<24|(dData&0xff00)<<8|(dData&0xff000000)>>24|(dData&0xff0000)>>8;
 return dData;
}

UINT16 SwapINT16(UINT16 dData)
{
    dData = (dData&0xff00)>>8|(dData&0x00ff)<<8;
 return dData;
}

/* 从U盘中读取多个扇区的数据块到缓冲区中 */
UINT8 RBC_Read(UINT32 iLbaStart, UINT8 iSectorCount,UINT8 *mBufferPoint)
/* iLbaStart 是读取的线起始性扇区号, iSectorCount 是读取的扇区数 */
{
 UINT8 mIntStatus;
 UINT16  mBlockCount;
 UINT8 mLength;
 CH375_CMD_PORT_d_out(CMD_DISK_READ);  /* 从USB存储器读数据块 */
 CH375_DAT_PORT_d_out((UINT8)iLbaStart);  /* LBA的最低8位 */
 CH375_DAT_PORT_d_out ((UINT8)( iLbaStart >> 8 ));
 CH375_DAT_PORT_d_out((UINT8)( iLbaStart >> 16 ));
 CH375_DAT_PORT_d_out((UINT8)( iLbaStart >> 24 ));  /* LBA的最高8位 */
 mDelayms(1);
 CH375_DAT_PORT_d_out( iSectorCount);  /* 扇区数 */
 mDelayms(1);
 mBufferPoint = DBUF;  /* 指向缓冲区起始地址 */
 for ( mBlockCount = iSectorCount * CH375_BLK_PER_SEC; mBlockCount != 0; mBlockCount -- ) {  /* 数据块计数 */
  mIntStatus = mWaitInterrupt( );  /* 等待中断并获取状态 */
  if ( mIntStatus == USB_INT_DISK_READ ) {  /* USB存储器读数据块,请求数据读出 */
   CH375_CMD_PORT_d_out(CMD_RD_USB_DATA);  /* 从CH375缓冲区读取数据块 */
   mLength = CH375_DAT_PORT_in();  /* 后续数据的长度 */
/* 通常数据长度是64,有些U盘要求单片机必须在2mS之内取走64字节数据,否则U盘可能数据丢失 */
/* 建议优化下面的循环程序,确保单片机在1mS之内完成64字节的数据传输 */
   if ( mLength ) {  /* 根据长度读取数据 */
    do {  // 对于C51,这个DO+WHILE结构效率高,速度快
     *mBufferPoint = CH375_DAT_PORT_in();  /* 读出数据并保存 */
     mBufferPoint ++;
    } while ( -- mLength );
   }
   CH375_CMD_PORT_d_out( CMD_DISK_RD_GO);  /* 继续执行USB存储器的读操作 */
   mDelayms(10);
  }
  else break;  /* 返回错误状态 */
 }
 if ( mBlockCount == 0 ) mIntStatus = mWaitInterrupt( );  /* 等待中断并获取状态 */
 if ( mIntStatus == USB_INT_SUCCESS ) return 1;  /* 操作成功 */
 else return 0;  /* 操作失败 */
}

/* 将缓冲区中的多个扇区的数据块写入U盘 */
UINT8 RBC_Write( UINT32 iLbaStart, UINT8 iSectorCount,UINT8 *mBufferPoint )
/* iLbaStart 是写入的线起始性扇区号, iSectorCount 是写入的扇区数 */
{
 UINT8 mIntStatus;
 UINT16  mBlockCount;
 UINT8 mLength;
 CH375_CMD_PORT_d_out( CMD_DISK_WRITE);  /* 向USB存储器写数据块 */
 CH375_DAT_PORT_d_out((UINT8)iLbaStart);  /* LBA的最低8位 */
 CH375_DAT_PORT_d_out((UINT8)( iLbaStart >> 8 ));
 CH375_DAT_PORT_d_out((UINT8)( iLbaStart >> 16 ));
 CH375_DAT_PORT_d_out((UINT8)( iLbaStart >> 24 ));  /* LBA的最高8位 */
 CH375_DAT_PORT_d_out(iSectorCount);  /* 扇区数 */
 //mBufferPoint = &DATA_BUFFER;  /* 指向缓冲区起始地址 */
 for ( mBlockCount = iSectorCount * CH375_BLK_PER_SEC; mBlockCount != 0; mBlockCount -- ) {  /* 数据块计数 */
  mIntStatus = mWaitInterrupt( );  /* 等待中断并获取状态 */
  if ( mIntStatus == USB_INT_DISK_WRITE ) {  /* USB存储器写数据块,请求数据写入 */
   CH375_CMD_PORT_d_out( CMD_WR_USB_DATA7);  /* 向CH375缓冲区写入数据块 */
   mLength = CH375_BLOCK_SIZE;
   CH375_DAT_PORT_d_out(mLength);  /* 后续数据的长度 */
/* 通常数据长度是64,有些U盘要求单片机必须在2mS之内写入64字节数据,否则U盘可能数据丢失 */
/* 建议优化下面的循环程序,确保单片机在1mS之内完成64字节的数据传输 */
   do {  // 对于C51,这个DO+WHILE结构效率高,速度快
    CH375_DAT_PORT_d_out(*mBufferPoint);  /* 将数据写入 */
    mBufferPoint ++;
   } while ( -- mLength );
   CH375_CMD_PORT_d_out( CMD_DISK_WR_GO);  /* 继续执行USB存储器的写操作 */
  }
  else break;  /* 返回错误状态 */
 }
 if ( mBlockCount == 0 ) mIntStatus = mWaitInterrupt( );  /* 等待中断并获取状态 */
 if ( mIntStatus == USB_INT_SUCCESS ) return 1;  /* 操作成功 */
 else return 0;  /* 操作失败 */
}

UINT8 mCH375Read( INT8 mAddr )
{
 CH375_CMD_PORT_d_out( 0x0A );
 CH375_DAT_PORT_d_out( mAddr );
 if ( mAddr ) return( CH375_DAT_PORT_in( ) );
 else return( 0 );
}

void mCH375Write( UINT8 mAddr, UINT8 mData )
{
 CH375_CMD_PORT_d_out( 0x0B );
 CH375_DAT_PORT_d_out( mAddr );
 CH375_DAT_PORT_d_out( mData );
}

UINT8 epBulkSend( UINT8 *mBuffer, UINT8 mLength )
{
 UINT8 mBulkOut;
 UINT8  CH375IntStatus;
 CH375_CMD_PORT_d_out( CMD_WR_USB_DATA7 );  /* 向CH375的端点缓冲区写入准备发送的数据 */
 CH375_DAT_PORT_d_out( mLength );  /* 后续数据长度4 */
 while( mLength ) {
  CH375_DAT_PORT_d_out( *mBuffer );
  mBuffer ++;
  mLength --;
 }
 mCH375Write( SFR_USB_H_ENDP, mCH375Read( VAR_UDISK_TOGGLE ) );
 mBulkOut = mCH375Read( VAR_UDISK_BULK_OUT );
 CH375IntStatus = 0;  /* 清操作完成的中断状态 */
 CH375_CMD_PORT_d_out( CMD_ISSUE_TOKEN );
 CH375_DAT_PORT_d_out( mBulkOut );  /* 高4位目的端点号, 低4位令牌PID */
// if ( CH375LibConfig & 0x80 ) while ( CH375IntStatus == 0 );  /* 中断方式,等待数据传输操作 */
// else xQueryInterrupt( );  /* 查询方式,查询中断状态 */
 CH375IntStatus=mWaitInterrupt( );
 if ( CH375IntStatus == USB_INT_SUCCESS ) {  /* 操作成功 */
  mCH375Write( VAR_UDISK_TOGGLE, mCH375Read( VAR_UDISK_TOGGLE ) ^ 0x40 );//printf("mUsbBulksend success\n ");
  return 1;
 }
 else return 0;  /* 操作失败 */
}

UINT8 epBulkRcv( UINT8 *mBuffer, UINT8 mLength )
{
 INT8 mBulkIn, mCount,CH375IntStatus;
 mCH375Write( SFR_USB_H_ENDP, mCH375Read( VAR_UDISK_TOGGLE ) );
 mBulkIn = mCH375Read( VAR_UDISK_BULK_IN );
 CH375IntStatus = 0;  /* 清操作完成的中断状态 */
 CH375_CMD_PORT_d_out( CMD_ISSUE_TOKEN );
 CH375_DAT_PORT_d_out( mBulkIn );  /* 高4位目的端点号, 低4位令牌PID */
// if ( CH375LibConfig & 0x80 ) while ( CH375IntStatus == 0 );  /* 中断方式,等待数据传输操作 */
// else xQueryInterrupt( );  /* 查询方式,查询中断状态 */
 CH375IntStatus=mWaitInterrupt( );
 if ( CH375IntStatus == USB_INT_SUCCESS ) {  /* 操作成功 */
  mCH375Write( VAR_UDISK_TOGGLE, mCH375Read( VAR_UDISK_TOGGLE ) ^ 0x80 );
  CH375_CMD_PORT_d_out( CMD_RD_USB_DATA );  /* 从CH375的端点缓冲区读取接收到的数据 */
  mCount = CH375_DAT_PORT_in( );  /* 后续数据长度 */
  mLength = mCount;
  while( mCount ) {
   *mBuffer = CH375_DAT_PORT_in( );
   mBuffer ++;
   mCount --;
  }//printf("mUsbBulkRecv success\n ");
  return 1;
 }
 else return  0;  /* 操作失败 */
}

TPBLK_STRUC TPBulk_Block;
#define     TPBulk_CBW  TPBulk_Block.TPBulk_CommandBlock
#define     CBW_wXferLen TPBulk_CBW.dCBW_DataXferLen
#define     RBC_CDB   TPBulk_CBW.cdbRBC
#define     RBC_LUN   TPBulk_CBW.bCBW_LUN
#define     TPBulk_CSW  TPBulk_Block.TPBulk_CommandStatus

/*unsigned char TPBulk_GetMaxLUN(void)
{
 usbstack.setup.bmRequest=0xa1;
 usbstack.setup.bRequest=0xfe;
 usbstack.setup.wValue=0;
 usbstack.setup.wIndex=0;
 usbstack.setup.wLength=1;
 usbstack.buffer=DBUF;
 return ep0Xfer();

}

unsigned char SPC_READLONG(void)
{
#define cdbReadLong RBC_CDB.SpcCdb_ReadLong 
 //nsigned char retStatus=FALSE;
 TPBulk_CBW.dCBW_Signature=CBW_SIGNATURE;
 TPBulk_CBW.dCBW_Tag=0x60a624de;
 TPBulk_CBW.dCBW_DataXferLen=0xfc000000;
 TPBulk_CBW.bCBW_Flag=0x80;
 TPBulk_CBW.bCBW_LUN=0;
 TPBulk_CBW.bCBW_CDBLen=sizeof(READ_LONG_CMD);
 
 /////////////////////////////////////
 cdbReadLong.OperationCode=SPC_CMD_READLONG;
 cdbReadLong.LogicalUnitNum=0;
 cdbReadLong.AllocationLen=0xfc;
 //////////////////////////////////////
 if(!epBulkSend((unsigned char *)&TPBulk_CBW,sizeof(TPBulk_CBW)))
  return FALSE;
 
 if(!epBulkRcv(DBUF,0xfc))
  return FALSE;
 
 if(!epBulkRcv((unsigned char *)&TPBulk_CSW,13))
  return FALSE;
  ////////////////////////////
  return TRUE;
#undef cdbReadLong
}

*/
unsigned char SPC_RequestSense(void)
{
#define cdbRequestSenseSPC RBC_CDB.SpcCdb_RequestSense 
 //unsigned char retStatus=FALSE;
 TPBulk_CBW.dCBW_Signature=CBW_SIGNATURE;
 TPBulk_CBW.dCBW_Tag=0x60a624de;
 TPBulk_CBW.dCBW_DataXferLen=0x0e000000;
 TPBulk_CBW.bCBW_Flag=0x80;
 TPBulk_CBW.bCBW_LUN=0;
 TPBulk_CBW.bCBW_CDBLen=sizeof(REQUEST_SENSE_SPC);
  
 /////////////////////////////////////
 cdbRequestSenseSPC.OperationCode=SPC_CMD_REQUESTSENSE;
 cdbRequestSenseSPC.AllocationLen=0x0e;
 //////////////////////////////////////
 if(!epBulkSend((unsigned char *)&TPBulk_CBW,sizeof(TPBulk_CBW)))
  return FALSE;
 
 if(!epBulkRcv(DBUF,18))
  return FALSE;
 
 if(!epBulkRcv((unsigned char *)&TPBulk_CSW,13))
  return FALSE;
/////////////////////////////
 return TRUE;
 
#undef cdbRequestSenseSPC
}

UINT8 SPC_TestUnit(void)
{
#define cdbTestUnit RBC_CDB.SpcCdb_TestUnit 
 //unsigned char retStatus=FALSE;
 TPBulk_CBW.dCBW_Signature=CBW_SIGNATURE;
 TPBulk_CBW.dCBW_Tag=0x60a624de;
 TPBulk_CBW.dCBW_DataXferLen=0x00000000;
 TPBulk_CBW.bCBW_Flag=0x00;
 TPBulk_CBW.bCBW_LUN=0;
 TPBulk_CBW.bCBW_CDBLen=sizeof(TEST_UNIT_SPC);
 /////////////////////////////////////
 cdbTestUnit.OperationCode=SPC_CMD_TESTUNITREADY;
 //////////////////////////////////////
 if(!epBulkSend((UINT8 *)&TPBulk_CBW,sizeof(TPBulk_CBW)))
  return FALSE;
 
 if(!epBulkRcv((UINT8 *)&TPBulk_CSW,13))
  return FALSE;
#undef cdbTestUnit
////////////////////////////
 return TRUE;
}