スラローム走行

合宿にて次やることは”ジャイロを使ってのスラローム”
と教えてもらったので実装してみる。
車両全体の速度はエンコーダだけ見て
角速度はジャイロだけ見て制御してみる