final submission: full implementation of discrete online trajectory optimization method with dimensionality modifications. project builds. project runs in analytic mode, though incorrectly. project encounters runtime error in discrete mode, though i am not sure why. code is clean and commented for any future development initiatives.