Support Completing rostest Migration to ROS2

[nqtabokado]

Hi @ThomasDuvinage 👋,
I noticed that in PR #4 , you mentioned that the rostest migration to ROS2 is not yet available. I’d like to help finalize this part.

[ThomasDuvinage]

Hi @nqtabokado,
That's a great news, thanks ! Feel free to contribute on the current PR 😃