Subversion Repositories openarty

#include "artyboard.h"

#include "zipsys.h"

asm("\t.section\t.start\n"

        "\t.global\t_start\n"

"_start:\n"

        "\tLDI\t_top_of_stack,SP\n"

        "\tMOV\t_after_bootloader(PC),R0\n"

        "\tBRA\tbootloader\n"

"_after_bootloader:\n"

        "\tLDI\t_top_of_stack,SP\n"

        "\tOR\t0x4000,CC\n"     // Clear the data cache

        "\tMOV\t_kernel_exit(PC),R0\n"

        "\tBRA\tentry\n"

"_kernel_exit:\n"

        "\tHALT\n"

        "\tBRA\t_kernel_exit\n"

        "\t.section\t.text");

extern int      _sdram_image_end, _sdram_image_start, _sdram,

        _blkram, _flash, _bss_image_end,

        _kernel_image_start, _kernel_image_end;

extern  void    bootloader(void) __attribute__ ((section (".boot")));

// #define      USE_DMA

void    bootloader(void) {

        int     zero = 0;

#ifdef  USE_DMA

        zip->dma.ctrl= DMACLEAR;

        zip->dma.rd = _kernel_image_start;

        if (_kernel_image_end != _sdram_image_start) {

                zip->dma.len = _kernel_image_end - _blkram;

                zip->dma.wr  = _blkram;

                zip->dma.ctrl= DMACCOPY;

                zip->pic = SYSINT_DMAC;

                while((zip->pic & SYSINT_DMAC)==0)

                        ;

        }

        zip->dma.len = &_sdram_image_end - _sdram;

        zip->dma.wr  = _sdram;

        zip->dma.ctrl= DMACCOPY;

        zip->pic = SYSINT_DMAC;

        while((zip->pic & SYSINT_DMAC)==0)

                ;

        if (_bss_image_end != _sdram_image_end) {

                zip->dma.len = _bss_image_end - _sdram_image_end;

                zip->dma.rd  = &zero;

                // zip->dma.wr // Keeps the same value

                zip->dma.ctrl = DMACCOPY;

                zip->pic = SYSINT_DMAC;

                while((zip->pic & SYSINT_DMAC)==0)

                        ;

        }

#else

        int     *rdp = &_kernel_image_start, *wrp = &_blkram;

        //

        // Load any part of the image into block RAM, but *only* if there's a

        // block RAM section in the image.  Based upon our LD script, the

        // block RAM should be filled from _blkram to _kernel_image_end.

        // It starts at _kernel_image_start --- our last valid address within

        // the flash address region.

        //

        if (&_kernel_image_end != &_sdram_image_start) {

                for(int i=0; i< &_kernel_image_end - &_blkram; i++)

                        *wrp++ = *rdp++;

        }

        //

        // Now, we move on to the SDRAM image.  We'll here load into SDRAM

        // memory up to the end of the SDRAM image, _sdram_image_end.

        // As with the last pointer, this one is also created for us by the

        // linker.

        // 

        wrp = &_sdram;

        for(int i=0; i< &_sdram_image_end - &_sdram; i++)

                *wrp++ = *rdp++;

        //

        // Finally, we load BSS.  This is the segment that only needs to be

        // cleared to zero.  It is available for global variables, but some

        // initialization is expected within it.  We start writing where

        // the valid SDRAM context, i.e. the non-zero contents, end.

        //

        for(int i=0; i<&_bss_image_end - &_sdram_image_end; i++)

                *wrp++ = 0;

#endif

}

void    idle_task(void) {

        while(1)

                zip_idle();

}

void    entry(void) {

        const unsigned red = 0x0ff0000, green = 0x0ff00, blue = 0x0ff,

                white = 0x070707, black = 0, dimgreen = 0x1f00,

                second = 81250000;

        int     i, sw;

        int     user_context[16];

        for(i=0; i<15; i++)

                user_context[i] = 0;

        user_context[15] = (unsigned)idle_task;

        zip_restore_context(user_context);

        for(i=0; i<4; i++)

                sys->io_clrled[i] = red;

        sys->io_ledctrl = 0x0ff;

        // Clear the PIC

        //

        //      Acknowledge all interrupts, turn off all interrupts

        //

        zip->pic = 0x7fff7fff;

        while(sys->io_pwrcount < (second >> 4))

                ;

        // Repeating timer, every 250ms

        // zip->tma = (second/4) | 0x80000000;

        zip->tma = 1024 | 0x80000000;

        // Restart the PIC -- listening for SYSINT_TMA only

        zip->pic = SYSINT_TMA;

        zip->pic = EINT(SYSINT_TMA)|SYSINT_TMA;

        zip_rtu();

        sys->io_clrled[0] = green;

        sys->io_ledctrl = 0x010;

        zip->pic = SYSINT_TMA;

        zip->pic = EINT(SYSINT_TMA)|SYSINT_TMA;

        zip_rtu();

        sys->io_clrled[0] = dimgreen;

        sys->io_clrled[1] = green;

        sys->io_scope[0].s_ctrl = 32 | SCOPE_TRIGGER;

        sys->io_ledctrl = 0x020;

        zip->pic = SYSINT_TMA;

        zip->pic = EINT(SYSINT_TMA)|SYSINT_TMA;

        zip_rtu();

        sys->io_clrled[1] = dimgreen;

        sys->io_clrled[2] = green;

        sys->io_ledctrl = 0x040;

        zip->pic = SYSINT_TMA;

        zip->pic = EINT(SYSINT_TMA);

        zip_rtu();

        sys->io_clrled[2] = dimgreen;

        sys->io_clrled[3] = green;

        sys->io_ledctrl = 0x080;

        zip->pic = SYSINT_TMA;

        zip->pic = EINT(SYSINT_TMA);

        zip_rtu();

        sys->io_clrled[3] = dimgreen;

        zip->pic = SYSINT_TMA;

        zip->pic = EINT(SYSINT_TMA);

        zip_rtu();

        for(i=0; i<4; i++)

                sys->io_clrled[i] = black;

        // Wait one second ...

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

                zip->pic = SYSINT_TMA;

                zip->pic = EINT(SYSINT_TMA);

                zip_rtu();

        }

        sw = sys->io_btnsw & 0x0f;

        for(int i=0; i<4; i++)

                sys->io_clrled[i] = (sw & (1<<i)) ? white : black;

        // Wait another two second ...

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

                zip->pic = SYSINT_TMA;

                zip->pic = EINT(SYSINT_TMA);

                zip_rtu();

        }

        // Blink all the LEDs

        //      First turn them on

        sys->io_ledctrl = 0x0ff;

        // Then wait a quarter second

        zip->pic = SYSINT_TMA;

        zip->pic = EINT(SYSINT_TMA)|SYSINT_TMA;

        zip_rtu();

        // Then turn the back off

        sys->io_ledctrl = 0x0f0;

        // and wait another quarter second

        zip->pic = SYSINT_TMA;

        zip->pic = EINT(SYSINT_TMA)|SYSINT_TMA;

        zip_rtu();

        // Now, read buttons, and flash an LED on any button being held

        // down ... ? neat?

        // zip->tma = 20000000; // 1/4 second -- already set

        while(1) {

                unsigned        btn, ledc;

                zip->pic = SYSINT_TMA;

                zip->pic = EINT(SYSINT_TMA);

                zip_rtu();

                // If the button is pressed, toggle the LED

                // Otherwise, turn the LED off.

                //

                // First, get all the pressed buttons

                btn = (sys->io_btnsw >> 4) & 0x0f;

                sys->io_btnsw = 0x0f0;

                // Of any LEDs that are on, or buttons on, toggle their values

                ledc = (sys->io_ledctrl | btn)&0x0f;

                // Make sure we set everything

                ledc |= 0x0f0;

                // Now issue the command

                sys->io_ledctrl = ledc;

                // That way, at the end, the toggle will leave them in the

                // off position.

                // sys->io_ledctrl = 0xf0 | ((sys->io_ledctrl&1)^1);

                sw = sys->io_btnsw & 0x0f;

                for(int i=0; i<4; i++)

                        sys->io_clrled[i] = (sw & (1<<i)) ? white : black;

        }

        zip_halt();

}