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)
increment(timestep_);
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_;
// 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