#include <platform-config.h>
#include <board/bsp.h>
#include "app/factory.h"

using namespace QP;
void delay(int counter);

void delay(int counter)
	{
	uint16_t del = 0;
		for(del = 0; del < counter ; del ++)
		{
			for(uint16_t del_counter = 0 ; del_counter < 1680 ; del_counter ++){/*NOP*/}
		}
	}

int main()
{
//=====================================================================================================
// Initialisation
//=====================================================================================================
	BSP_init();			// Initialize board specific stuff
	QF::init();			// Initialize execution framework

	factory.build();	// Construct, initialize application


//=====================================================================================================
//Definition of the Variables
//=====================================================================================================
	uint16_t buttonsState;
	int VarSenkrecht = 0;
	int VarWaagrecht = 0;
	int keyLock = 0;
	int var_tast9 = 0;
	int var_tast8 = 0;
	int var_tast7 = 0;
	int var_tast6 = 0;
	int var_tast5 = 0;
	int var_tast4 = 0;
	int var_tast3 = 0;
	int var_tast2 = 0;
	int var_tast1 = 0;
	int var_taste = 0;

//=====================================================================================================
// keyboard request
//=====================================================================================================
	while (true)
	{
		do
		{

			switch(VarWaagrecht)
			{
				case 0: factory.buttonController().Taster4(true);
						factory.buttonController().Taster1(false);
						break;
				case 1: factory.buttonController().Taster1(true);
						factory.buttonController().Taster2(false);
						break;
				case 2: factory.buttonController().Taster2(true);
						factory.buttonController().Taster3(false);
						break;
				case 3: factory.buttonController().Taster3(true);
						factory.buttonController().Taster4(false);
						break;
			}
			delay(100);
			buttonsState = factory.buttonController().readButtonsValue();
			VarSenkrecht = (buttonsState & 0xF0);

//=====================================================================================================
// which Button is pressed?
//=====================================================================================================
			if(keyLock == 0)
			{
				switch(VarWaagrecht)
				{
				case 0:	switch(VarSenkrecht)
						{
						case 16: keyLock = 1;
								factory.ledController().myLed7(true);
								var_taste = 13;
								break;
						case 32: keyLock = 1;
								factory.ledController().myLed7(false);
								var_taste = 14;
								break;
						case 64: keyLock = 1;
								factory.ledController().myLed7(true);
								var_taste = 15;
								break;
						case 128: keyLock = 1;
								factory.ledController().myLed7(false);
								var_taste = 16;
								break;
						}
						break;
				case 1:	switch(VarSenkrecht)
						{
						case 16: keyLock = 1;
								factory.ledController().myLed7(true);
								var_taste = 9;
								break;
						case 32: keyLock = 1;
								factory.ledController().myLed7(false);
								var_taste = 10;
								break;
						case 64: keyLock = 1;
								factory.ledController().myLed7(true);
								var_taste = 11;
								break;
						case 128: keyLock = 1;
								factory.ledController().myLed7(false);
								var_taste = 12;
								break;
						}
						break;
				case 2:	switch(VarSenkrecht)
						{
						case 16: keyLock = 1;
								factory.ledController().myLed7(true);
								var_taste = 1;
								break;
						case 32: keyLock = 1;
								factory.ledController().myLed7(false);
								var_taste = 2;
								break;
						case 64: keyLock = 1;
								factory.ledController().myLed7(true);
								var_taste = 3;
								break;
						case 128: keyLock = 1;
								factory.ledController().myLed7(false);
								var_taste = 4;
								break;
						}
						break;
				case 3:	switch(VarSenkrecht)
						{
						case 16: keyLock = 1;
								factory.ledController().myLed7(true);
								var_taste = 5;
								break;
						case 32: keyLock = 1;
								factory.ledController().myLed7(false);
								var_taste = 6;
								break;
						case 64: keyLock = 1;
								factory.ledController().myLed7(true);
								var_taste = 7;
								break;
						case 128: keyLock = 1;
								factory.ledController().myLed7(false);
								var_taste = 8;
								break;
						}
						break;
				}
			}
			delay(100);
			if((keyLock == 1) && ((buttonsState & 0xF0)==0))
			{
				keyLock = 0;
			}

			VarWaagrecht++;
			if(VarWaagrecht == 0x04)
			{
				VarWaagrecht = 0;
			}

//=====================================================================================================
// PIN correct?
//=====================================================================================================
			if(var_taste > 0)
			{
				var_tast9 =  var_tast8;
				var_tast8 =  var_tast7;
				var_tast7 =  var_tast6;
				var_tast6 =  var_tast5;
				var_tast5 =  var_tast4;
				var_tast4 =  var_tast3;
				var_tast3 =  var_tast2;
				var_tast2 =  var_tast1;
				var_tast1 =  var_taste;
				var_taste = 0;
			}
			// überprüfen des ersten Codes
		//if((var_tast1 == 9) && (var_tast2 == 8) && (var_tast3 == 7) &&(var_tast4 == 6) && (var_tast5 == 5) &&(var_tast6 == 4) &&(var_tast7 == 3) && (var_tast8 == 2)&& (var_tast9 == 1))
			if((var_tast1 == 3) && (var_tast2 == 2))
			{// zurücksetzten aller Eingaben
				var_tast9 =  0;
				var_tast8 =  0;
				var_tast7 =  0;
				var_tast6 =  0;
				var_tast5 =  0;
				var_tast4 =  0;
				var_tast3 =  0;
				var_tast2 =  0;
				var_tast1 =  0;
				factory.ledController().myLed6(false);

			}
//===========================================================================================
		}
		while(1);
	}
	QF::run();			// Run execution framework
	return 0;
}