Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-22 16:48:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

HAL_F4Light: fixed bug on write in USB MassStorage mode

Browse Source
This commit is contained in:
night-ghost 2018-04-11 13:04:44 +05:00 committed by Andrew Tridgell
parent d1f2646394
commit 6e0742630d
1 changed files with 18 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

19
libraries/AP_HAL_F4Light/hardware/massstorage/msc/usbd_msc_scsi.c
View File

@ -613,8 +613,10 @@ static int8_t SCSI_Read10(uint8_t lun , uint8_t *params)
p->is_write = false; p->is_write = false;
} }
// printf("\nUSB: enqueue read blk=%ld\n", SCSI_blk_addr / SCSI_blk_size);
uint32_t fifoemptymsk = 0x1 << (MSC_IN_EP & 0x7F); uint32_t fifoemptymsk = 0x1 << (MSC_IN_EP & 0x7F);
USB_OTG_MODIFY_REG32(&cdev->regs.DREGS->DIEPEMPMSK, fifoemptymsk, 0); // clear FIFO Empty mask until real data write USB_OTG_MODIFY_REG32(&cdev->regs.DREGS->DIEPEMPMSK, fifoemptymsk, 0); // clear FIFO Empty mask until real data write to prevent interrupt
hal_set_task_active(task_handle); // resume task hal_set_task_active(task_handle); // resume task
hal_context_switch_isr(); // and reschedule tasks after interrupt hal_context_switch_isr(); // and reschedule tasks after interrupt
@ -732,6 +734,8 @@ static int8_t SCSI_Write10 (uint8_t lun , uint8_t *params)
p->is_write = true; p->is_write = true;
} }
// printf("\nUSB: enqueue write blk=%ld\n", SCSI_blk_addr / SCSI_blk_size);
hal_set_task_active(task_handle); // resume task hal_set_task_active(task_handle); // resume task
hal_context_switch_isr(); // and reschedule tasks after interrupt hal_context_switch_isr(); // and reschedule tasks after interrupt
return 0; return 0;
@ -767,18 +771,26 @@ static void usb_task(){
int8_t ret; int8_t ret;
if(p->is_write){ if(p->is_write){
// printf("\nUSB: do write blk=%ld\n", SCSI_blk_addr / SCSI_blk_size);
ret = SCSI_ProcessWrite(p->lun); ret = SCSI_ProcessWrite(p->lun);
} else { } else {
// printf("\nUSB: do read blk=%ld\n", SCSI_blk_addr / SCSI_blk_size);
MSC_BOT_DataLen = MSC_MEDIA_PACKET; MSC_BOT_DataLen = MSC_MEDIA_PACKET;
ret = SCSI_ProcessRead(p->lun); ret = SCSI_ProcessRead(p->lun);
uint32_t fifoemptymsk = 0x1 << (MSC_IN_EP & 0x7F);
USB_OTG_MODIFY_REG32(&cdev->regs.DREGS->DIEPEMPMSK, 0, fifoemptymsk); // Set FIFO Empty mask after real data write to allow next interrupt
} }
MSC_BOT_CBW_finish(p->pdev);
if(ret<0) { if(ret<0) {
#ifdef SCSI_DEBUG #ifdef SCSI_DEBUG
l->ret = ret; l->ret = ret;
#endif #endif
MSC_BOT_SendCSW (p->pdev, CSW_CMD_FAILED); MSC_BOT_SendCSW (p->pdev, CSW_CMD_FAILED);
} else { } else {
MSC_BOT_CBW_finish(p->pdev);
#ifdef SCSI_DEBUG #ifdef SCSI_DEBUG
l->ret = 1; l->ret = 1;
#endif #endif
@ -839,6 +851,7 @@ static int8_t SCSI_ProcessRead (uint8_t lun)
len = MIN(SCSI_blk_len , MSC_MEDIA_PACKET); len = MIN(SCSI_blk_len , MSC_MEDIA_PACKET);
// read block from storage
if( USBD_STORAGE_fops->Read(lun , if( USBD_STORAGE_fops->Read(lun ,
MSC_BOT_Data, MSC_BOT_Data,
SCSI_blk_addr / SCSI_blk_size, SCSI_blk_addr / SCSI_blk_size,
@ -848,7 +861,7 @@ static int8_t SCSI_ProcessRead (uint8_t lun)
return -1; return -1;
} }
// and setup TX
DCD_EP_Tx (cdev, DCD_EP_Tx (cdev,
MSC_IN_EP, MSC_IN_EP,
MSC_BOT_Data, MSC_BOT_Data,