Demo code

Code for the Demo for Thomas. Added absolute path to save waypoints and
windows for Merrick's image processing.