Raspi code for SICK Robot Day 2014 competition