Subversion Repositories s6soc

////////////////////////////////////////////////////////////////////////////////

//

// Filename:    kptest.c

//

// Project:     CMod S6 System on a Chip, ZipCPU demonstration project

//

// Purpose:     To test and demonstrate that the keypad works.

//

// Creator:     Dan Gisselquist, Ph.D.

//              Gisselquist Technology, LLC

//

////////////////////////////////////////////////////////////////////////////////

//

// Copyright (C) 2015-2016, Gisselquist Technology, LLC

//

// This program is free software (firmware): 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 3 of the License, or (at

// your option) any later version.

//

// This program is distributed in the hope that it will be useful, but WITHOUT

// ANY WARRANTY; without even the implied warranty of MERCHANTIBILITY or

// FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License

// for more details.

//

// You should have received a copy of the GNU General Public License along

// with this program.  (It's in the $(ROOT)/doc directory, run make with no

// target there if the PDF file isn't present.)  If not, see

// <http://www.gnu.org/licenses/> for a copy.

//

// License:     GPL, v3, as defined and found on www.gnu.org,

//              http://www.gnu.org/licenses/gpl.html

//

//

////////////////////////////////////////////////////////////////////////////////

//

//

#include "asmstartup.h"

#include "board.h"

#include "keypad.h"

void    txchr(char v) {

        volatile IOSPACE        *sys = (IOSPACE *)IOADDR;

        if (v < 10)

                return;

        v &= 0x07f;

        sys->io_pic = INT_UARTTX;

        while((sys->io_pic&INT_UARTTX)==0)

                ;

        sys->io_uart = v;

}

void    txstr(const char *str) {

        const char *ptr = str;

        while(*ptr) {

                txchr(*ptr++);

        }

}

void entry(void) {

        register IOSPACE        *sys = (IOSPACE *)0x0100;

        sys->io_pic = 0x07fffffff; // Acknowledge and turn off all interrupts

        sys->io_spio = 0x0f0;

        sys->io_tima = 100000 | TM_REPEAT;

        txstr("Press any keypad button for test.\r\n");

        while(1) {

                int     ch;

                while(0 == (sys->io_pic & INT_KEYPAD))

                        ;

                sys->io_pic = INT_KEYPAD | INT_TIMA;

                // Wait 5 ms

                for(int i=0; i<5; i++) {

                        while(0 == (sys->io_pic & INT_TIMA))

                                ;

                }

                sys->io_spio = 0x011;

                ch = keypadread();

                if (ch < 0)

                        ; // txstr("Unknown key pressed or error\n");

                else if (ch < 10)

                        txchr(ch+'0');

                else if (ch == 15)

                        txstr("F\r\n");

                else if (ch < 15)

                        txchr(ch+'A'-10);

                else txstr("Unknown key pressed\n");

                keypad_wait_for_release();

                sys->io_spio = 0x010;

        }

}