Robot code for Lego Mindstorms robot controlled by a Raspberry Pi & BrickPi