Commit d2bf2ac0 authored by Francois Keith's avatar Francois Keith
Browse files

Correct an error in the debug message.

If the two vectors have a different sizes this crashes.
parent 7e5de6da
...@@ -161,7 +161,8 @@ void SoTHRP2Device::getControl(map<string,dgsot::ControlValues> &controlOut) ...@@ -161,7 +161,8 @@ void SoTHRP2Device::getControl(map<string,dgsot::ControlValues> &controlOut)
increment(timestep_); increment(timestep_);
sotDEBUG (25) << "state = " << state_ << std::endl; sotDEBUG (25) << "state = " << state_ << std::endl;
sotDEBUG (25) << "diff = " << state_ - previousState_ << std::endl; sotDEBUG (25) << "diff = " << ((previousState_.size() == state_.size())?
(state_ - previousState_) : state_ ) << std::endl;
previousState_ = state_; previousState_ = state_;
// Specify the joint values for the controller. // Specify the joint values for the controller.
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment