From 6eaaa29c57b70f3e9aa48c2d14fe9acfe008669d Mon Sep 17 00:00:00 2001 From: haller Date: Tue, 3 May 2005 23:28:47 +0000 Subject: Correction de quelques bug (conversion) --- 2005/i/robert/src/asserv/asserv.cc | 27 +++++++++++---------------- 1 file changed, 11 insertions(+), 16 deletions(-) (limited to '2005/i/robert/src/asserv/asserv.cc') diff --git a/2005/i/robert/src/asserv/asserv.cc b/2005/i/robert/src/asserv/asserv.cc index 3288ac6..dd0902b 100644 --- a/2005/i/robert/src/asserv/asserv.cc +++ b/2005/i/robert/src/asserv/asserv.cc @@ -35,8 +35,6 @@ Asserv::Asserv (const Config & config, Receiver & receiver) loadConfig(config); //Ouverture du port série proto_.open(ttyName_); - //Initialisation de l'AVR - reset(); } /// Reset de l'AVR @@ -262,25 +260,25 @@ void Asserv::setEpsilon(double epsilon) proto_.send('p',"bd", 'e', static_cast(epsilon * 256)); } -void Asserv::setKp(double Kp) +void Asserv::setKp(int Kp) { kp_ = Kp; // Envoie à l'AVR - proto_.send('p',"bw", 'p', static_cast(Kp * 256)); + proto_.send('p',"bw", 'p', Kp); } -void Asserv::setKi(double Ki) +void Asserv::setKi(int Ki) { ki_ = Ki; // Envoie à l'AVR - proto_.send('p',"bw", 'i', static_cast(Ki * 256)); + proto_.send('p',"bw", 'i', Ki); } -void Asserv::setKd(double Kd) +void Asserv::setKd(int Kd) { kd_ = Kd; // Envoie à l'AVR - proto_.send('p',"bw", 'd', static_cast(Kd * 256)); + proto_.send('p',"bw", 'd', Kd); } void Asserv::setESat(int eSat) @@ -321,11 +319,8 @@ void Asserv::setMaxSpeed(int maxSLin, int maxSRot) { maxSLin_ = maxSLin; maxSRot_ = maxSRot; - // Conversion mm->ppp - int p = mms2ppp(maxSLin); - int r = radTo256(maxSRot); // Envoie à l'AVR - proto_.send('p',"bbb", 'm', p, r); + proto_.send('p',"bbb", 'm', maxSLin, maxSRot); } void Asserv::setUseTazFSM(bool use) @@ -340,7 +335,7 @@ void Asserv::setInvPwm(bool leftInvPwm, bool rightInvPwm) leftInvPwm_ = leftInvPwm; rightInvPwm_ = rightInvPwm; // Envoie la commande à l'AVR - proto_.send('p', "bbb", 'W', leftInvPwm ? 1 : 0, rightInvPwm ? 1 : 0); + proto_.send('p', "bbb", 'w', leftInvPwm , rightInvPwm); } /// implémentation du proto::Receiver @@ -428,9 +423,9 @@ void Asserv::loadConfig(const Config & config) footing_ = config.get("asserv.footing"); epsilon_ = config.get("asserv.epsilon"); accel_ = config.get("asserv.accel"); - kp_ = config.get("asserv.kp"); - ki_ = config.get("asserv.ki"); - kd_ = config.get("asserv.kd"); + kp_ = config.get("asserv.kp"); + ki_ = config.get("asserv.ki"); + kd_ = config.get("asserv.kd"); eSat_ = config.get("asserv.eSat"); speedIntMax_ = config.get("asserv.speedIntMax"); dSample_ = config.get("asserv.dSample"); -- cgit v1.2.3