Add NaN assertion

[200km]

Issue

現状これを入れないと問題が出るというわけではないが、過去のバグを含め包括的にこの手の現象に対応するため。

詳細

数値計算上のNaNを回避するためにAssertionを入れた。特に過去のデータを引きずりエラーが継続しやすい次の箇所に入れた

• PID制御
• フィルター系

検証結果

ビルドチェック (どちらもチェック)

• SILSでのビルドチェックに通った(CIで確認)
• vMicroでのビルドチェックに通った

動作確認チェック (いずれかをチェック)

• SILSでアルゴリズムが想定通りに動いた
• 実機でアルゴリズムが想定通りに動いた
• (テレコマ試験の場合)コマンドファイルを使った試験をパスした

試験結果詳細記述場所 or 詳細ログ保存場所へのリンク

• 現時点で動かしてこのAssertionに引っ掛かることはなく、修正前後で制御結果などは変わりえない

補足

NA

[200km]

ELも追加しました。Spikeの方はエラーを返しており、そのエラーで上位アプリ側でELがかかるようになっているので、入れていません。

[conjikidow]

ありがとうございます。