ROBOOP, A Robotics Object Oriented Package in C++