AresENSEA-CDF2020 / Mbed 2 deprecated AresCDFMainCode_us2

Test

Dependencies:   mbed DRV8825

motors.cpp

Committer:
Nanaud
Date:
2020-07-15
Revision:
3:3ba377aafdfd
Parent:
1:2fe8c402ee79
Child:
4:ad9b7355332e

File content as of revision 3:3ba377aafdfd:

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

void drv_init(){
    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);
}

// TESTS

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

void testAngle(int cmdAngle){
    
}