Code to test robot Camera vision processing