Conflict merged
Merge branch 'followme' of https://github.com/alexey-ozhigov/cob_navigation into followme
Transform incomming points into global frame. Clear points after plan is made.