Subversion Repositories s6soc

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

//

// Filename:    display.c

//

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

//

// Purpose:     A device driver for the SPI controlled display.  The primary

//              purpose of this "device" is to output SPI instructions, though,

//      not to handle screen position or to optimize data set to the display.

//

// 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 "board.h"

#include "display.h"

static void     dispwait(void) {

        // Slow us down to the speed the display can handle

        // We want to delay about 0x800 clocks.

        // Three instructions per loop,

        //      LBL:

        //              NOOP

        //              ADD -1,CTR

        //              BNZ LBL

        //      40 clocks per instruction, as required by the SPI flash memory

        int i = 18;

        do {

                asm("noop");

        } while(i-->0);

}

void    dispchar(int ch) {

        if (!ch) // Don't display null characters

                return;

        if (ch&(~0x0ff)) { // Multiple characters to display

                int     v = (ch>>24)&0x0ff;

                if (v) {

                        dispchar(v);

                        v = (ch>>16)&0x0ff;

                        if (v) {

                                dispchar(v);

                                v = (ch>> 8)&0x0ff;

                                if (v) {

                                        dispchar(v);

                                        dispchar(ch&0x0ff);

                                }

                        }

                }

        } else {

                IOSPACE *sys = (IOSPACE *)IOADDR;

                // Send the character

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

                        int gpiov = GPOCLRV(GPO_MOSI|GPO_SCK|GPO_SS);

                        if (ch&0x80)

                                gpiov |= GPOSETV(GPO_MOSI);

                        sys->io_gpio = gpiov;

                        dispwait();

                        sys->io_gpio = GPOSETV(GPO_SCK);

                        dispwait();

                        ch<<=1;

                }

                // Turn off the clock

                sys->io_gpio = GPOCLRV(GPO_SCK);

                dispwait();

                // Then the port

                sys->io_gpio = GPOSETV(GPO_SS);

                dispwait();

        }

}

#ifdef  ZIPOS

#include "../zipos/ktraps.h"

#include "../zipos/kfildes.h"

void    display_task(void) {

        while(1) {

                int     ch;

                read(FILENO_STDIN, &ch, 1);

                dispchar(ch);

        }

}

#endif