AresENSEA-CDF2020 / Mbed 2 deprecated AresCDFMainCode_us2

Test

Dependencies:   mbed DRV8825

motors.cpp

Committer:
Nanaud
Date:
2020-07-08
Revision:
0:dc036b67c87c
Child:
1:2fe8c402ee79

File content as of revision 0:dc036b67c87c:

#include "pins.h"

void drv_init(){
    mot_dis();
}

void test_drv(){
    mot_en();
    motGauche_fwd();
    drvGauche.move(1);  
    wait(2);
    motGauche_bck();
    wait(2);
    mot_dis();
}

// ENABLE/DISABLE // Les deux modules ont le même enable
void mot_en(){
    drvGauche.setEnable(START);
    //drvDroite.setEnable(START);
}

void mot_dis(){
    drvGauche.setEnable(STOP);
    //drvDroite.setEnable(STOP);
}

// FORWARD
void motGauche_fwd(){
    drvGauche.setDir(FORWARD);
}

void motDroite_fwd(){
    drvDroite.setDir(FORWARD);
}

// BACKWARD
void motGauche_bck(){
    drvGauche.setDir(BACKWARD);
}

void motDroite_bck(){
    drvDroite.setDir(BACKWARD);
}