mirror of https://github.com/lianthony/NT4.0
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
108 lines
2.6 KiB
108 lines
2.6 KiB
/*****************************************************************************
|
|
*
|
|
* 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;
|
|
}
|