set foot height from command line, also do smarter zmp shifting using cubic spline, also figured out some command line switches for quasistatic