Added function to plan path and added mutex for thread blocking. No guts to path planning function yet.
Fix XYPlot Javascript issue
Path planning is now integrated into car control using existing waypoint vector heading system. Changes to matlab lib. Changes to FrontEnd to plot possible paths.