Transmission roulis okay
This commit is contained in:
parent
058777c5f8
commit
083c6851d6
1 changed files with 19 additions and 7 deletions
|
|
@ -31,7 +31,7 @@ void Transmission_batterie(int batterie){
|
||||||
send_USART_String(USART1,"Batterie : "); //USART3
|
send_USART_String(USART1,"Batterie : "); //USART3
|
||||||
}
|
}
|
||||||
else{
|
else{
|
||||||
send_USART_String(USART1, "ATTENTION LA BATTERIE EST SOUS LES 50% : "); //USART3
|
send_USART_String(USART1, "SEUIL DE BATTERIE ATTEINT : "); //USART3
|
||||||
}
|
}
|
||||||
send_USART(USART1,(batterie/10) + '0'); // Envoie le chiffre des dizaines //USART3
|
send_USART(USART1,(batterie/10) + '0'); // Envoie le chiffre des dizaines //USART3
|
||||||
send_USART(USART1,(batterie%10) + '0'); // Envoie le chiffre des unités //USART3
|
send_USART(USART1,(batterie%10) + '0'); // Envoie le chiffre des unités //USART3
|
||||||
|
|
@ -40,14 +40,26 @@ void Transmission_batterie(int batterie){
|
||||||
}
|
}
|
||||||
|
|
||||||
void Transmission_roulis(char roulis){
|
void Transmission_roulis(char roulis){
|
||||||
if (tickms-last4 >= 1000){
|
char angabs;
|
||||||
|
if (tickms-last4 >= 2000){
|
||||||
last4 = tickms;
|
last4 = tickms;
|
||||||
send_USART_String(USART1, "Angle de roulis : "); //USART3
|
if (roulis >= 40 && !(roulis & (1<<7))){
|
||||||
send_USART(USART1,(roulis/10) + '0'); // Envoie le chiffre des dizaines //USART3
|
|
||||||
send_USART(USART1,(roulis%10) + '0'); // Envoie le chiffre des unités //USART3
|
|
||||||
send_USART_String(USART1," degre(s)\n"); //USART3
|
|
||||||
if (roulis >= 40){
|
|
||||||
send_USART_String(USART1, "ANGLE DE ROULIS TROP ELEVE : DEBORDAGE!!! \n"); //USART3
|
send_USART_String(USART1, "ANGLE DE ROULIS TROP ELEVE : DEBORDAGE!!! \n"); //USART3
|
||||||
|
send_USART(USART1,(roulis/10) + '0'); // Envoie le chiffre des dizaines //USART3
|
||||||
|
send_USART(USART1,(roulis%10) + '0'); // Envoie le chiffre des unités //USART3
|
||||||
}
|
}
|
||||||
|
else if (roulis & (1<<7)) {
|
||||||
|
angabs = (1<<7) - (roulis & 0x7F);
|
||||||
|
if (angabs >= 40) send_USART_String(USART1, "ANGLE DE ROULIS TROP ELEVE : DEBORDAGE!!! \n"); //USART3
|
||||||
|
else send_USART_String(USART1, "Angle de roulis : ");
|
||||||
|
send_USART(USART1,(angabs/10) + '0');
|
||||||
|
send_USART(USART1,(angabs%10) + '0');
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
send_USART_String(USART1, "Angle de roulis : "); //USART3
|
||||||
|
send_USART(USART1,(roulis/10) + '0'); // Envoie le chiffre des dizaines //USART3
|
||||||
|
send_USART(USART1,(roulis%10) + '0'); // Envoie le chiffre des unités //USART3
|
||||||
|
}
|
||||||
|
send_USART_String(USART1," degre(s)\n"); //USART3
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
Loading…
Reference in a new issue