Fixed a compiler error in prior commit and added a simple motion validity function in RRT2DTest.hs
Added a general discrete motion validator
Added generalized goals, consolidated some code, and fixed a bug with motion checking in RRT