本文整理汇总了C++中state::rot_acc_lpf方法的典型用法代码示例。如果您正苦于以下问题：C++ state::rot_acc_lpf方法的具体用法？C++ state::rot_acc_lpf怎么用？C++ state::rot_acc_lpf使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类state的用法示例。
在下文中一共展示了state::rot_acc_lpf方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: update
/// update state using a rotation speed (in rad/s) and acceleration (in m/s^2)
void update(state & s, double timestep, vector3d const& rotspeed, vector3d const& acc)
{
double thalf = 0.5*timestep;
matrix3d const rhalf = rotation_vec_to_matrix(rotspeed*thalf);
matrix3d const ohalf = s.orientation * rhalf;
vector3d const racc = ohalf * acc;
vector3d const racchp = racc - s.rot_acc_lpf(racc);
vector3d const shinc = thalf * racchp;
vector3d const shalf = s.speed + shinc;
s.location.noalias() += shalf * timestep;
s.speed.noalias() = shalf + shinc;
s.orientation.noalias() = ohalf * rhalf;
}