adding turning constants to robomap
reorganizing and cleaning out code
adding isWithin() to MathUtils
merging in Mikes code fixes