Fonction pour sauvegarder les consignes de la loi de commande
This commit is contained in:
parent
8db2e226b8
commit
d6c64fb05d
@ -3,14 +3,23 @@
|
||||
#include "Commande_vitesse.h"
|
||||
|
||||
|
||||
float avance_mm_s, orientation_radian_s;
|
||||
|
||||
float get_avance_mm_s(){
|
||||
return avance_mm_s;
|
||||
}
|
||||
|
||||
float get_orientation_radian_s(){
|
||||
return orientation_radian_s;
|
||||
}
|
||||
|
||||
/// @brief Commande de la vitesse dans le référentiel du robot
|
||||
/// @param avance_mm_s : Vitesse d'avance
|
||||
/// @param orientation_radian_s : Rotation en radian/s
|
||||
void commande_vitesse(float avance_mm_s, float orientation_radian_s){
|
||||
void commande_vitesse(float _avance_mm_s, float _orientation_radian_s){
|
||||
float vitesse_roue_gauche, vitesse_roue_droite;
|
||||
avance_mm_s = _avance_mm_s;
|
||||
orientation_radian_s = _orientation_radian_s;
|
||||
|
||||
vitesse_roue_gauche = avance_mm_s - (orientation_radian_s * DISTANCE_ROUES_CENTRE_MM);
|
||||
vitesse_roue_droite = avance_mm_s + (orientation_radian_s * DISTANCE_ROUES_CENTRE_MM);
|
||||
|
||||
@ -1,2 +1,4 @@
|
||||
void commande_vitesse(float vitesse_avance_mm_s, float orientation_radian_s);
|
||||
void commande_vitesse_stop(void);
|
||||
float get_avance_mm_s();
|
||||
float get_orientation_radian_s();
|
||||
Loading…
Reference in New Issue
Block a user