Adding RBFMotionSolver