コード例 #1
0
ファイル: ata.c プロジェクト: HTshandou/newos
void ata_dpc_PIO( ide_qrequest *qrequest )
{
	ide_device_info *device = qrequest->device;
	bigtime_t timeout = qrequest->request->cam_timeout > 0 ? 
		qrequest->request->cam_timeout : IDE_STD_TIMEOUT;
	
	if( !check_rw_error( device, qrequest ) ||
		!check_rw_status( device, qrequest,
		qrequest->is_write ? device->left_blocks > 1 : true )) 
	{
		/*if( (device->sense.sense_key == SCSIS_KEY_ABORTED_COMMAND ||
			 device->sense.ascq == SCSIS_ASC_UNREC_READ_ERR) &&
			++qrequest->retries < MAX_PIO_RETRIES ) 
		{
			finish_rw_request( qrequest, ide_finish_rw_retry );
		} else*/
			finish_checksense( qrequest );
			
		return;
	}

	if( qrequest->is_write ) {
		if( device->left_blocks == 0 )
			goto finish;
			
		if( !wait_for_drq( device )) 
			goto finish;
			
		start_waiting_nolock( device->bus, timeout, ide_state_async_waiting );
		
		// having a too short data buffer shouldn't happen here
		// anyway - we are prepared
		if( write_PIO_block( qrequest, 512 ) == ERR_GENERAL )
			goto finish_cancel_timeout;
			
		--device->left_blocks;

	} else {
		if( device->left_blocks > 0 )
			start_waiting_nolock( device->bus, timeout, ide_state_async_waiting );
		
		// see write
		if( read_PIO_block( qrequest, 512 ) == ERR_GENERAL ) 
			goto finish_cancel_timeout;
			
		--device->left_blocks;
		
		if( device->left_blocks == 0 ) {
			wait_for_drqdown( device );
			goto finish_cancel_timeout;
		}
	}
	
	//start_waiting( device->bus );
	return;
	
finish_cancel_timeout:
	cancel_irq_timeout( device->bus );
	
finish:
	finish_checksense( qrequest );
	return;
}
コード例 #2
0
ファイル: ata.c プロジェクト: AmirAbrams/haiku
void
ata_dpc_PIO(ide_qrequest *qrequest)
{
	ide_device_info *device = qrequest->device;
	uint32 timeout = qrequest->request->timeout > 0 ?
		qrequest->request->timeout : IDE_STD_TIMEOUT;

	SHOW_FLOW0(3, "");

	if (check_rw_error(device, qrequest)
		|| !check_rw_status(device, qrequest->is_write ? device->left_blocks > 0 : true))
	{
		// failure reported by device
		SHOW_FLOW0( 3, "command finished unsuccessfully" );

		finish_checksense(qrequest);
		return;
	}

	if (qrequest->is_write) {
		if (device->left_blocks == 0) {
			// this was the end-of-transmission IRQ
			SHOW_FLOW0(3, "write access finished");
			if (!wait_for_drqdown(device)) {
				SHOW_ERROR0(3, "device wants to transmit data though command is finished");
				goto finish;
			}
			goto finish;
		}

		// wait until device requests data
		SHOW_FLOW0(3, "Waiting for device ready to transmit");
		if (!wait_for_drq(device)) {
			SHOW_FLOW0(3, "device not ready for data transmission - abort");
			goto finish;
		}

		// start async waiting for next block/end of command
		// we should start that when block is transmitted, but with bad
		// luck the IRQ fires exactly between transmission and start of waiting,
		// so we better start waiting too early; as we are in service thread,
		// a DPC initiated by IRQ cannot overtake us, so there is no need to block
		// IRQs during sent
		start_waiting_nolock(device->bus, timeout, ide_state_async_waiting);

		// having a too short data buffer shouldn't happen here
		// anyway - we are prepared
		SHOW_FLOW0(3, "Writing one block");
		if (write_PIO_block(qrequest, 512) == B_ERROR)
			goto finish_cancel_timeout;

		--device->left_blocks;
	} else {
		if (device->left_blocks > 1) {
			// start async waiting for next command (see above)
			start_waiting_nolock(device->bus, timeout, ide_state_async_waiting);
		}

		// see write
		SHOW_FLOW0( 3, "Reading one block" );
		if (read_PIO_block(qrequest, 512) == B_ERROR)
			goto finish_cancel_timeout;

		--device->left_blocks;

		if (device->left_blocks == 0) {
			// at end of transmission, wait for data request going low
			SHOW_FLOW0( 3, "Waiting for device to finish transmission" );

			if (!wait_for_drqdown(device))
				SHOW_FLOW0( 3, "Device continues data transmission - abort command" );

			// we don't cancel timeout as no timeout is started during last block
			goto finish;
		}
	}

	return;

finish_cancel_timeout:
	cancel_irq_timeout(device->bus);

finish:
	finish_checksense(qrequest);
}