Robotics Project in C++