Added linear and figure-eight path support to trajectory generation system