Starting the init routiune

2016-12-28 01:32:54 +01:00
parent 6a20f829d1
commit 4a0794d0f9
146 changed files with 16469 additions and 22012 deletions
@@ -0,0 +1,161 @@
+#include "InitLAN.h"
+
+
+unsigned long hex2int(char *a)
+{
+    int i,len=0;
+    unsigned long val = 0;
+
+                while(a[len])
+                        len++;
+
+    for(i=0;i<len;i++)
+       if(a[i] <= 57)
+        val += (a[i]-48)*(1<<(4*(len-1-i)));
+       else
+        val += (a[i]-55)*(1<<(4*(len-1-i)));
+
+    return val;
+}
+
+
+BYTE delayCIA(){ //one CIA acces: 1.4 micro sec
+   return (CIA_TST);
+}
+
+WORD delayShort(){
+    return (CHP_TST);
+}
+
+
+
+int SoftReset(APTR *BaseAddress){
+        int i;
+        WORD w,v=0;
+        WORD wTestWriteData, wTestReadData;
+        // Perform a reset via the PSP interface
+				//set the clock to 33mhz: COCON[3..0] = "0001"
+        //CLRREG(BaseAddress,ECON2, (ECON2_COCON3|ECON2_COCON2|ECON2_COCON1));
+        //SETREG(BaseAddress,ECON2, ECON2_COCON0);
+				
+
+        do
+        {
+
+                // Set and clear a few bits that clears themselves upon reset.
+                // If EUDAST cannot be written to and your code gets stuck in this
+                // loop, you have a hardware problem of some sort (SPI or PMP not
+                // initialized correctly, I/O pins aren't connected or are
+                // shorted to something, power isn't available, etc.)
+           		w= 0x1234;
+                //do
+                //{
+                        WRITEREG(BaseAddress,EUDAST, w);
+                        v=READREG(BaseAddress, EUDAST);
+                        printf("Read 0x%x at register 0x%x (should be 0x%x)\n",v,EUDAST,w);
+                //} while(v != w);
+
+                // Issue a reset and wait for it to complete
+                SETREG(BaseAddress,ECON2, ECON2_ETHRST);
+                do{
+             
+	                delayCIA();
+  	                v = READREG(BaseAddress,ESTAT);
+                    printf("Read 0x%x at register 0x%x\n",v,ESTAT);
+                	
+                }while((v & (ESTAT_CLKRDY | ESTAT_RSTDONE | ESTAT_PHYRDY)) != (ESTAT_CLKRDY | ESTAT_RSTDONE | ESTAT_PHYRDY));
+
+                // Check to see if the reset operation was successful by
+                // checking if EUDAST went back to its reset default.  This test
+                // should always pass, but certain special conditions might make
+                // this test fail, such as a PSP pin shorted to logic high.
+                w=READREG(BaseAddress,EUDAST);
+                printf("Read 0x%x at register 0x%x\n",w,EUDAST);
+        } while(READREG(BaseAddress,EUDAST) != 0);
+
+
+        // Really ensure reset is done and give some time for power to be stable
+        for(i=0; i<1000; ++i){
+                        delayCIA();
+        }
+
+
+        // If using PSP, verify all address and data lines are working
+				// Parallel direct addressing
+
+        // Initialize RAM contents with a random pattern and read back to verify
+        // This step is critical if using a PSP interface since some functionality
+        // may appear to work while a solder bridge or disconnect will cause
+        // certain memory ranges to fail.
+
+        // Generate and write pattern
+        for(w = 0; w < ENC100_RAM_SIZE; w += sizeof(wTestWriteData))
+        {
+                wTestWriteData = w;
+                WRITEREG(BaseAddress, w, w);
+        }
+
+        // Read back and verify random pattern
+
+        for(w = 0; w < ENC100_RAM_SIZE; w += sizeof(wTestWriteData))
+        {
+                wTestWriteData = w;
+                wTestReadData = READREG(BaseAddress,w);
+
+                // See if the data matches.  If your application gets stuck here,
+                // it means you have a hardware failure.  Check all of your PSP
+                // address and data lines.
+                if(wTestWriteData != wTestReadData)
+                	printf("Error checking memory at adress %lx! Expected $x - got %x\n",(BaseAddress+w),wTestWriteData,wTestReadData);
+
+        }
+        return v;
+}
+
+/*
+** **********************************************
+** LocateBoard()
+** **********************************************
+**
+** Locates Host Controller hardware
+**
+*/
+APTR LocateBoard(int manufactor, int product)
+{
+    APTR board;
+
+    board = NULL; // Board not found (yet)
+
+    if ( ExpansionBase = OpenLibrary( "expansion.library", 36 ) ) {
+
+        struct ConfigDev *cfg;
+
+
+        // *** Find board
+
+        if (cfg = FindConfigDev( NULL, manufactor, product ))
+                {
+                        board = cfg->cd_BoardAddr; // Get board base adr.
+                }
+
+        CloseLibrary( ExpansionBase );
+    }
+
+    return( board ); // Return board ptr (or NULL)
+}
+
+
+main(int argc, char *argv[])
+{
+    static int manufactor = 2588;
+    static int product = 123;
+    int v =0;
+    APTR board = LocateBoard(manufactor,product);
+    if(board){
+        printf("Found board for manufactor/product %d/%d at address 0x%lx.\n",manufactor,product, board);
+        v=SoftReset(board);
+        printf("SoftReset returned %X\n",v);
+    }else{
+        printf("No board found for manufactor/product %d/%d.\n",manufactor,product);
+    }
+}