Plan for minimum time trajectory, at least one joint maximum torque