Robot Programming Exercise 4, Group D2