• 検索結果がありません。

CRI – 慣性センサデータとセンサパラメータ

13.2.1 PERDCRI,A – 加速度センサデータ

書式:

$PERDCRI , A , imuParamconf , validAccel , xRawAccel , yRawAccel , zRawAccel , xGain , yGain ,

1 2 3 4 5 6 7 8 9

zGain , xOffset , yOffset , zOffset , rollAlign , pitchAlign , yawAlign , learnmode *hh <CR> <LF>

10 11 12 13 14 15 16 17

Field Data type Range Description

1 $PERDCRI - コマンド名

2 A - サブコマンド名

3 imuParamconf 0 to 3

加速度センサデータの信頼性 0:無効

1:初期値

2:初期バイアス推定中

3:センサ誤差推定フィルタによる補正中

4 validAccel 0, 7

加速度センサの有効軸を示すフラグ 0:センサ未検出

7:センサ検出済(X・Y・Z軸有効)

5 xRawAccel - 加速度センサ出力値(X軸) [digit]

6 yRawAccel - 加速度センサ出力値(Y軸) [digit]

7 zRawAccel - 加速度センサ出力値(Z軸) [digit]

8 xGain - 加速度センサゲイン(X軸)(LSB-18) [m/s2/digit]

9 yGain - 加速度センサゲイン(Y軸)(LSB-18) [m/s2/digit]

10 zGain - 加速度センサゲイン(Z軸)(LSB-18) [m/s2/digit]

11 xOffset - 加速度センサオフセット(X軸) [digit]

12 yOffset - 加速度センサオフセット(Y軸) [digit]

13 zOffset - 加速度センサオフセット(Z軸) [digit]

14 rollAlign -180 to 180 加速度センサミスアライメント角(ロール角) [度]

15 pitchAlign -180 to 180 加速度センサミスアライメント角(ピッチ角) [度]

16 yawAlign 0 to 35931 加速度センサミスアライメント角(ヨー角) [度]

17 learnmode 0 to 3

加速度センサ学習モード 0:未学習

1:バイアス学習完了

2:ミスアライメント角学習完了

3:バイアスとミスアライメント角の学習完了 例:

42

13.2.2 PERDCRI,G – ジャイロセンサデータ

書式:

$PERDCRI , G , imuParamconf , validGyro , xRawGyro , yRawGyro , zRawGyro , xGain , yGain ,

1 2 3 4 5 6 7 8 9

zGain , xOffset , yOffset , zOffset , rollAlign , pitchAlign , yawAlign , learnmode *hh <CR> <LF>

10 11 12 13 14 15 16 17

Field Data type Range Description

1 $PERDCRI - コマンド名

2 G - サブコマンド名

3 imuParamconf 0 to 3

ジャイロセンサパラメータの信頼性 0:無効

1:初期値

2:初期バイアス推定中

3:センサ誤差推定フィルタによる補正中

4 validGyro 0, 7

ジャイロセンサ有効軸数を示すフラグ 0:センサ未検出

7:センサ検出済(X・Y・Z軸有効)

5 xRawGyro - ジャイロセンサ出力値(X軸) [digit]

6 yRawGyro - ジャイロセンサ出力値(Y軸) [digit]

7 zRawGyro - ジャイロセンサ出力値(Z軸) [digit]

8 xGain - ジャイロゲイン(X軸)(LSB-18) [dps/digit]

9 yGain - ジャイロゲイン(Y軸)(LSB-18) [dps/digit]

10 zGain - ジャイロゲイン(Z軸)(LSB-18) [dps/digit]

11 xOffset - ジャイロオフセット(X軸) [digit]

12 yOffset - ジャイロオフセット(Y軸) [digit]

13 zOffset - ジャイロオフセット(Z軸) [digit]

14 rollAlign -180 to 180 ジャイロミスアライメント角(ロール角) [度]

15 pitchAlign -180 to 180 ジャイロミスアライメント角(ピッチ角) [度]

16 yawAlign 0 to 35932 ジャイロミスアライメント角(ヨー角) [度]

17 learnmode 0 to 15 ジャイロ学習モード(表 13.1参照)

13.1 learnmodeのフラグ

learnmode 0 1 2 3 5 6 7 9 11 13 15

オフセット - ● - ● ● - ● ● ● ● ● ミスアライメント - - ● ● - ● ● - ● - ● ゲイン - - - - ● ● ● - - ● ● 温度補償 - - - ● ● ● ● 例:

$PERDCRI,G,3,7,96,144,-16,655,655,653,102,135,-25,1,0,90,7*2D

32 yawAlignのRangeが-180度~359度で出力される場合があります。負の値が出力された場合、+360度を加算してご 使用ください。

13.2.3 PERDCRI,O – 車速パルスデータ 書式:

$PERDCRI , O , odomtrconf , odomtrcounts , odomtrdir , countsPerRev ,

1 2 3 4 5 6

meterPerRev *hh <CR> <LF>

7

Field Data type Range Description

1 $PERDCRI - コマンド名

2 O - サブコマンド名

3 odomtrConf 0, 1, 3, 7, 9, 11, 15

車速パルスの信頼性 0:不明(パルス非認識)

1:初期化完了

3:車輪1回転当たりのパルス数推定中

7:車輪1回転当たりのパルス数の誤差推定中 9:初期化とバック信号の認識完了

11:3に加えてバック信号の認識完了 15:7に加えてバック信号の認識完了 4 odomtrcounts 0 to 2000 車速パルスのカウント数 [カウント数/秒]

5 odomtrdir 0 to 3 車速パルスの進行方向

0:無視、1:不明、2:順方向、3:逆方向

6 countsPerRev - 車輪1回転当たりのパルス数 [カウント数/回転数]

7 meterPerRev 1.569858 車輪1回転当たりのメートル数 [m/回転数]

例:

$PERDCRI,O,7,0,2,4.09,1.569858*22

関連したドキュメント