/*****************************************************************//**
 * @file main_sampler_test.cpp
 *
 * @brief Basic test of nexys4 ddr mmio cores
 *
 * @author p chu
 * @version v1.0: initial release
 *********************************************************************/

// #define _DEBUG
#include "chu_init.h"
#include "gpio_cores.h"
#include "xadc_core.h"
#include "sseg_core.h"
#include "spi_core.h"
#include "i2c_core.h"
#include "ps2_core.h"
#include "ddfs_core.h"
#include "adsr_core.h"

bool reset = false;

int getBtnPress(DebounceCore *dbc, GpoCore *gpc, GpiCore *gpi){
	while(!reset){
		reset = gpi->read(0);
		for(int i = 0; i < 5; i++){
			int p = dbc->read_db(i);
			if(p == 1){
				gpc->write(1,i);
				return i;
			}else{
				gpc->write(0,i);
			}
		}
	}
	return -1;
}

void ssegShow(SsegCore *sseg_p, int in_val, int dots[4]) {
	int d[4] = {(in_val&0xf),(in_val&0xff)>>0x4,(in_val&0xfff)>>0x8,(in_val&0xffff)>>0xC};
	for(int i = 0; i < 4; i++){
		uint8_t k = sseg_p->h2s(d[i]);
		sseg_p->write_1ptn(k, i);
		sseg_p->set_dp(dots[i]);
	}
}

void wait1s(TimerCore *tmr, int mult){
	tmr->sleep(mult);
}
void displayInc(SsegCore *sseg_p, TimerCore *tmr, int val, int dots[4]){
	ssegShow(sseg_p, val, dots);
	wait1s(tmr, 1000000);
	return;
}

bool read(GpiCore *gpi){
	reset = gpi->read(0);
	if(gpi->read(0)){
		return true;
	}else{
		return false;
	}
}

TimerCore tmr(get_slot_addr(BRIDGE_BASE,S0_SYS_TIMER));
GpoCore led(get_slot_addr(BRIDGE_BASE, S2_LED));
GpiCore sw(get_slot_addr(BRIDGE_BASE, S3_SW));
XadcCore adc(get_slot_addr(BRIDGE_BASE, S5_XDAC));
PwmCore pwm(get_slot_addr(BRIDGE_BASE, S6_PWM));
DebounceCore btn(get_slot_addr(BRIDGE_BASE, S7_BTN));
SsegCore sseg(get_slot_addr(BRIDGE_BASE, S8_SSEG));
SpiCore spi(get_slot_addr(BRIDGE_BASE, S9_SPI));
I2cCore adt7420(get_slot_addr(BRIDGE_BASE, S10_I2C));
Ps2Core ps2(get_slot_addr(BRIDGE_BASE, S11_PS2));
DdfsCore ddfs(get_slot_addr(BRIDGE_BASE, S12_DDFS));
AdsrCore adsr(get_slot_addr(BRIDGE_BASE, S13_ADSR), &ddfs);

//0 = 1, 2 = 5, 3 = 10, 1 = 20, 4 = toggle
int main() {
	int dots[4] = {0,0,0,0};
	ssegShow(&sseg,0x0000,dots);
	int tot = 0x0;
	int dir = 1;
	read(&sw);
	while(true){

		int sel = getBtnPress(&btn,&led,&sw);
		if(read(&sw)){
			tot = 0x0;
			dir = 1;
			ssegShow(&sseg, 0x0, dots);
		}else{
			switch(sel){
			case 0:
				displayInc(&sseg,&tmr,0x1,dots);
				tot+=0x1*dir;
				ssegShow(&sseg, tot, dots);
				break;
			case 1:
				displayInc(&sseg,&tmr,0x14,dots);
				tot+=0x14*dir;
				ssegShow(&sseg, tot, dots);
				break;
			case 2:
				displayInc(&sseg,&tmr,0x5,dots);
				tot+=0x5*dir;
				ssegShow(&sseg, tot, dots);
				break;
			case 3:
				displayInc(&sseg,&tmr,0xA,dots);
				tot+=0xA*dir;
				ssegShow(&sseg, tot, dots);
				break;
			case 4:

				if(dir == 1){
					dir = -1;
				}else{
					dir = 1;
				}
				wait1s(&tmr, 1000000);
				break;
			default:
				break;

			}
		}
	}

} //main