質問をすることでしか得られない、回答やアドバイスがある。

15分調べてもわからないことは、質問しよう!

ただいまの
回答率

90.01%

MbedでMadgwickFilterで使用する方法がわかりません。

受付中

回答 2

投稿

  • 評価
  • クリップ 0
  • VIEW 186

PHENIXa

score 5

mbedを使い9軸センサの値をMadgwickFiterで計算させて傾斜角を取得する方法を模索中です。
Arduinoでは

#include <MadgwickAHRS.h>
#include <math.h>
Madgwick MadgwickFilter;

setup(){
MadgwickFilter.begin(10); 
}

loop(){
//センサからの取得値をAadgwickFiterに渡す
MadgwickFilter.update(加速度x,加速度y,加速度z,ジャイロx,ジャイロy,ジャイロz,地磁気x,地磁気y,地磁気z)

 float roll  = MadgwickFilter.getRoll();//ロール角
 float pitch = MadgwickFilter.getPitch();//ピッチ角
 float yaw   = MadgwickFilter.getYaw();//ヨー角
}


というような記述法で角度を取得できてはいたのですが、
mbedに移植するのに苦戦しており、ArduinoのMadgwickFilterと互換性がないのでは?と思い試行錯誤してみましたが角度がおかしい(開始直後から誤差大)ので、解決方法を教えていただきたいです。

参考サイト
http://tomi-tomi-pon.hatenablog.com/entry/2018/11/07/012854

  • 気になる質問をクリップする

    クリップした質問は、後からいつでもマイページで確認できます。

    またクリップした質問に回答があった際、通知やメールを受け取ることができます。

    クリップを取り消します

  • 良い質問の評価を上げる

    以下のような質問は評価を上げましょう

    • 質問内容が明確
    • 自分も答えを知りたい
    • 質問者以外のユーザにも役立つ

    評価が高い質問は、TOPページの「注目」タブのフィードに表示されやすくなります。

    質問の評価を上げたことを取り消します

  • 評価を下げられる数の上限に達しました

    評価を下げることができません

    • 1日5回まで評価を下げられます
    • 1日に1ユーザに対して2回まで評価を下げられます

    質問の評価を下げる

    teratailでは下記のような質問を「具体的に困っていることがない質問」、「サイトポリシーに違反する質問」と定義し、推奨していません。

    • プログラミングに関係のない質問
    • やってほしいことだけを記載した丸投げの質問
    • 問題・課題が含まれていない質問
    • 意図的に内容が抹消された質問
    • 広告と受け取られるような投稿

    評価が下がると、TOPページの「アクティブ」「注目」タブのフィードに表示されにくくなります。

    質問の評価を下げたことを取り消します

    この機能は開放されていません

    評価を下げる条件を満たしてません

    評価を下げる理由を選択してください

    詳細な説明はこちら

    上記に当てはまらず、質問内容が明確になっていない質問には「情報の追加・修正依頼」機能からコメントをしてください。

    質問の評価を下げる機能の利用条件

    この機能を利用するためには、以下の事項を行う必要があります。

回答 2

0

角速度データの単位がArduionoとmbedで違うような気がします。

ArduionoのMadgwickの実装を見ると度数を受け付けているように見えます。
対して、mbedの文書を見るとラジアンを受け付けているようです。

度数をラジアンに変換してから渡すのではないかと思います。

投稿

  • 回答の評価を上げる

    以下のような回答は評価を上げましょう

    • 正しい回答
    • わかりやすい回答
    • ためになる回答

    評価が高い回答ほどページの上位に表示されます。

  • 回答の評価を下げる

    下記のような回答は推奨されていません。

    • 間違っている回答
    • 質問の回答になっていない投稿
    • スパムや攻撃的な表現を用いた投稿

    評価を下げる際はその理由を明確に伝え、適切な回答に修正してもらいましょう。

  • 2019/09/22 19:26 編集

    回答ありがとうございます。
    度数をラジアンに直すということは「ラジアン=角度*(円周率/180)」でいいですか?

    プログラム的にいうと
    xGyro=xGyro*(3.1415/180)
    というところでしょうか?

    Madgwickの中身には
    「角速度データ,[rad]に変換してから入れてください」
    と記述されていたので、両方試しましたが改善されなかった
    ですが、各値に変化はみられません。

    キャンセル

  • 2019/09/22 20:04 編集

    > xGyro=xGyro*(3.1415/180)
    > というところでしょうか?
    はい。変換しているとしたら問題なさそうですね。

    あとは関数の呼び出し間隔は同じになっているでしょうか?
    Arduionoは"MadgwickFilter.begin(10)"としていると100ms単位に呼び出すことを前提となります(たとえ10msしか経過していなくても200ms経過していたとしても100ms経過したとして演算する)
    mbedは関数呼び出しの間隔を実時間から取っているようです。また、複数のMadgwickFilterインスタンスを使用しているとおかしな結果になるかもしれません。

    該当実装
    Arduiono:https://github.com/arduino-libraries/MadgwickAHRS/blob/70fd2c93d7fa88bffdd4ace675db1d7110e80adb/src/MadgwickAHRS.cpp#L135
    mbed:https://os.mbed.com/teams/PQ_Hybrid_Electrical_Equipment_Team/code/MadgwickFilter/docs/tip/MadgwickFilter_8hpp_source.html の343行目

    キャンセル

0

![イメージ説明]

青がroll
オレンジ色がpitch
灰色がyaw

左の軸はrollとpitch
右の軸はyaw

解決策1.
角度をラジアンに変換したことでセンサを傾けたときに変化するようにはならなくなったが、グラフ化すると値が徐々に変化して飽和する

投稿

  • 回答の評価を上げる

    以下のような回答は評価を上げましょう

    • 正しい回答
    • わかりやすい回答
    • ためになる回答

    評価が高い回答ほどページの上位に表示されます。

  • 回答の評価を下げる

    下記のような回答は推奨されていません。

    • 間違っている回答
    • 質問の回答になっていない投稿
    • スパムや攻撃的な表現を用いた投稿

    評価を下げる際はその理由を明確に伝え、適切な回答に修正してもらいましょう。

15分調べてもわからないことは、teratailで質問しよう!

  • ただいまの回答率 90.01%
  • 質問をまとめることで、思考を整理して素早く解決
  • テンプレート機能で、簡単に質問をまとめられる