Concurrent Contact Planning and Trajectory Optimization in One Step Walking Motion