#include "stm32f10x.h"
#include <Driver_GPIO.h>
#include <MyTimer.h>
#include <MyADC.h>
#include <Plateau.h>
#include <Telecommande.h>
#include <Batterie.h>
#include <MyGirouette.h>
#include <MyVoile.h>

int droite;
int b;
int testBatterie ;
int bat;

void f (char a) {


	if (a>> 7 & 1) {
		droite = 1;
		b = 256 - a;
		Set_Moteur_Plateau(HORRAIRE, b);
	}
	else {
		droite = 0;
		b = a;
		Set_Moteur_Plateau(ANTI_HORRAIRE, b);
	}
}



int main (void)
{

    char* visuBatterie = "[-----]";
    /* Pour la telecommande */
    Init_USART(USART1);
    Init_Message_Reception(&f);
    Init_Plateau();
 	Init_Girouette();
 	MyVoile_Init();

	/* Batterie */
	Init_Batterie();
	while (1) {
	    Set_Voile(Get_Angle());
		bat = Get_Batterie();
		if (bat < 20) {
			visuBatterie = "[-----]";
		} else if (bat < 40) {
			visuBatterie = "[##---]";
		} else if (bat < 60) {
			visuBatterie = "[###--]";
		} else if (bat < 80) {
			visuBatterie = "[####-]";
		} else {
			visuBatterie = "[#####]";
		}

		Send_Message("Batterie : ");
		Send_Message(visuBatterie);
		Send_Message("\r");
	}

	
	

	do {
		}
	while (1);
}