Adding robot code so far
Fixing organization of robot_code