Run test_plan_speeds with rosrun, try modifying the joint limits. Then we will need to incorporate trajectory_speed_up in everything.