LabAlgo

Prototype algorithm for star labs.

3/12 meeting notes optimizer is solving for a path. given gradient matrices. solving at every time instant.