added obstacle avoidance
Seemd to fix camera/mapping things
Merge branch 'master' of https://github.com/cypressf/rescuebot
Merge branch 'obstacle-avoid' of https://github.com/cypressf/rescuebot
Adjusting for robot theta