added navigation psudocode. point-to-point navigation
added log. split map class. added AngleUtilities.hpp
updated log
fixing cmake script for graph
Added nodeExistsForward(), getNodesNearby(), and started logger. Have not tested the functions yet
fixing compile errors
Merge branch 'devel_week2' of https://github.com/fernandomdo/roomba_pp into devel_week3