Update robotFunctions.c