trying to find walls
Merge branch 'PTAM_dev' of github.com:pvarin/Olin_AR_Drone into PTAM_dev