// This code drives the RGB LED Matrix on the 1st Connector
#include <stdint.h>
#include <pru_cfg.h>
#include "resource_table_empty.h"
#include "prugpio.h"
#include "rgb_pocket.h"

#define DELAY 10	// Number of cycles (5ns each) to wait after a write

volatile register uint32_t __R30;
volatile register uint32_t __R31;

void main(void)
{
	// Set up the pointers to each of the GPIO ports 
	uint32_t *gpio[] = {
			(uint32_t *) GPIO0, 
			(uint32_t *) GPIO1, 
			(uint32_t *) GPIO2, 
			(uint32_t *) GPIO3
		};
	
	uint32_t i, row;

	while(1) {
	    for(row=0; row<16; row++) {
	    	// Set the row address
			// Here we take advantage of the select bits (LA,LB,LC,LD)
			// being sequential in the R30 register (bits 2,3,4,5)
			// We shift row over so it lines up with the select bits
			// Oring (|=) with R30 sets bits to 1 and
			// Anding (&=) clears bits to 0, the 0xffc mask makes sure the
			// other bits aren't changed.
	        __R30 |=  row<<pru_sel0;
	        __R30 &= (row<<pru_sel0)|0xffc3;

    	    for(i=0; i<64; i++) {
    	    	// Top row white
    	    	// Combining these to one write works because they are all in 
    	    	// the same gpio port
    	      	gpio[r11_gpio][GPIO_SETDATAOUT] = r11_pin | g11_pin | b11_pin;
    	    	__delay_cycles(DELAY);;
    	      	
    	      	// Bottom row red
    	      	gpio[r12_gpio][GPIO_SETDATAOUT]   = r12_pin;
    	    	__delay_cycles(DELAY);
    	      	gpio[r12_gpio][GPIO_CLEARDATAOUT] = g12_pin | b12_pin;
    	    	__delay_cycles(DELAY);
    	      	
                __R30 |=  pru_clock;	// Toggle clock
    	    	__delay_cycles(DELAY);
        		__R30 &= ~pru_clock;
    	    	__delay_cycles(DELAY);
    	    	
    	    	// Top row black
    	    	gpio[r11_gpio][GPIO_CLEARDATAOUT] = r11_pin | g11_pin | b11_pin;
    	    	__delay_cycles(DELAY);
    	      	
    	      	// Bottom row green
    	    	gpio[r12_gpio][GPIO_CLEARDATAOUT] = r12_pin | b12_pin;
    	    	__delay_cycles(DELAY);
    	      	gpio[r12_gpio][GPIO_SETDATAOUT]   = g12_pin;
    	    	__delay_cycles(DELAY);
    	      	
                __R30 |=  pru_clock;	// Toggle clock
    	    	__delay_cycles(DELAY);
        		__R30 &= ~pru_clock;
    	    	__delay_cycles(DELAY);
    	    }
    	    __R30 |=  pru_oe;        // Disable display
    	   	__delay_cycles(DELAY);
    	    __R30 |=  pru_latch;     // Toggle latch
    	   	__delay_cycles(DELAY);
    	    __R30 &= ~pru_latch;
    	   	__delay_cycles(DELAY);
    	    __R30 &= ~pru_oe;        // Enable display
    	    __delay_cycles(DELAY);
	    }
	}
}