Initial version of the code.
- By the moment, just plotting class is implemented.
   * This class will be used for debugging purposes
Simplified the plotting class so OpenCV is not needed for that