greatly sped up ikfast by prioritizing which raghavanroth equations to use