|
|
@ -650,7 +650,7 @@ class SolutionSet : public StaticLocalDataSet<SOLUTION_SET_ENTRIES> {
|
|
|
|
// Ticks timestamp
|
|
|
|
// Ticks timestamp
|
|
|
|
lp_var_t<uint32_t> ticks = lp_var_t<uint32_t>(sid.objectId, PoolIds::TICKS_SOLUTION_SET, this);
|
|
|
|
lp_var_t<uint32_t> ticks = lp_var_t<uint32_t>(sid.objectId, PoolIds::TICKS_SOLUTION_SET, this);
|
|
|
|
/// Unix time stamp
|
|
|
|
/// Unix time stamp
|
|
|
|
lp_var_t<uint64_t> time = lp_var_t<uint64_t>(sid.objectId, PoolIds::TIME_SOLUTION_SET, this);
|
|
|
|
lp_var_t<uint64_t> timeUs = lp_var_t<uint64_t>(sid.objectId, PoolIds::TIME_SOLUTION_SET, this);
|
|
|
|
// Calibrated quaternion (takes into account the mounting quaternion), typically same as
|
|
|
|
// Calibrated quaternion (takes into account the mounting quaternion), typically same as
|
|
|
|
// track q values
|
|
|
|
// track q values
|
|
|
|
lp_var_t<float> caliQw = lp_var_t<float>(sid.objectId, PoolIds::CALI_QW, this);
|
|
|
|
lp_var_t<float> caliQw = lp_var_t<float>(sid.objectId, PoolIds::CALI_QW, this);
|
|
|
@ -695,7 +695,7 @@ class SolutionSet : public StaticLocalDataSet<SOLUTION_SET_ENTRIES> {
|
|
|
|
void printSet() {
|
|
|
|
void printSet() {
|
|
|
|
PoolReadGuard rg(this);
|
|
|
|
PoolReadGuard rg(this);
|
|
|
|
sif::info << "SolutionSet::printSet: Ticks: " << this->ticks << std::endl;
|
|
|
|
sif::info << "SolutionSet::printSet: Ticks: " << this->ticks << std::endl;
|
|
|
|
sif::info << "SolutionSet::printSet: Time: " << this->time << std::endl;
|
|
|
|
sif::info << "SolutionSet::printSet: Time: " << this->timeUs << std::endl;
|
|
|
|
sif::info << "SolutionSet::printSet: Calibrated quaternion Qw: " << this->caliQw << std::endl;
|
|
|
|
sif::info << "SolutionSet::printSet: Calibrated quaternion Qw: " << this->caliQw << std::endl;
|
|
|
|
sif::info << "SolutionSet::printSet: Calibrated quaternion Qx: " << this->caliQx << std::endl;
|
|
|
|
sif::info << "SolutionSet::printSet: Calibrated quaternion Qx: " << this->caliQx << std::endl;
|
|
|
|
sif::info << "SolutionSet::printSet: Calibrated quaternion Qy: " << this->caliQy << std::endl;
|
|
|
|
sif::info << "SolutionSet::printSet: Calibrated quaternion Qy: " << this->caliQy << std::endl;
|
|
|
|