fixes for making follow me work in the real robot
Merge pull request #152 from reem-utils/roger_branch

fixes for making follow me work in the real robot