AresENSEA-CDF2020 / Mbed 2 deprecated AresCDFMainCode_capteur_US

Capteur_US

Dependencies:   mbed DRV8825

pins.cpp

Committer:
Nanaud
Date:
2020-07-18
Revision:
4:ad9b7355332e
Parent:
1:2fe8c402ee79
Child:
5:34ed652f8c31

File content as of revision 4:ad9b7355332e:

// Nom du fichier : pins.cpp
#include "pins.h"

// Capteurs à ultrasons
DigitalOut trigger(PB_9);
InterruptIn echo1(PA_11);
InterruptIn echo2(PB_12);
InterruptIn echo3(PB_2);
InterruptIn echo4(PB_1);
InterruptIn echo5(PB_15);
InterruptIn echo6(PB_14);

// Drivers DRV8825 
#define STEP1 PA_6
#define STEP2 PB_6
#define DIR1 PC_2
#define DIR2 PH_1
#define EN PC_3
#define rRoue 70 // peut être 71 mm
#define nbPas 1000
BusOut mode(PB_0, PC_1, PC_0); // LSB ... MSB
DRV8825 drvGauche(EN,DIR1,STEP1,rRoue,nbPas); 
DRV8825 drvDroite(EN,DIR2,STEP2,rRoue,nbPas); 

// Codeurs (Réf : LPJ3806-1000BM-G5-24E)
InterruptIn cdgA(PA_8); // Codeur de gauche
InterruptIn cdgB(PA_9);
InterruptIn cddA(PA_0); // Codeur de droite
InterruptIn cddB(PA_1);