dbgwrite.c

Go to the documentation of this file.

/*
 *  This program is free software; you can redistribute it and/or
 *  modify it under the terms of the GNU General Public License
 *  as published by the Free Software Foundation; either version
 *  2 of the License, or (at your option) any later version.
 *
 *  Copyright 2008 Spiro Trikaliotis
 *
 */

#include <wdm.h>
#include "cbm_driver.h"
#include "i_iec.h"


#define PARALLEL_CONTROL_PORT_MASK_VALUES 0x0F

NTSTATUS
cbmiec_iec_dbg_write(IN PDEVICE_EXTENSION Pdx, IN UCHAR Value)
{
    UCHAR valueToSet;

    FUNC_ENTER();

    valueToSet = (Value & PARALLEL_CONTROL_PORT_MASK_VALUES) 
                 | ((Pdx->IecOutEor ^ Pdx->IecOutBits) & ~ PARALLEL_CONTROL_PORT_MASK_VALUES);

    DBG_PRINT((DBG_PREFIX "Value to set: %02x, modified to %02x", Value, valueToSet));

    WRITE_PORT_UCHAR(OUT_PORT, valueToSet);

    Pdx->IecOutBits = valueToSet ^ Pdx->IecOutEor;

    FUNC_LEAVE_NTSTATUS_CONST(STATUS_SUCCESS);
}