Make testNestRobot test passed
Finished the recursive function and make two of the initial tests passed