Complete trajectory generation / solution for minihubo using Youngbum's ZMP Preview implementation. The code is a hacked up mess right now, but it belches out turning trajectories like nobodies' business. The ZMP Model used is limited to large turning radii, since the centripetal acceleration is not included.