Name fixes on ControlLaw and TrajectoryGenerator. Added memory variables and fixed updating.