[OLD] Implementation of STP for RoboCup in C++