Révision 432
Ajouté par maporte3 il y a plus de 6 ans
| branch/porte/Emb_App/programme_principal_etud.c | ||
|---|---|---|
|
int vit=0, i=1, Distance;
|
||
|
int Angle_R=0; //Angle des roues
|
||
|
unsigned short Vitesse_vert=50,Vitesse_bleu=37,Vitesse_rouge=30, Vitesse_noir=12;
|
||
|
unsigned short Vitesse_vert_virage=33, Vitesse_bleu_virage=28, Vitesse_rouge_virage=20, Vitesse_rouge_saut=45;
|
||
|
unsigned short Vitesse_vert_virage=33, Vitesse_bleu_virage=28, Vitesse_rouge_virage=23, Vitesse_rouge_saut=45;
|
||
|
//Variable de la fonction Capteur
|
||
|
unsigned int Info_capteur, couleur_capteur, num_capteur;
|
||
|
//Variable de la fonction Distance_bord
|
||
|
unsigned int Bord_defaut=0, ecart=400, distance_bord_vert=810, distance_bord=780, distance_bord_noir=500;
|
||
|
unsigned int Bord_defaut=0, ecart=500, distance_bord_vert=810, distance_bord=780, distance_bord_noir=500;
|
||
|
//Variable des fonctions IHM
|
||
|
short Touche_clavier;
|
||
|
float Temps=0;
|
||
| ... | ... | |
|
snd_dtq (CanTx,demande.msg); // Interrogation du peripherique sur le temps de course actuel.
|
||
|
Temps=periph[ADDR('H')].val; // contient la valeur de retour du simulateur sur le temps de course actuel.
|
||
|
|
||
|
lcd_init();
|
||
|
switch(Num_circuit){
|
||
|
case 1: lcd_str("VERT"); break;
|
||
|
case 2: lcd_str("BLEU"); break;
|
||
|
case 3: lcd_str("ROUGE"); break;
|
||
|
case 4: lcd_str("NOIR"); break;
|
||
|
default : lcd_str("Inconnu");
|
||
|
if(Bp_D == 0){
|
||
|
lcd_init();
|
||
|
switch(Num_circuit){
|
||
|
case 1: lcd_str("VERT"); break;
|
||
|
case 2: lcd_str("BLEU"); break;
|
||
|
case 3: lcd_str("ROUGE"); break;
|
||
|
case 4: lcd_str("NOIR"); break;
|
||
|
default : lcd_str("Inconnu");
|
||
|
}
|
||
|
lcd_putc('|');
|
||
|
switch(couleur_capteur){
|
||
|
case 0x560: lcd_str("VERT"); break;
|
||
|
case 0x430: lcd_str("NOIR"); break;
|
||
|
case 0x520: lcd_str("ROUGE"); break;
|
||
|
case 0x4a0: lcd_str("JAUNE"); break;
|
||
|
case 0x420: lcd_str("BLEU"); break;
|
||
|
default : lcd_str("!!");
|
||
|
}
|
||
|
lcd_putc('|');
|
||
|
//lcd_str('Temps');
|
||
|
}
|
||
|
lcd_putc('|');
|
||
|
switch(couleur_capteur){
|
||
|
case 0x560: lcd_str("VERT"); break;
|
||
|
case 0x430: lcd_str("NOIR"); break;
|
||
|
case 0x520: lcd_str("ROUGE"); break;
|
||
|
case 0x4a0: lcd_str("JAUNE"); break;
|
||
|
case 0x420: lcd_str("BLEU"); break;
|
||
|
default : lcd_str("!!");
|
||
|
}
|
||
|
lcd_putc('|');
|
||
|
//lcd_str('Temps');
|
||
|
|
||
|
|
||
|
|
||
| ... | ... | |
|
}
|
||
|
|
||
|
void Led_Jaune(){
|
||
|
|
||
|
if(Bord_defaut == 1){
|
||
|
LED_J=1;
|
||
|
dly_tsk(1000);
|
||
|
LED_J=0;
|
||
|
while(1){
|
||
|
if(Bord_defaut == 1){
|
||
|
LED_J=1;
|
||
|
dly_tsk(1000);
|
||
|
LED_J=0;
|
||
|
}
|
||
|
dly_tsk(1000);
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
|
// +-----------------------------------------------------+
|
||
Formats disponibles : Unified diff
Gèle de l'afficheur si appui sur le bouton de droite