26 lines
620 B
C
Executable file
26 lines
620 B
C
Executable file
#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
|
|
}
|
|
};
|