fixes high-gain controller

[hmatsushita]

ハイゲインモード用のコントローラの以下の不具合を修正しました。

• ddq の計算誤りを修正しました
• dq, ddq の計算結果が制限値を越えていた場合、制限値に補正する誤った処理を削除しました。