add a debug drawing module containing frames and arrows

[MaximilienNaveau]

Description

Add drawing tools for debug!

How I Tested

Creating and running a demo

I fulfilled the following requirements

• All new code is formatted according to our style guide (for C++ run clang-format, for Python, run flake8 and fix all warnings).
• All new functions/classes are documented and existing documentation is updated according to changes.
• No commented code from testing/debugging is kept (unless there is a good reason to keep it).