#include <stm32f10x.h>
#include <stdio.h> // Pour print

#include "Girouette.h"
#include "Servo.h"


//Variables
int angleVentVar;
int angleVoileVar;

int main ( void ){
  // ---- Setup ------
  //Servo.c
  initServo(TIM4, 3);
  // Giroutte.c
  configEncoder(TIM2);
  
	LocaliserZero();
	// ----- Opération -----
  while (1){
    angleVentVar = angleVent(TIM2); // Récupérer l'angle de girouette
    angleVoileVar = vent2voile(angleVentVar); // Transformer l'angle de girouette au l'angle des voiles souhaités
    Servo_Moteur(angleVoileVar, TIM4, 3); // Faire bouger le moteur servo
  }	
};