fixed variable scope error
Merge branch 'master' of https://github.com/hmurraydavis/Path_Planning