first try on the robot, it works
Merge pull request #182 from reem-utils/roger_branch

first try on the robot, it works