Multiple ATAPI bugfixes.

This commit is contained in:
OBattler
2017-01-05 04:36:37 +01:00
parent 0e08eccb71
commit 66838be5f9
2 changed files with 102 additions and 85 deletions

185
src/ide.c
View File

@@ -1729,7 +1729,10 @@ void atapi_command_send_init(IDE *ide, uint8_t command, int req_length, int allo
}
/* No atastat setting: PCem actually emulates the callback cycle. */
ide->secount = 2;
if (alloc_length != 0)
{
ide->secount = 2;
}
// no bytes transferred yet
ide->pos = 0;
@@ -1851,6 +1854,7 @@ static void atapicommand(int ide_board)
int ret;
int real_pos;
int track = 0;
uint8_t cdb[12];
#if 0
pclog("ATAPI command 0x%02X, Sense Key %02X, Asc %02X, Ascq %02X, %i, Unit attention: %i\n",idebufferb[0],SCSISense.SenseKey,SCSISense.Asc,SCSISense.Ascq,ins,SCSISense.UnitAttention);
@@ -1862,6 +1866,8 @@ static void atapicommand(int ide_board)
}
#endif
memcpy(cdb, idebufferb, 12);
msf=idebufferb[1]&2;
SectorLen=0;
@@ -1883,6 +1889,7 @@ static void atapicommand(int ide_board)
execution under it, error out and report the condition. */
if (SCSISense.UnitAttention == 1)
{
// pclog("Unit attention now 2\n");
SCSISense.UnitAttention = 2;
if (!(SCSICommandTable[idebufferb[0]] & ALLOW_UA))
{
@@ -1895,6 +1902,7 @@ static void atapicommand(int ide_board)
{
if (idebufferb[0]!=GPCMD_REQUEST_SENSE)
{
// pclog("Unit attention now 0\n");
SCSISense.UnitAttention = 0;
}
}
@@ -1936,7 +1944,6 @@ static void atapicommand(int ide_board)
case GPCMD_REQUEST_SENSE: /* Used by ROS 4+ */
alloc_length = idebufferb[4];
temp_command = idebufferb[0];
atapi_command_send_init(ide, temp_command, 18, alloc_length);
/*Will return 18 bytes of 0*/
memset(idebufferb,0,512);
@@ -1974,9 +1981,9 @@ static void atapicommand(int ide_board)
}
}
idebufferb[7]=10;
// pclog("Reporting sense: %02X %02X %02X\n", idebufferb[2], idebufferb[12], idebufferb[13]);
atapi_command_ready(ide_board, 18);
idebufferb[7]=10;
if (idebufferb[2] == SENSE_UNIT_ATTENTION)
{
@@ -1988,11 +1995,17 @@ static void atapicommand(int ide_board)
/* Clear the sense stuff as per the spec. */
atapi_sense_clear(temp_command, 0);
if (idebufferb[4] == 0)
if (alloc_length == 0)
{
// pclog("REQUEST SENSE - empty allocation\n");
ide->packetstatus = ATAPI_STATUS_COMPLETE;
idecallback[ide_board]=50*IDE_TIME;
}
else
{
atapi_command_send_init(ide, temp_command, 18, alloc_length);
atapi_command_ready(ide_board, 18);
}
break;
case GPCMD_SET_SPEED:
@@ -2003,17 +2016,19 @@ static void atapicommand(int ide_board)
case GPCMD_MECHANISM_STATUS:
len=(idebufferb[7]<<16)|(idebufferb[8]<<8)|idebufferb[9];
if (len == 0)
{
fatal("Zero allocation length to MECHANISM STATUS not impl.\n");
}
atapi_command_send_init(ide, idebufferb[0], 8, alloc_length);
memset(idebufferb, 0, 8);
idebufferb[5] = 1;
atapi_command_ready(ide_board, 8);
if (len == 0)
{
ide->packetstatus = ATAPI_STATUS_COMPLETE;
idecallback[ide_board]=50*IDE_TIME;
}
else
{
atapi_command_send_init(ide, cdb[0], 8, alloc_length);
atapi_command_ready(ide_board, 8);
}
break;
case GPCMD_READ_TOC_PMA_ATIP:
@@ -2371,72 +2386,68 @@ static void atapicommand(int ide_board)
idebufferb[2] = ((alloc_length-4) >> 8) & 0xff;
idebufferb[3] = (alloc_length-4) & 0xff;
atapi_command_send_init(ide, temp_command, len, alloc_length);
atapi_command_ready(ide_board, len);
if (len == 0)
{
ide->packetstatus = ATAPI_STATUS_COMPLETE;
idecallback[ide_board]=50*IDE_TIME;
}
else
{
atapi_command_send_init(ide, temp_command, len, alloc_length);
atapi_command_ready(ide_board, len);
}
break;
case GPCMD_GET_EVENT_STATUS_NOTIFICATION:
temp_command = idebufferb[0];
alloc_length = len;
{
gesn_cdb = (void *)idebufferb;
gesn_event_header = (void *)idebufferb;
gesn_cdb = (void *)idebufferb;
gesn_event_header = (void *)idebufferb;
/* It is fine by the MMC spec to not support async mode operations. */
if (!(gesn_cdb->polled & 0x01))
{ /* asynchronous mode */
/* Only polling is supported, asynchronous mode is not. */
atapi_invalid_field(ide);
return;
}
/* polling mode operation */
/*
* These are the supported events.
*
* We currently only support requests of the 'media' type.
* Notification class requests and supported event classes are bitmasks,
* but they are built from the same values as the "notification class"
* field.
*/
gesn_event_header->supported_events = 1 << GESN_MEDIA;
/*
* We use |= below to set the class field; other bits in this byte
* are reserved now but this is useful to do if we have to use the
* reserved fields later.
*/
gesn_event_header->notification_class = 0;
/*
* Responses to requests are to be based on request priority. The
* notification_class_request_type enum above specifies the
* priority: upper elements are higher prio than lower ones.
*/
if (gesn_cdb->class & (1 << GESN_MEDIA))
{
gesn_event_header->notification_class |= GESN_MEDIA;
used_len = SCSICDROMEventStatus(idebufferb);
}
else
{
gesn_event_header->notification_class = 0x80; /* No event available */
used_len = sizeof(*gesn_event_header);
}
gesn_event_header->len = used_len - sizeof(*gesn_event_header);
/* It is fine by the MMC spec to not support async mode operations. */
if (!(gesn_cdb->polled & 0x01))
{ /* asynchronous mode */
/* Only polling is supported, asynchronous mode is not. */
atapi_invalid_field(ide);
return;
}
atapi_command_send_init(ide, temp_command, len, alloc_length);
/* polling mode operation */
atapi_command_ready(ide_board, len);
/*
* These are the supported events.
*
* We currently only support requests of the 'media' type.
* Notification class requests and supported event classes are bitmasks,
* but they are built from the same values as the "notification class"
* field.
*/
gesn_event_header->supported_events = 1 << GESN_MEDIA;
/*
* We use |= below to set the class field; other bits in this byte
* are reserved now but this is useful to do if we have to use the
* reserved fields later.
*/
gesn_event_header->notification_class = 0;
/*
* Responses to requests are to be based on request priority. The
* notification_class_request_type enum above specifies the
* priority: upper elements are higher prio than lower ones.
*/
if (gesn_cdb->class & (1 << GESN_MEDIA))
{
gesn_event_header->notification_class |= GESN_MEDIA;
used_len = SCSICDROMEventStatus(idebufferb);
}
else
{
gesn_event_header->notification_class = 0x80; /* No event available */
used_len = sizeof(*gesn_event_header);
}
gesn_event_header->len = used_len - sizeof(*gesn_event_header);
atapi_command_send_init(ide, cdb[0], used_len, used_len);
atapi_command_ready(ide_board, used_len);
break;
case GPCMD_READ_DISC_INFORMATION:
@@ -2460,18 +2471,21 @@ static void atapicommand(int ide_board)
{
len = alloc_length;
}
ide->packetstatus = ATAPI_STATUS_DATA;
ide->cylinder=len;
ide->secount=2;
ide->pos=0;
idecallback[ide_board]=60*IDE_TIME;
ide->packlen=len;
if (len == 0)
{
ide->packetstatus = ATAPI_STATUS_COMPLETE;
idecallback[ide_board]=50*IDE_TIME;
}
else
{
ide->packetstatus = ATAPI_STATUS_DATA;
ide->secount=2;
ide->cylinder=len;
ide->pos=0;
ide->packlen=len;
idecallback[ide_board]=60*IDE_TIME;
}
break;
case GPCMD_READ_TRACK_INFORMATION:
@@ -2529,18 +2543,20 @@ static void atapicommand(int ide_board)
idebufferb[1] = (max_len - 2) & 0xff;
}
ide->packetstatus = ATAPI_STATUS_DATA;
ide->cylinder=len;
ide->secount=2;
ide->pos=0;
idecallback[ide_board]=60*IDE_TIME;
ide->packlen=len;
if (len == 0)
{
ide->packetstatus = ATAPI_STATUS_COMPLETE;
idecallback[ide_board]=50*IDE_TIME;
}
else
{
ide->packetstatus = ATAPI_STATUS_DATA;
ide->cylinder=len;
ide->secount=2;
ide->pos=0;
idecallback[ide_board]=60*IDE_TIME;
ide->packlen=len;
}
break;
case GPCMD_PLAY_AUDIO_10:
@@ -2802,15 +2818,16 @@ atapi_out:
len = alloc_length;
}
atapi_command_send_init(ide, temp_command, len, alloc_length);
atapi_command_ready(ide_board, len);
if (len == 0)
{
ide->packetstatus = ATAPI_STATUS_COMPLETE;
idecallback[ide_board]=50*IDE_TIME;
}
else
{
atapi_command_send_init(ide, temp_command, len, alloc_length);
atapi_command_ready(ide_board, len);
}
break;
case GPCMD_PREVENT_REMOVAL: