109 lines
2.6 KiB
C
109 lines
2.6 KiB
C
/*****************************************************************************
|
||
*
|
||
* COPYRIGHT 1993 - COLORADO MEMORY SYSTEMS, INC.
|
||
* ALL RIGHTS RESERVED.
|
||
*
|
||
******************************************************************************
|
||
*
|
||
* FILE: \SE\DRIVER\DEVICE\JUMBO\SRC\0X11033.C
|
||
*
|
||
* FUNCTION: cqd_ProgramFDC
|
||
*
|
||
* PURPOSE: Send a command to the Floppy Disk Controller. Commands are of
|
||
* various lengths as defined by the FDC spec (NEC uPD765A).
|
||
*
|
||
* For each byte in the command string, program_nec must wait for the
|
||
* FDC to become ready to read command data. Program_nec will wait
|
||
* up to approx. 3 msecs before giving up and declaring an error.
|
||
*
|
||
* HISTORY:
|
||
* $Log: J:\se.vcs\driver\q117cd\src\0x11033.c $
|
||
*
|
||
*
|
||
*****************************************************************************/
|
||
#define FCT_ID 0x11033
|
||
#include "include\public\adi_api.h"
|
||
#include "include\public\frb_api.h"
|
||
#include "include\private\kdi_pub.h"
|
||
#include "include\private\cqd_pub.h"
|
||
#include "q117cd\include\cqd_defs.h"
|
||
#include "q117cd\include\cqd_strc.h"
|
||
#include "q117cd\include\cqd_hdr.h"
|
||
/*endinclude*/
|
||
|
||
dStatus cqd_ProgramFDC
|
||
(
|
||
/* INPUT PARAMETERS: */
|
||
|
||
CqdContextPtr cqd_context,
|
||
dUBytePtr command,
|
||
dUWord length,
|
||
dBoolean result
|
||
|
||
/* UPDATE PARAMETERS: */
|
||
|
||
/* OUTPUT PARAMETERS: */
|
||
|
||
)
|
||
/* COMMENTS: *****************************************************************
|
||
*
|
||
* DEFINITIONS: *************************************************************/
|
||
{
|
||
|
||
/* DATA: ********************************************************************/
|
||
|
||
dUDWord i;
|
||
dUDWord wait_count;
|
||
|
||
/* CODE: ********************************************************************/
|
||
|
||
cqd_context->controller_data.command_has_result_phase = result;
|
||
|
||
#if DBG
|
||
DBG_ADD_ENTRY(QIC117SHOWMCMDS, (CqdContextPtr)cqd_context, DBG_PGM_FDC);
|
||
#endif
|
||
|
||
for (i = 0; i < length; i++) {
|
||
|
||
wait_count = FDC_MSR_RETRIES;
|
||
|
||
do {
|
||
|
||
if ((kdi_ReadPort(
|
||
cqd_context->kdi_context,
|
||
cqd_context->controller_data.fdc_addr.msr) &
|
||
(MSR_RQM | MSR_DIO)) == MSR_RQM) {
|
||
|
||
break;
|
||
|
||
}
|
||
|
||
#ifndef WIN95
|
||
kdi_ShortTimer(kdi_wt12us);
|
||
#endif
|
||
|
||
} while (--wait_count > 0);
|
||
|
||
if (wait_count == 0) {
|
||
|
||
return kdi_Error(ERR_FDC_FAULT, FCT_ID, ERR_SEQ_1);
|
||
|
||
}
|
||
|
||
kdi_WritePort(
|
||
cqd_context->kdi_context,
|
||
cqd_context->controller_data.fdc_addr.dr,
|
||
command[i]);
|
||
|
||
#if DBG
|
||
DBG_ADD_ENTRY(QIC117SHOWMCMDS, (CqdContextPtr)cqd_context, command[i]);
|
||
#endif
|
||
|
||
#ifndef WIN95
|
||
kdi_ShortTimer(kdi_wt12us);
|
||
#endif
|
||
}
|
||
|
||
return DONT_PANIC;
|
||
}
|