Initial files

Added pdf lab paper, wavefront algorithm matlab file and 2 .mat files
contains maps to solve
Building Trajectory

Build Trajectory Functions