Add ikTraj to planSwing. Untested.