deplacement v6

Fork of Deplacement by Projet robot

Deplacement.cpp

Committer:
fab16
Date:
2017-03-02
Revision:
9:832a3d20c4ee
Parent:
8:751dfd02c59e
Child:
10:00043b0d1e5e

File content as of revision 9:832a3d20c4ee:

#include "Deplacement.h"
#include "mbed.h"
   
m3pi m3piD;

Deplacement::Deplacement() //constructeur
{
 
    this->mseconds=30;// temps pour la rotation une fois valeur trouvé ne pas changer
    posx=0;
    posy=0;
    this->vitesse=0.1; //pointeur this
}

void Deplacement::init(float val){
    m3piD.right_motor(val);
    m3piD.left_motor(val);
}

Deplacement::~Deplacement()
{
   
}
/////////////////////////////////////////////////////

void Deplacement::setVitesse(float v)
{
    this->vitesse=v; 
}

/////////////////////////////////////////////////////
    
void Deplacement::tourner_droite()
{
    int copie=0;
    
    m3piD.right(this->vitesse);
    wait(0.9);
    
    m3piD.stop();
    
    posx=copie;
    posx=posy;
    posy=-copie;
    
}
    
void Deplacement::tourner_gauche()
{
    int copie=0;
    
    m3piD.left(this->vitesse);
    wait(0.9);
    m3piD.stop();
    
    
    posx=copie;
    posx=-posy;
    posy=copie;

}

void Deplacement::avancer()
{
    m3piD.forward(this->vitesse);
    wait(2);
    posy++;
    m3piD.stop();
}

void Deplacement::reculer()
{
    m3piD.right(this->vitesse);
    wait(1.8);
    m3piD.backward(this->vitesse);
    wait(2);
    posy--;
    m3piD.stop();
}

void Deplacement::gauche(){
    m3piD.left(this->vitesse);
    wait(0.9);
    avancer();
}

void Deplacement::droite(){
    m3piD.right(this->vitesse);
    wait(0.9);
    avancer();
}

void Deplacement::stop()
{
    m3piD.stop();    
}

void Deplacement::RAZ()
{
    posx=0;   
    posy=0;
    this->vitesse=0;
   
} 

float Deplacement::getVitesse()
{
    return(this->vitesse);
}

int Deplacement::getPosX()
{ 
    return(this->posx);
}

int Deplacement::getPosY()
{   
    return(this->posy);
}

void Deplacement::tourner_droite_t()
{
    
    m3piD.left_motor(this->vitesse);
    m3piD.right_motor(-(this->vitesse));
}