fix some bags v2

[kengohozumi]

概要

• 実機を動かすことやシュミレーションで気づいたバグを修正しました。

[bvbnatsu]

@koki0624 承知いたしました。