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!
1 file
+ 5
8
Compare changes
  • Side-by-side
  • Inline
@@ -153,14 +153,11 @@ 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 %d %d %d", target(0), target(1), target(2));
ARMARX_RT_LOGF_IMPORTANT("OStte %d %d %d", oldState(0), oldState(1), oldState(2));
ARMARX_RT_LOGF_IMPORTANT("State %d %d %d", state(0), state(1), state(2));
ARMARX_RT_LOGF_IMPORTANT("Delta %d %d %d", delta(0), delta(1), delta(2));
ARMARX_RT_LOGF_IMPORTANT("Factor %d", factor);
if (state.norm() > oldState.norm())
{
ARMARX_RT_LOGF_IMPORTANT("!!!!NORM INVALID!!!!");
Loading