人追従のアルゴリズムのリファクタリング

[ShunjiHashimoto]

大幅なリファクタリングを実施し、屋外での動作実験は完了している。