Re-organized Robot code into its own sub folder

So that Robot and camera test can each be their own net beans project.