C++ script for robot arm - Raspberry Pi