remove the most of the test on additional time samples for inverseKinTraj. That part of the code should be reformulated, to take Russ's suggestion on parameterizing qdot as decision variables so as to make the gradient sparse