code to control HapPi robot