Subversion Repositories z80soc

#include <o3s.h>

#include <de2115.h>

#include <z80soc.h>

#include <string.h>

#include <stdio.h>

#include <stdlib.h>

#include <time.h>

void delay(int count) {

        if (count > 0) {

                for (count; count>0; count--) {

                        readMemory(0x0000);

                }

        }

}

// blink leds until pushbutton 0 is pressed

void waitToExit(void) {

    while (pushButton() != 0b00000001) {

        greenLeds(0xFF);

        delay(5000);

        greenLeds(0x00);

        delay(5000);

    }

}

unsigned char testmodule(unsigned int baseAddress, unsigned int endAddress, short int baseAddressL, short int baseAddressH) {

    unsigned char currdip = dipSwitchA();

    unsigned char mychar  = 0;

    while (baseAddress < endAddress) {

        hexlsb0(baseAddressL);

        hexmsb0(baseAddressH);

        mychar = 0x41;

        hexmsb1(mychar);

        writeMemory(baseAddress, mychar);

        mychar = 0xAA;

        mychar = readMemory(baseAddress);

        hexlsb1(mychar);

        if ( mychar == 0x41) {

            greenLeds(readMemory(baseAddress));

            baseAddressL++;

            baseAddress++;

            if (baseAddressL > 0xFF) {

                baseAddressL = 0x00;

                baseAddressH++;

            }

        } else {

            waitToExit();

            return 0xFF;

        }

    }

    waitToExit();

    return 0xAA;

}

unsigned char testvram(void) {

    unsigned char nchar = 0;

    unsigned int addr = readMemoryInt(0x57D4);

    unsigned int endaddr = addr + 4800;

    hexlsb0(readMemory(0x57D4));

    hexmsb0(readMemory(0x57D5));

    while (addr < endaddr) {

        writeMemory(addr,nchar);

        nchar++;

        if (nchar == 255) nchar = 0;

        addr++;

    }

    waitToExit();

    return 0xAA;

}

unsigned char testlcd(void) {

    unsigned char nchar = 0;

    unsigned int addr = readMemoryInt(0x57DC);

    hexlsb0(readMemory(0x57DC));

    hexmsb0(readMemory(0x57DD));

    printlcd(0,"**** Z80SoC ****");

    printlcd(16,"  Retro-CPU.run ");

    waitToExit();

    return 0xAA;

}

unsigned char lcdcls(void) {

    unsigned char nchar = 0;

    unsigned int addr = readMemoryInt(0x57DC);

    hexlsb0(readMemory(0x57DC));

    hexmsb0(readMemory(0x57DD));

    while (nchar < 32) {

        writeMemory(addr,32);

        nchar++;

        addr++;

    }

    return 0xAA;

}

unsigned char testCharRam(void) {

    // will redefine char with ascii codes 1 to 4

    unsigned int baseAddress = readMemoryInt(0x57D6) + 8;

    short int i;

    unsigned char hero_bits[] = {

        0x01,0x01,0x03,0x13,0x13,0x97,0x97,0x9e,

        0x80,0x80,0xc0,0xc8,0xc8,0xe9,0xe9,0x79,

        0xbc,0xbd,0xff,0xff,0xfb,0xf3,0xe1,0xc1,

        0x3d,0xbd,0xff,0xff,0xdf,0xcf,0x87,0x83

    };

    for (i = 0; i < 32; i++) {

        writeMemory(baseAddress + i, hero_bits[i]);

    }

    writeMemory(readMemoryInt(0x57D4) + 10*80 + 31,1);

    writeMemory(readMemoryInt(0x57D4) + 10*80 + 32,2);

    writeMemory(readMemoryInt(0x57D4) + 11*80 + 31,3);

    writeMemory(readMemoryInt(0x57D4) + 11*80 + 32,4);

    waitToExit();

    return 0xAA;

}

unsigned char testprintf(char s[]) {

    // set device output to video

    writeMemory(0x57CD,0);

    hexlsb0(readMemory(0x57D0));

    hexmsb0(readMemory(0x57D1));

    printf(s);

    return 0xAA;

}

void main(void) {

    unsigned char SW = 0;

    char LEDCOUNT = 0;

    short int baseAddressL;

    short int baseAddressH;

    unsigned int baseAddress = 0;

    unsigned int endAddress = 0;

    unsigned int myvramaddr;

    int i;

    int direction;

    myvramaddr = readMemoryInt(0x57D4) + (5 * 32);

    writeMemoryInt(0x57D0, myvramaddr);

    cls();

    lcdonoff(1);

    redLedsA(6);

    if (readMemory(0x57DF) > 0) {

        printlcd(0,"TestSys Z80SoC  ");

        if (readMemory(0x57DF) == 1) {

            printlcd(16,"  running on S3E");

        } else if (readMemory(0x57DF) == 2) {

            printlcd(16,"  running on DE2");

        } else if (readMemory(0x57DF) == 3) {

            printlcd(16,"  running on O3S");

        }

    }

    while (1) {

    cursorxy(15,3);

    printf("TestSys - A hardware test program for the Z80SoC");

    redLedsA(LEDCOUNT);

    LEDCOUNT++;

    SW = dipSwitchA();

     switch (SW) {

        case 1:

            // test sram

            printf("\n\n\n      Testing RAM. Check the address being tested on the 7SEG Display");

            baseAddressL = readMemory(0x57D8);

            baseAddressH = readMemory(0x57D9);

            baseAddress = readMemoryInt(0x57D8);

            endAddress = readMemoryInt(0x57DA) - 0x100;

            hexmsb1(testmodule(baseAddress, endAddress, baseAddressL, baseAddressH));

            waitToExit();

            break;

        case 2:

            // test vram

            //hexmsb1(testvram());

             baseAddressL = readMemory(0x57D4);

             baseAddressH = readMemory(0x57D5);

             baseAddress = readMemoryInt(0x57D4);

             endAddress = readMemoryInt(0x57D8);

             hexmsb1(testmodule(baseAddress, endAddress, baseAddressL, baseAddressH));

             waitToExit();

             cls();

            break;

        case 4:

             // test lcd

             if (readMemory(0x57DF) == 0) {

                 printf("\n\n\n     DE1 platform don't have LCD display");

                 waitToExit();

                 cls();

             } else {

                     printf("\n\n\n      Check the LCD display");

                     lcdonoff(0);

                     waitToExit();

                     lcdonoff(1);

                    }

             break;

        case 8:

             // test lcd

             if (readMemory(0x57DF) == 0) {

                 printf("\n\n\n     DE1 platform don't have LCD display");

                 waitToExit();

                 cls();

             } else {

                     printf("\n\n\n      Check the LCD display");

                     hexmsb1(testlcd());

                     waitToExit();

                     printlcd(0,"TestSys Z80SoC  ");

                    if (readMemory(0x57DF) == 1) {

                        printlcd(16,"  running on S3E");

                    } else if (readMemory(0x57DF) == 2) {

                              printlcd(16,"  running on DE2");

                           }

              }

             break;

        case 16:

            // test charram

            hexlsb0(readMemory(0x57D6));

            hexmsb0(readMemory(0x57D7));

            hexmsb1(testCharRam());

            waitToExit();

            cls();

            break;

         case 32:

             printf("\n\n\n              Testing the printf C function and newlines \\n");

             cursorxy(10,10);

             printf("1******************** Z80SoC ********************");

             cursorxy(10,11);

             printf("2******************** Z80SoC ********************");

             cursorxy(10,12);

             printf("3******************** Z80SoC ********************");

             printf("<< end>>");

             printf("\n>>>printing after\n\n\n\n>>>four new lines\n");

             hexlsb0(readMemory(0x57D0));

             hexmsb0(readMemory(0x57D1));

             printf("    1\n");

             printf("    2\n");

             printf("    3\n\n");

             printf("    4\n");

             waitToExit();

             cls();

             break;

         case 64:

             cls();

             cursorxy(5,2);

             printf("Testing char type storage and retrieve using writeMemory() function\n");

             cursorxy(5,3);

             printf("Confirms that a single byte is being written");

             baseAddress = readMemoryInt(0x57D8);

             for (i=0; i<10; i++) {

                 writeMemory(baseAddress + i, i);

                 writeMemory(baseAddress + 20 + 9 - i, 9 - i);

             }

             cursorxy(5,5);

             printf("written up down");

             cursorxy(40,5);

             printf("written down up");

             for (i=0; i<10; i++) {

                 cursorxy(5,6+i);

                 printf("%d",readMemory(baseAddress + i));

                 cursorxy(40,6+i);

                 printf("%d",readMemory(baseAddress + 20 + i));

             }

             waitToExit();

             cls();

             break;

         case 128:

             // random number generator test

             printf("\n    Testing the random integer number generator implemented inside thr FPGA (0xFFCA)");

             cursorxy(5,5);

             for (i=0; i<2000; i++) {

                 direction = readMemoryInt(0x57C9); // get a rumdom number - integer

                 printf("%i ",direction);

             }

             waitToExit();

             cls();

             break;

     }

   }

}