壁トレース制御のやり直し

どうやって真っ直ぐ走ればでやっていた方法だと速度を上げていくにつれて蛇行が酷くなってきたので変更する。
壁トレースができる場合は壁との変異をヨー速度の制御量に変換する。
壁トレースができない場合は角度0になるように制御する。
壁トレースの可否の判断は左右のどちらの壁も使えないと判断した場合
壁が使えなる判断は、横壁センサの値が閾値よりも大きい&横壁センサの値が8mm前よりも小さすぎない&過去8mmに置いて壁在りの判定となっている。ことを条件に判断する

todo
・串区間の制御
・斜め走行の壁トレース
・斜め走行の出口の壁切れ