Code for my first version micromouse