First Commit, Basic robot can be started, but no functions yet. States can be changed from console.