Carte esclave gros robot

Dependencies:   mbed Herkulex_Library_2019 ident_crac actions_Pr

lecture_girouette_copy/lecture_girouette.cpp

Committer:
gein
Date:
2022-04-22
Revision:
54:529b24478996
Parent:
53:b7d2682fba44

File content as of revision 54:529b24478996:

#include "main.h"

DigitalIn captuer_haut_girou(PC_3) ;
DigitalIn captuer_bas_girou(PB_10) ;

// noir = 1 // blanc = 0

char lecture_girouette (void) 
{
    char val_cpt_haut, val_cpt_bas ;
    val_cpt_haut = captuer_haut_girou.read() ;
    val_cpt_bas = captuer_bas_girou.read() ;
    
    if(val_cpt_haut == 1 && val_cpt_bas == 0)
        return 1 ; //Nord
        
    else if (val_cpt_haut == 0 && val_cpt_bas == 1)
        return 0 ; //Sud
        
    else if(  val_cpt_haut == 1 && val_cpt_bas == 1)
        return 2 ; //On sait pas
    
    else if(  val_cpt_haut == 0 && val_cpt_bas == 0)
        return 3 ; //On sait pas
    else
        return 4 ;
}

void test_lecture_girou (void)
{
    unsigned char message_test_girou ;
    
    message_test_girou = captuer_bas_girou.read() | (captuer_haut_girou.read() << 1) ;
    SendMsgCan(LECTURE_GIROUETTE, &message_test_girou, sizeof(char) ) ;
}