First run, yaaay!

Lots of place to improve, the robot movement is very rough for me right now so I need to optimize it.