parallellised the code and first working measurements
resolved conflicts
Merge branch 'ar_approaching' of https://github.com/yujinrobot/kobuki-x into ar_approaching