#include<msp430x14x.h>
#include "lcd.h"
#include "portyLcd.h"

unsigned char i;
unsigned char znak;

int adres;
float pole;
int linia;
int poziom;
int ink1;
int ink2;
int granica;
int linia_paletki;

void polozenie_paletki(int a) {
	if (a) {
		if (granica >= 0)
			granica--;
	}
	else {
		if (granica <= 9)
			granica++;
	}
}


void paletka() {

	SEND_CMD(CG_RAM_ADDR + 1);
	int x;
	int a = granica;
	if (a >= 5) {
		a = granica - 5;

	}

	for (x = 0;x<8;x++) {
		if (a <= x&&a + 4>x)
			SEND_CHAR(16);
		else
			SEND_CHAR(0);
	}
	if (granica<5)
		SEND_CMD(DD_RAM_ADDR);
	else
		SEND_CMD(DD_RAM_ADDR + 40);
	SEND_CHAR(1);
}
void pilka(int a1, int a2, int a3, int a4, int a5, int a6, int a7, int a8, int addr) {
	int znaczek[8] = { a1,a2,a3,a4,a5,a6,a7,a8 };
	SEND_CMD(CG_RAM_ADDR);
	int x;
	for (x = 0;x<8;x++)
		SEND_CHAR(znaczek[x]);
	SEND_CMD(DD_RAM_ADDR + addr);
	SEND_CHAR(0);
}

void increment() {
	if (adres == 15 || adres == 55)
		ink1 = 1;
	if (adres == 0 || adres == 40)
		ink1 = 0;

	if (ink1 == 0 && pole == 1)
		adres++;
	if (ink1 == 1 && pole == 16)
		adres--;

	if (ink1 == 0)
		pole = pole / 2;

	if (ink1 == 1)
		pole = pole * 2;

	if (ink1 == 0 && pole == 1)
		pole = 16;
	if (ink1 == 1 && pole == 16)
		pole = 1;
	if (linia == 2 && adres <= 15)
		adres = adres + 40;
	if (linia == 1 && adres >= 40)
		adres = adres - 40;
}
void cross() {
	if (poziom == 7 && linia == 2)
		ink2 = 1;

	if (poziom == 0 && linia == 1)
		ink2 = 0;


	if (ink2 == 0 && poziom == 7 && linia == 1) {

		linia = 2;
		poziom = 0;
	}
	if (ink2 == 1 && poziom == 0 && linia == 2) {

		linia = 1;
		poziom = 7;
	}
	if (ink2)
		poziom--;
	else
		poziom++;
}


void wyswietl_pilke() {

	if (poziom == 0)
		pilka(pole, 0, 0, 0, 0, 0, 0, 0, adres)
		if (poziom == 1)
			pilka(0, pole, 0, 0, 0, 0, 0, 0, adres)
			if (poziom == 2)
				pilka(0, 0, pole, 0, 0, 0, 0, 0, adres)
				if (poziom == 3)
					pilka(0, 0, 0, pole, 0, 0, 0, 0, adres)
					if (poziom == 4)
						pilka(0, 0, 0, 0, pole, 0, 0, 0, adres)
						if (poziom == 5)
							pilka(0, 0, 0, 0, 0, pole, 0, 0, adres)
							if (poziom == 6)
								pilka(0, 0, 0, 0, 0, 0, pole, 0, adres)
								if (poziom == 7)
									pilka(0, 0, 0, 0, 0, 0, 0, pole, adres)




}

void main(void)
{
	// STATUS LED
	WDTCTL = WDTPW + WDTHOLD;                        // zatrzymanie WDT
	float a, b;int y;
	InitPortsLcd();                               // inicjalizacja portów
	InitLCD();                                    // inicjalizacja LCD
	clearDisplay();                               // czyszczenie LCD
	linia = 1;
	adres = 0;
	pole = 0;
	poziom = 0;
	while (1)                                    // nieskończona pętla
	{







	}