Cleaned up Repo, changed design of the robot