Started the programming

A couple of days ago Locky and I started the programming with something very simple!

basically:

looped the following
if (ultrasonic sensor distance > 50cm)
spin (to look for it)
else
charge and raise fork when < 10cm away (probably change that to 5cm because it is lifting it too early atm!)



Will add edge detection and rear attack detection and that should be as much as we need!