/*
* IDD_NV.C - nvram handling routines
*/
#include <ndis.h>
#include <mytypes.h>
#include <mydefs.h>
#include <disp.h>
#include <util.h>
#include <opcodes.h>
#include <idd.h>
#include <res.h>
static USHORT nv_op (IDD*, SHORT, USHORT, USHORT, USHORT);
static INT nv_clk (IDD*, USHORT);
/* clock one nvram bit in/out */
static INT
nv_clk(IDD *idd, USHORT dat)
{
INT ret;
dat &= 1; /* make sure dat is one bit only */
idd->OutToPort(idd, 0, (UCHAR)(0x04 | dat)); /* setup data */
idd->OutToPort(idd, 0, (UCHAR)(0x06 | dat)); /* clock high */
idd->OutToPort(idd, 0, (UCHAR)(0x04 | dat)); /* clock low */
ret = idd->InFromPort(idd, 0) & 0x01; /* return out bit */
return(ret);
}
/* perform a basic nvram operation */
static USHORT
nv_op(IDD *idd, SHORT op, USHORT addr, USHORT val, USHORT has_val)
{
INT n;
USHORT word = 0;
D_LOG(D_ENTRY, ("nv_op: entry, idd: 0x%lx op: %d, addr: 0x%x, val: 0x%x, has_val: %d", \
idd, op, addr, val, has_val));
/* own i/o resource */
res_own(idd->res_io, idd);
/* set CS */
idd->OutToPort(idd, 0, 0x4);
/* if waiting for chip to be done, stay here */
if ( op < 0 )
{
while ( !(idd->InFromPort(idd, 0) & 0x01) )
;
/* remove ownership of i/o */
res_unown(idd->res_io, idd);
return(0);
}
/* clock in SB + opcode */
nv_clk(idd, (USHORT)1);
nv_clk(idd, (USHORT)(op >> 1));
nv_clk(idd, (USHORT)(op & 1));
/* clock in address */
for ( n = 5 ; n >= 0 ; n-- )
nv_clk(idd, (USHORT)(addr >> n));
if ( has_val )
{
/* clock data/val in/out */
for ( n = 15 ; n >= 0 ; n-- )
word = (word << 1) | nv_clk(idd, (USHORT)(val >> n));
}
/* remove CS */
idd->OutToPort(idd, 0, 0x00);
/* remove ownership of i/o */
res_unown(idd->res_io, idd);
D_LOG(D_EXIT, ("nv_op: exit, word: 0x%x", word));
return(word);
}
/* read a nvram location */
USHORT
IdpNVRead(IDD *idd, USHORT addr)
{
/* a basic op */
return(nv_op(idd, 2, addr, 0, 1));
}
/* read a nvram location */
USHORT
AdpNVRead(IDD *idd, USHORT addr)
{
return(AdpGetUShort(idd, ADP_NVRAM_WINDOW + addr));
}
/* write a nvram location */
VOID
IdpNVWrite(IDD *idd, USHORT addr, USHORT val)
{
/* enable writes */
nv_op(idd, 0, 0x30, 0, 0);
/* do the write */
nv_op(idd, 1, addr, val, 1);
/* wait for part to be done */
nv_op(idd, -1, 0, 0, 0);
}
/* write a nvram location */
VOID
AdpNVWrite(IDD *idd, USHORT addr, USHORT val)
{
}
/* erase all nvram */
VOID
IdpNVErase(IDD *idd)
{
/* enable writes */
nv_op(idd, 0, 0x30, 0, 0);
/* erase */
nv_op(idd, 0, 0x20, 0, 0);
}
/* erase all nvram */
VOID
AdpNVErase(IDD *idd)
{
}
