Skip to content
Snippets Groups Projects

Improve armar7 platform movement

Merged Tobias Gröger requested to merge feature/improve-armar7-platform-movement into master
All threads resolved!
Compare and Show latest version
1 file
+ 10
8
Compare changes
  • Side-by-side
  • Inline
@@ -153,14 +153,16 @@ namespace armarx
{
// if (state.norm() >= oldState.norm())
// {
std::stringstream ss;
ss << "====TargetZero:\nTarget:\n"
<< target << "\nstate:\n"
<< state << "\noldst:\n"
<< oldState << "\ndelta:\n"
<< delta << "\nfactor: " << factor << "\n====\n";
std::string s = ss.str();
ARMARX_RT_LOGF_IMPORTANT("%s", s.c_str());
ARMARX_RT_LOGF_IMPORTANT("Target %.04f %.04f %.04f", target(0), target(1), target(2));
ARMARX_RT_LOGF_IMPORTANT(
"OStte %.04f %.04f %.04f", oldState(0), oldState(1), oldState(2));
ARMARX_RT_LOGF_IMPORTANT("State %.04f %.04f %.04f", state(0), state(1), state(2));
ARMARX_RT_LOGF_IMPORTANT("Delta %.04f %.04f %.04f", delta(0), delta(1), delta(2));
ARMARX_RT_LOGF_IMPORTANT("Factor %.04f", factor);
if (state.norm() > oldState.norm())
{
ARMARX_RT_LOGF_IMPORTANT("!!!!NORM INVALID!!!!");
}
// throw LocalException("haeee");
// }
Loading