Cleaned up some code.
Added NavTestPrograms directory. Instructions for running are in lab notebook.