fixed minor errors in forwardMotionModel and MotionGraphs for Astar