void TrackHandler::add_gyro_reading(Eigen::Vector3f &gyro_reading) { gyro_accum_ += gyro_reading; n_gyro_readings_++; }
时间: 2024-03-29 20:37:00 浏览: 50
Support Vector Tracking
5星 · 资源好评率100%
这段代码是一个类 TrackHandler 的成员函数,用于将陀螺仪的测量值加入到累计的陀螺仪测量值中,并记录已经加入的陀螺仪测量值的数量。具体来说,它将给定的三维向量 gyro_reading 加到成员变量 gyro_accum_ 中,同时将 n_gyro_readings_ 计数器加一。这通常用于惯性导航系统中的姿态估计,可以通过对一段时间内的陀螺仪测量值求和来估计当前的姿态。
阅读全文