Fixed some bugs in the moveRelativePath_old service, added the DeltaRobotTest to cmake.