Modif Voilier (main)
This commit is contained in:
parent
90f8251e3b
commit
0fc121930f
1 changed files with 70 additions and 1 deletions
|
@ -1,4 +1,73 @@
|
|||
#include "Allure.h"
|
||||
#include "AntiChavirement.h"
|
||||
#include "Batterie.h"
|
||||
#include "Gouvernail.h"
|
||||
#include "Heure.h"
|
||||
#include "Transmission.h"
|
||||
#include "Voile.h"
|
||||
|
||||
|
||||
/**
|
||||
* @brief configure tous les periphs qu'on va utiliser en appelant les
|
||||
fonctions de config de chaque "module"
|
||||
* @note
|
||||
* @param None
|
||||
* @retval None
|
||||
*/
|
||||
void Setup(){
|
||||
ConfAllure();
|
||||
ConfVoile();
|
||||
ConfGouvernail();
|
||||
ConfAntiChavirement();
|
||||
|
||||
}
|
||||
|
||||
|
||||
//on utilise EnvoiRegulier de Transmission
|
||||
//TODO : récuperer les valeurs des params de EnvoiRegulier
|
||||
//Interruption toute les 3s via un Timer qui déclenche cette fonction qui permet d'envoyer ce qu'il faut
|
||||
|
||||
/**
|
||||
* @brief
|
||||
* @note
|
||||
* @param
|
||||
* @retval
|
||||
*/
|
||||
void Envoi3s(){
|
||||
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief tache qui va fonctionner en fond qui gere l'orientation
|
||||
des voiles, le gouvernail et aussi le systeme anti-chavirement
|
||||
* @note relacher les voiles <=> tendre les voiles avec un angle à 90°
|
||||
* @param None
|
||||
* @retval None
|
||||
*/
|
||||
void Background(){
|
||||
//Voiles
|
||||
int allure = RecupAllure(); //on recupere l'allulre via la girouette
|
||||
int tensionVoile = CalculerTension(allure); //grace à l'allure on peut calculer la tension à appliquer sur la voile
|
||||
TendreVoile(tensionVoile); //on tend la voile grâce à la tension obtenue
|
||||
|
||||
//Gouvernail
|
||||
int valeurTelecommande = LireTelecommande(); //on lit la valeur renvoyée par la télécommande
|
||||
int vitesse = CalculerVitesse(valeurTelecommande);//gràace à la valeur de la telecommande on calcule la vitesse souhaitée
|
||||
CommanderMoteur(vitesse);//On commande le moteur pour aller à la vitesse voulue
|
||||
|
||||
//Anti-Chavirement
|
||||
int rouli = RecupRouli();
|
||||
int danger = CalculerDanger(rouli);//renvoi boolean : int à 0 si faux et 1 si vrai
|
||||
if(danger){
|
||||
TendreVoile(90); //si il y a danger on relache les voiles (relacher les voiles = les mettre à 90)
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
int main(){
|
||||
//c'est le main ici
|
||||
Setup();
|
||||
while(1){
|
||||
Background();
|
||||
}
|
||||
return 0;
|
||||
}
|
Loading…
Reference in a new issue