/** * @brief Writes Sector(s) * @param lun : lun id * @param *buff: Data to be written * @param sector: Sector address (LBA) * @param count: Number of sectors to write (1..128) * @retval DRESULT: Operation result */ DRESULT USBH_write(BYTE lun, const BYTE *buff, DWORD sector, UINT count) { DRESULT res = RES_ERROR; MSC_LUNTypeDef info; USBH_StatusTypeDef status = USBH_OK; if ((DWORD)buff & 3) /* DMA Alignment issue, do single up to aligned buffer */ { #if _USE_BUFF_WO_ALIGNMENT == 0 while (count--) { memcpy (scratch, &buff[count * _MAX_SS], _MAX_SS); status = USBH_MSC_Write(&usb_msc_host_param[lun], lun, sector + count, (BYTE *)scratch, 1) ; if(status == USBH_FAIL) { break; } } #else return res; #endif } else { status = USBH_MSC_Write(&usb_msc_host_param[lun], lun, sector, (BYTE *)buff, count); } if(status == USBH_OK) { res = RES_OK; } else { USBH_MSC_GetLUNInfo(&usb_msc_host_param[lun], lun, &info); switch (info.sense.asc) { case SCSI_ASC_WRITE_PROTECTED: USBH_ErrLog("USB Disk is Write protected!"); res = RES_WRPRT; break; case SCSI_ASC_LOGICAL_UNIT_NOT_READY: case SCSI_ASC_MEDIUM_NOT_PRESENT: case SCSI_ASC_NOT_READY_TO_READY_CHANGE: USBH_ErrLog("USB Disk is not ready!"); res = RES_NOTRDY; break; default: res = RES_ERROR; break; } } return res; }
DRESULT disk_write (BYTE pdrv, const BYTE* buff, DWORD sector, BYTE count) { DRESULT res = RES_ERROR; MSC_LUNTypeDef info; USBH_StatusTypeDef status = USBH_OK; DWORD scratch [_MAX_SS / 4]; if ((DWORD)buff & 3) /* DMA Alignment issue, do single up to aligned buffer */ { while (count--) { memcpy (scratch, &buff[count * _MAX_SS], _MAX_SS); status = USBH_MSC_Write(&hUSBHost_HS, pdrv, sector + count, (BYTE *)scratch, 1) ; if(status == USBH_FAIL) { break; } } } else { status = USBH_MSC_Write(&hUSBHost_HS, pdrv, sector, (BYTE *)buff, count); } if(status == USBH_OK) { res = RES_OK; } else { USBH_MSC_GetLUNInfo(&hUSBHost_HS, pdrv, &info); switch (info.sense.asc) { case SCSI_ASC_WRITE_PROTECTED: USBH_ErrLog("USB Disk is Write protected!"); res = RES_WRPRT; break; case SCSI_ASC_LOGICAL_UNIT_NOT_READY: case SCSI_ASC_MEDIUM_NOT_PRESENT: case SCSI_ASC_NOT_READY_TO_READY_CHANGE: USBH_ErrLog("USB Disk is not ready!"); res = RES_NOTRDY; break; default: res = RES_ERROR; break; } } return res; }