CRAC Team / Mbed 2 deprecated carte_esclave_PETIT_ROBOT_2019

carte esclave Petit Robot

Dependencies:   mbed Herkulex_Library_2019 actions_Gr ident_crac actions_Pr

Capteurs/dt.cpp@10:48c0d1b8aed9, 2019-05-18 (annotated)

Committer:
Artiom
Date:
Sat May 18 12:07:01 2019 +0000
Revision:
10:48c0d1b8aed9
Parent:
9:9833e788942b
Child:
25:9627700d989f

        

        
Who changed what in which revision?

        

            
                
UserRevisionLine numberNew contents of line

            
            


Artiom

8:8aeb718824ea


     1

#include "mbed.h"





Artiom

8:8aeb718824ea


     2

#include "dt.h"





Artiom

8:8aeb718824ea


     3

//RawSerial pc(USBTX, USBRX,9600);//serie pour debug





Artiom

8:8aeb718824ea


     4







Artiom

8:8aeb718824ea


     5

AnalogIn DT1(PB_0);





Artiom

8:8aeb718824ea


     6

AnalogIn DT2(PC_5);





Artiom

8:8aeb718824ea


     7

AnalogIn DT3(PC_4);





Artiom

8:8aeb718824ea


     8

AnalogIn DT4(PA_5);





Artiom

8:8aeb718824ea


     9







Artiom

10:48c0d1b8aed9


    10

InterruptIn DT1_isr(PB_1);





Artiom

10:48c0d1b8aed9


    11

InterruptIn DT2_isr(PA_7);





Artiom

10:48c0d1b8aed9


    12

InterruptIn DT3_isr(PA_6);





Artiom

10:48c0d1b8aed9


    13

InterruptIn DT4_isr(PA_4);





Artiom

8:8aeb718824ea


    14







Artiom

9:9833e788942b


    15

Timer t;





Artiom

9:9833e788942b


    16







Artiom

8:8aeb718824ea


    17

double DT1_mes[256]= {0};





Artiom

8:8aeb718824ea


    18

double DT1_trait[256]= {0};





Artiom

8:8aeb718824ea


    19

double DT1_trait_Ex;





Artiom

8:8aeb718824ea


    20







Artiom

8:8aeb718824ea


    21

double DT2_mes[256]= {0};





Artiom

8:8aeb718824ea


    22

double DT2_trait[256]= {0};





Artiom

8:8aeb718824ea


    23

double DT2_trait_Ex;





Artiom

8:8aeb718824ea


    24







Artiom

8:8aeb718824ea


    25

double DT3_mes[256]= {0};





Artiom

8:8aeb718824ea


    26

double DT3_trait[256]= {0};





Artiom

8:8aeb718824ea


    27

double DT3_trait_Ex;





Artiom

8:8aeb718824ea


    28







Artiom

8:8aeb718824ea


    29

double DT4_mes[256]= {0};





Artiom

8:8aeb718824ea


    30

double DT4_trait[256]= {0};





Artiom

8:8aeb718824ea


    31

double DT4_trait_Ex;





Artiom

8:8aeb718824ea


    32







Artiom

10:48c0d1b8aed9


    33

bool DT1_interrupt_Ex;





Artiom

10:48c0d1b8aed9


    34

bool DT2_interrupt_Ex;





Artiom

10:48c0d1b8aed9


    35

bool DT3_interrupt_Ex;





Artiom

10:48c0d1b8aed9


    36

bool DT4_interrupt_Ex;





Artiom

10:48c0d1b8aed9


    37







Artiom

8:8aeb718824ea


    38

unsigned char n = 0;





Artiom

9:9833e788942b


    39

bool flag_t=0;





Artiom

8:8aeb718824ea


    40







Artiom

8:8aeb718824ea


    41

void f_mesure()





Artiom

8:8aeb718824ea


    42

{





Artiom

9:9833e788942b


    43

    if(!flag_t) {





Artiom

9:9833e788942b


    44

        t.start();





Artiom

9:9833e788942b


    45

        flag_t=1;





Artiom

9:9833e788942b


    46

    }





Artiom

9:9833e788942b


    47







Artiom

9:9833e788942b


    48

    if (t.read_ms() >= 4) {





Artiom

9:9833e788942b


    49

        n++;





Artiom

9:9833e788942b


    50

        DT1.read();//lecture dans le vide le temp que l'adc switch





Artiom

9:9833e788942b


    51

        wait_us(100);//attente du switch de l'adc





Artiom

9:9833e788942b


    52

        DT1_mes[n]= DT1.read() * A + B;





Artiom

9:9833e788942b


    53

        DT1_trait[n] = mediane(DT1_mes, 10);





Artiom

9:9833e788942b


    54

        DT1_trait_Ex = DT1_trait[n];





Artiom

8:8aeb718824ea


    55







Artiom

9:9833e788942b


    56

        DT2.read();//lecture dans le vide le temp que l'adc switch





Artiom

9:9833e788942b


    57

        wait_us(100);//attente du switch de l'adc





Artiom

9:9833e788942b


    58

        DT2_mes[n]= DT2.read() * A + B;





Artiom

9:9833e788942b


    59

        DT2_trait[n] = mediane(DT2_mes, 10);





Artiom

9:9833e788942b


    60

        DT2_trait_Ex = DT2_trait[n];





Artiom

9:9833e788942b


    61







Artiom

9:9833e788942b


    62

        DT3.read();//lecture dans le vide le temp que l'adc switch





Artiom

9:9833e788942b


    63

        wait_us(100);//attente du switch de l'adc





Artiom

9:9833e788942b


    64

        DT3_mes[n]= DT3.read() * A + B;





Artiom

9:9833e788942b


    65

        DT3_trait[n] = mediane(DT3_mes, 10);





Artiom

9:9833e788942b


    66

        DT3_trait_Ex = DT3_trait[n];





Artiom

9:9833e788942b


    67







Artiom

9:9833e788942b


    68

        DT4.read();//lecture dans le vide le temp que l'adc switch





Artiom

9:9833e788942b


    69

        wait_us(100);//attente du switch de l'adc





Artiom

9:9833e788942b


    70

        DT4_mes[n]= DT4.read() * A + B;





Artiom

9:9833e788942b


    71

        DT4_trait[n] = mediane(DT4_mes, 10);





Artiom

9:9833e788942b


    72

        DT4_trait_Ex = DT4_trait[n];





Artiom

9:9833e788942b


    73







Artiom

9:9833e788942b


    74

        t.reset();





Artiom

9:9833e788942b


    75

    }





Artiom

9:9833e788942b


    76







Artiom

8:8aeb718824ea


    77

}





Artiom

8:8aeb718824ea


    78







Artiom

8:8aeb718824ea


    79

double mediane(double* buff_med, int size_med)





Artiom

8:8aeb718824ea


    80

{





Artiom

8:8aeb718824ea


    81

    double DT_med[30]= {0};





Artiom

8:8aeb718824ea


    82

    for(unsigned char i =0; i< size_med; i++)DT_med[i] = buff_med[(unsigned char)(n-i)];





Artiom

8:8aeb718824ea


    83







Artiom

8:8aeb718824ea


    84

    tri(DT_med, size_med);





Artiom

8:8aeb718824ea


    85

    return DT_med[(int)(size_med/2)];





Artiom

8:8aeb718824ea


    86

}





Artiom

8:8aeb718824ea


    87







Artiom

8:8aeb718824ea


    88

void tri(double* tab, int size)





Artiom

8:8aeb718824ea


    89

{





Artiom

8:8aeb718824ea


    90

    for (int i=0; i<size; i++) {





Artiom

8:8aeb718824ea


    91

        for(int j=i; j<size; j++) {





Artiom

8:8aeb718824ea


    92

            if(tab[j]<tab[i]) {





Artiom

8:8aeb718824ea


    93

                double temp = tab[i];





Artiom

8:8aeb718824ea


    94

                tab[i] = tab[j];





Artiom

8:8aeb718824ea


    95

                tab[j] = temp;





Artiom

8:8aeb718824ea


    96

            }





Artiom

8:8aeb718824ea


    97

        }





Artiom

8:8aeb718824ea


    98

    }





Artiom

8:8aeb718824ea


    99

}





Artiom

10:48c0d1b8aed9


   100







Artiom

10:48c0d1b8aed9


   101

void interrupt()





Artiom

10:48c0d1b8aed9


   102

{





Artiom

10:48c0d1b8aed9


   103

    DT1_interrupt_Ex = DT1_isr.read();





Artiom

10:48c0d1b8aed9


   104

    DT2_interrupt_Ex = DT2_isr.read();





Artiom

10:48c0d1b8aed9


   105

    DT3_interrupt_Ex = DT3_isr.read();





Artiom

10:48c0d1b8aed9


   106

    DT4_interrupt_Ex = DT4_isr.read();





Artiom

10:48c0d1b8aed9


   107

}





Artiom

10:48c0d1b8aed9


   108







Artiom

10:48c0d1b8aed9


   109