Planning desired center of Mass and zero moment point trajectories for bipedal locomotion