adding a couple functions for repeating and flipping 1-step trajectories. I *think* these are working correctly, but I'm not able to stabilize a second step.

Next thing to try will be computing LQR with zoh velocities and playing with costs.