AresENSEA-CDF2020 / Mbed 2 deprecated AresCDFMainCode_capteur_US

Capteur_US

Dependencies:   mbed DRV8825

debug.cpp@0:dc036b67c87c, 2020-07-08 (annotated)

Committer:
Nanaud
Date:
Wed Jul 08 19:51:28 2020 +0000
Revision:
0:dc036b67c87c
Child:
1:2fe8c402ee79
Code principal du projet

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Nanaud 0:dc036b67c87c 1 #include "pins.h"
Nanaud 0:dc036b67c87c 2
Nanaud 0:dc036b67c87c 3 void serialIT(){
Nanaud 0:dc036b67c87c 4 //pc.printf("\n\rserialIT on\n\r");
Nanaud 0:dc036b67c87c 5 static int i=0;
Nanaud 0:dc036b67c87c 6 static char buffer[10]=""; // Tableau qui contient la chaine de caractère rentrée dans le terminal.
Nanaud 0:dc036b67c87c 7 static char cmd[Lcmd]=""; // Variable qui retient que les premiers caractères qui représentent la commande.
Nanaud 0:dc036b67c87c 8 char tampon = pc.getc();
Nanaud 0:dc036b67c87c 9
Nanaud 0:dc036b67c87c 10 if((tampon >= 48 && tampon <=57) || (tampon>=97 && tampon<=122) || tampon==13)
Nanaud 0:dc036b67c87c 11 {
Nanaud 0:dc036b67c87c 12 buffer[i]=tampon; // Ajout du caractère dans le tableau buffer
Nanaud 0:dc036b67c87c 13 pc.putc(buffer[i]); // Réécriture sur le terminal du caractère envoyé
Nanaud 0:dc036b67c87c 14 i++;
Nanaud 0:dc036b67c87c 15 }
Nanaud 0:dc036b67c87c 16
Nanaud 0:dc036b67c87c 17 if(buffer[i-1]=='\r'){ // Attente un appui sur la touche entrée
Nanaud 0:dc036b67c87c 18 i=0;
Nanaud 0:dc036b67c87c 19 copieTab(buffer,cmd); // Sauvegarde la commande dans le tableau cmd
Nanaud 0:dc036b67c87c 20 cmdChoice(cmd);
Nanaud 0:dc036b67c87c 21 }
Nanaud 0:dc036b67c87c 22 }
Nanaud 0:dc036b67c87c 23
Nanaud 0:dc036b67c87c 24 void copieTab(char *tab1,char *tab2){ // Fonction qui recopie un tableau dans un autre
Nanaud 0:dc036b67c87c 25 //pc.printf("\n\rcopieTab on\n\r");
Nanaud 0:dc036b67c87c 26 //pc.printf("\n\r");
Nanaud 0:dc036b67c87c 27 for(int j=0;j<Lcmd;j++){
Nanaud 0:dc036b67c87c 28 tab2[j]=tab1[j];
Nanaud 0:dc036b67c87c 29 //pc.printf("%c",tab2[j]);
Nanaud 0:dc036b67c87c 30 }
Nanaud 0:dc036b67c87c 31 //pc.printf("\n\r");
Nanaud 0:dc036b67c87c 32 }
Nanaud 0:dc036b67c87c 33
Nanaud 0:dc036b67c87c 34 void cmdChoice(char *cmd){ // Fonction qui permet de choisir de l'activation d'une commande
Nanaud 0:dc036b67c87c 35 //pc.printf("\n\rcmdChoice on\n\rcmd =");
Nanaud 0:dc036b67c87c 36
Nanaud 0:dc036b67c87c 37 const char *options[]={
Nanaud 0:dc036b67c87c 38 "help", //0
Nanaud 0:dc036b67c87c 39 "usao", //1
Nanaud 0:dc036b67c87c 40 "us1o", //2
Nanaud 0:dc036b67c87c 41 "us2o", //3
Nanaud 0:dc036b67c87c 42 "us3o", //4
Nanaud 0:dc036b67c87c 43 "us4o", //5
Nanaud 0:dc036b67c87c 44 "us5o", //6
Nanaud 0:dc036b67c87c 45 "us6o", //7
Nanaud 0:dc036b67c87c 46 "tdrv", //8
Nanaud 0:dc036b67c87c 47 "cdon", //9
Nanaud 0:dc036b67c87c 48 "cdga", //10
Nanaud 0:dc036b67c87c 49 "cdgb", //11
Nanaud 0:dc036b67c87c 50 0
Nanaud 0:dc036b67c87c 51 };
Nanaud 0:dc036b67c87c 52
Nanaud 0:dc036b67c87c 53 long option=-1;
Nanaud 0:dc036b67c87c 54
Nanaud 0:dc036b67c87c 55 for (long a=0; options[a] && option<0; a++){
Nanaud 0:dc036b67c87c 56 if (!strcmp(cmd,options[a]) || strcmp(cmd,options[a])==1){ // strcmp(cmd,options[a])==1 permet de contourner le problème, à revoir !!!
Nanaud 0:dc036b67c87c 57 option=a;
Nanaud 0:dc036b67c87c 58 }
Nanaud 0:dc036b67c87c 59 //pc.printf("res = %d",strcmp(cmd,options[a]));
Nanaud 0:dc036b67c87c 60 }
Nanaud 0:dc036b67c87c 61
Nanaud 0:dc036b67c87c 62 switch (option) {
Nanaud 0:dc036b67c87c 63 case 0: //help
Nanaud 0:dc036b67c87c 64 pc.printf("\n\n\r###HELP###\n\r");
Nanaud 0:dc036b67c87c 65 pc.printf("usao : Affichage resultats capteurs a ultrasons\n\r");
Nanaud 0:dc036b67c87c 66 pc.printf("usxo : Affichage resultat capteur ultrasons x\n\r");
Nanaud 0:dc036b67c87c 67 pc.printf("tdrv : Lance la fonction test_drv()\n\r");
Nanaud 0:dc036b67c87c 68 pc.printf("cdon : Affichage resultats codeurs\n\r");
Nanaud 0:dc036b67c87c 69 pc.printf("cdgx : Affichage resultats codeur gauche phase x (a ou b)\n\r");
Nanaud 0:dc036b67c87c 70 pc.printf("\n\r");
Nanaud 0:dc036b67c87c 71 break;
Nanaud 0:dc036b67c87c 72 case 1: //usao
Nanaud 0:dc036b67c87c 73 pc.printf("Capt US ALL ON/OFF\n\r");
Nanaud 0:dc036b67c87c 74 aff_US[0]=!aff_US[0];aff_US[1]=!aff_US[1];aff_US[2]=!aff_US[2];
Nanaud 0:dc036b67c87c 75 aff_US[3]=!aff_US[3];aff_US[4]=!aff_US[4];aff_US[5]=!aff_US[5];
Nanaud 0:dc036b67c87c 76 break;
Nanaud 0:dc036b67c87c 77 case 2: //us1o
Nanaud 0:dc036b67c87c 78 pc.printf("Capt US 1 ON/OFF\n\r");
Nanaud 0:dc036b67c87c 79 aff_US[0]=!aff_US[0];
Nanaud 0:dc036b67c87c 80 break;
Nanaud 0:dc036b67c87c 81 case 3: //us2o
Nanaud 0:dc036b67c87c 82 pc.printf("Capt US 2 ON/OFF\n\r");
Nanaud 0:dc036b67c87c 83 aff_US[1]=!aff_US[1];
Nanaud 0:dc036b67c87c 84 break;
Nanaud 0:dc036b67c87c 85 case 4: //us3o
Nanaud 0:dc036b67c87c 86 pc.printf("Capt US 3 ON/OFF\n\r");
Nanaud 0:dc036b67c87c 87 aff_US[2]=!aff_US[2];
Nanaud 0:dc036b67c87c 88 break;
Nanaud 0:dc036b67c87c 89 case 5: //us4o
Nanaud 0:dc036b67c87c 90 pc.printf("Capt US 4 ON/OFF\n\r");
Nanaud 0:dc036b67c87c 91 aff_US[3]=!aff_US[3];
Nanaud 0:dc036b67c87c 92 break;
Nanaud 0:dc036b67c87c 93 case 6: //us5o
Nanaud 0:dc036b67c87c 94 pc.printf("Capt US 5 ON/OFF\n\r");
Nanaud 0:dc036b67c87c 95 aff_US[4]=!aff_US[4];
Nanaud 0:dc036b67c87c 96 break;
Nanaud 0:dc036b67c87c 97 case 7: //us6o
Nanaud 0:dc036b67c87c 98 pc.printf("Capt US 6 ON/OFF\n\r");
Nanaud 0:dc036b67c87c 99 aff_US[5]=!aff_US[5];
Nanaud 0:dc036b67c87c 100 break;
Nanaud 0:dc036b67c87c 101 case 8: //tdrv
Nanaud 0:dc036b67c87c 102 pc.printf("Fonction test_drv()\n\r");
Nanaud 0:dc036b67c87c 103 test_drv();
Nanaud 0:dc036b67c87c 104 break;
Nanaud 0:dc036b67c87c 105 case 9: //cdon
Nanaud 0:dc036b67c87c 106 pc.printf("Results ALL Encoders ON/OFF\n\r");
Nanaud 0:dc036b67c87c 107 aff_cd[0]=!aff_cd[0];
Nanaud 0:dc036b67c87c 108 aff_cd[1]=!aff_cd[1];
Nanaud 0:dc036b67c87c 109 break;
Nanaud 0:dc036b67c87c 110 case 10: //cdga
Nanaud 0:dc036b67c87c 111 pc.printf("Results Encoder Left A ON/OFF\n\r");
Nanaud 0:dc036b67c87c 112 aff_cd[0]=!aff_cd[0];
Nanaud 0:dc036b67c87c 113 break;
Nanaud 0:dc036b67c87c 114 case 11: //cdgb
Nanaud 0:dc036b67c87c 115 pc.printf("Results Encoder Left B ON/OFF\n\r");
Nanaud 0:dc036b67c87c 116 aff_cd[1]=!aff_cd[1];
Nanaud 0:dc036b67c87c 117 break;
Nanaud 0:dc036b67c87c 118 default:
Nanaud 0:dc036b67c87c 119 pc.printf("Commande invalide\n\r");
Nanaud 0:dc036b67c87c 120 }
Nanaud 0:dc036b67c87c 121 }
Nanaud 0:dc036b67c87c 122
Nanaud 0:dc036b67c87c 123 void affUltrasons(){
Nanaud 0:dc036b67c87c 124 if(aff_US[0]) printf("Tps US1 = %5.0f uS\n\r", us_out[0]);
Nanaud 0:dc036b67c87c 125 if(aff_US[1]) printf("Tps US2 = %5.0f uS\n\r", us_out[1]);
Nanaud 0:dc036b67c87c 126 if(aff_US[2]) printf("Tps US3 = %5.0f uS\n\r", us_out[2]);
Nanaud 0:dc036b67c87c 127 if(aff_US[3]) printf("Tps US4 = %5.0f uS\n\r", us_out[3]);
Nanaud 0:dc036b67c87c 128 if(aff_US[4]) printf("Tps US5 = %5.0f uS\n\r", us_out[4]);
Nanaud 0:dc036b67c87c 129 if(aff_US[5]) printf("Tps US6 = %5.0f uS\n\r", us_out[5]);
Nanaud 0:dc036b67c87c 130 if(aff_US[0]||aff_US[1]||aff_US[2]||aff_US[3]||aff_US[4]||aff_US[5]) printf("\n\r");
Nanaud 0:dc036b67c87c 131 }
Nanaud 0:dc036b67c87c 132
Nanaud 0:dc036b67c87c 133 void affCodeurs(){
Nanaud 0:dc036b67c87c 134 if(aff_cd[0]) printf("CdgA = %d\n\r", cpt_cdgA);
Nanaud 0:dc036b67c87c 135 if(aff_cd[1]) printf("CdgB = %d\n\r", cpt_cdgB);
Nanaud 0:dc036b67c87c 136 }
Nanaud 0:dc036b67c87c 137