The C++ Code for the Ping Pong Demo Robot