summaryrefslogtreecommitdiff
path: root/2004/i/nono/src/motor/movement_goto.cc
diff options
context:
space:
mode:
Diffstat (limited to '2004/i/nono/src/motor/movement_goto.cc')
-rw-r--r--2004/i/nono/src/motor/movement_goto.cc7
1 files changed, 3 insertions, 4 deletions
diff --git a/2004/i/nono/src/motor/movement_goto.cc b/2004/i/nono/src/motor/movement_goto.cc
index efaf959..40784a7 100644
--- a/2004/i/nono/src/motor/movement_goto.cc
+++ b/2004/i/nono/src/motor/movement_goto.cc
@@ -85,8 +85,7 @@ MovementGoto::control (void)
double dist, dx, dy;
if (!goto_->get (*t_, param_.dist_, param_.eps_, dist, dx, dy))
return false;
-std::cout << "movement goto: consign " << dist << ' ' << dx << ' ' << dy <<
- std::endl;
+//std::cout << "movement goto: consign " << dist << ' ' << dx << ' ' << dy << std::endl;
// Calcule l'erreur.
double el, ea, angle;
t_->computeError (dx, dy, el, ea, angle);
@@ -96,7 +95,7 @@ std::cout << "movement goto: consign " << dist << ' ' << dx << ' ' << dy <<
el = 0.0;
ea = 2.0 - ea;
}
-std::cout << "movement goto: error " << el << ' ' << ea << ' ' << angle << std::endl;
+//std::cout << "movement goto: error " << el << ' ' << ea << ' ' << angle << std::endl;
// Calcule les intégrales saturées.
il_ += el;
if (il_ > param_.is_) il_ = param_.is_;
@@ -109,7 +108,7 @@ std::cout << "movement goto: error " << el << ' ' << ea << ' ' << angle << std::
+ param_.kdl_ * (el - lel_));
double a = param_.kpa_ * (ea + param_.kia_ * ia_
+ param_.kda_ * (ea - lea_));
-std::cout << "movement goto: command " << l << ' ' << a << std::endl;
+//std::cout << "movement goto: command " << l << ' ' << a << std::endl;
m_->speed (l, a, dist, angle);
// Retiens l'erreur pour la dérivée.
lel_ = el;