changed ZMP coordinate frame in genFullBodyTraj. No renaming in core code