Updated IKFast solvers, worked on benchmarking