Updating RBFMotionSolver