Added time shifting and zoh options to lqr, added foot position x-offsets to controller.