MadgwickFilter + MPU9250 で遊ぶ

MadgwickFilterを使ってみました。何者かはちゃんと説明できませんが、センサで起きるノイズなどでドリフトしてしまう姿勢を安定的に求めるために使います。 MPU9250を利用して、加速度、ジャイロ、地磁気センサをこのフィルタを利用し、姿勢角を算出します。