Implemented basic functions for Navigation.java, refactored some methods in Robot.java, and just added a couple of constants to Constants.java