作业机械的姿势运算装置具备:计测装置,其设于作业机械,用于检测角速度及加速度;姿势角运算部,其根据由所述计测装置检测出的角速度及加速度来求解所述作业机械的姿势角;第一互补滤波器,其被设定第一截止频率,减少由所述姿势角运算部求出的所述姿势角中含有的杂音而输出第一姿势角;第二互补滤波器,其被设定与所述第一截止频率不同的第二截止频率,减少由所述姿势角运算部求出的所述姿势角中含有的杂音而输出第二姿势角;切换部,其根据所述计测装置的状态来切换并输出所述第一姿势角或所述第二姿势角。
金光保雄
株式会社小松制作所
日本东京都
作业机械的姿势运算装置具备:计测装置,其设于作业机械,用于检测角速度及加速度;姿势角运算部,其根据由所述计测装置检测出的角速度及加速度来求解所述作业机械的姿势角;第一互补滤波器,其被设定第一截止频率,减少由所述姿势角运算部求出的所述姿势角中含有的杂音而输出第一姿势角;第二互补滤波器,其被设定与所述第一截止频率不同的第二截止频率,减少由所述姿势角运算部求出的所述姿势角中含有的杂音而输出第二姿势角;切换部,其根据所述计测装置的状态来切换并输出所述第一姿势角或所述第二姿势角。