Fixed a problem that does not obstacle avoidance
Merge pull request #7 from open-rdc/fix-obstacle-height

Fixed a problem that does not obstacle avoidance