誤差関数の組み込み、直進回転で壁探索する関数の追加