diff --git a/src/sensor/sensor_base.cpp b/src/sensor/sensor_base.cpp index 7c9732d767955f1f7a1e7601905c4d09b9dd5282..0e649ec5cce5c11ca522c21bab70c67855922839 100644 --- a/src/sensor/sensor_base.cpp +++ b/src/sensor/sensor_base.cpp @@ -458,7 +458,7 @@ void SensorBase::printState (bool _metric, bool _state_blocks, std::ostream& _st { auto sb = getStateBlockDynamic(key); if (sb) - _stream << _tabs << " " << key << "[" << (sb->isFixed() ? "Fix" : "Est") << "] = ( " + _stream << _tabs << " " << key << " [" << (sb->isFixed() ? "Fix" : "Est") << "] = ( " << std::setprecision(3) << sb->getState().transpose() << " )" << " @ " << sb << std::endl; } } @@ -474,7 +474,7 @@ void SensorBase::printState (bool _metric, bool _state_blocks, std::ostream& _st { const auto &sb = getStateBlockDynamic(key); if (sb) - _stream << " " << key << "[" << (sb->isFixed() ? "Fix" : "Est") << "] @ " << sb; + _stream << " " << key << " [" << (sb->isFixed() ? "Fix" : "Est") << "] @ " << sb; } _stream << std::endl; } diff --git a/src/state_block/has_state_blocks.cpp b/src/state_block/has_state_blocks.cpp index bd800ab2e907b3313afdc1717b3c11f2cd07b858..36cada937e0412330e7242d2092948807549fea9 100644 --- a/src/state_block/has_state_blocks.cpp +++ b/src/state_block/has_state_blocks.cpp @@ -84,7 +84,7 @@ void HasStateBlocks::printState (bool _metric, bool _state_blocks, std::ostream& auto sb = getStateBlock(key); if (sb) _stream << _tabs << " " << key - << "[" << (sb->isFixed() ? "Fix" : "Est") + << " [" << (sb->isFixed() ? "Fix" : "Est") << "] = ( " << std::setprecision(3) << sb->getState().transpose() << " )" << " @ " << sb << std::endl; } @@ -103,7 +103,7 @@ void HasStateBlocks::printState (bool _metric, bool _state_blocks, std::ostream& const auto &sb = getStateBlock(key); if (sb) _stream << " " << key - << "[" << (sb->isFixed() ? "Fix" : "Est") + << " [" << (sb->isFixed() ? "Fix" : "Est") << "] @ " << sb; } _stream << std::endl;