1 files changed, 140 insertions, 0 deletions

diff --git a/private/ntos/ndis/digi/pcimac/idd_nv.c b/private/ntos/ndis/digi/pcimac/idd_nv.c
new file mode 100644
index 000000000..bda07f281
--- /dev/null
+++ b/private/ntos/ndis/digi/pcimac/idd_nv.c
@@ -0,0 +1,140 @@
+/*
+ * 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)
+{
+	
+}