[fix] Do not create not used pose manager

The pose manager was always created even if not used in the Reset function in the constructor.

This was leading to a weird segfault when using ROS wrapping in Release mode.

Now, the pose manager is resetted only if it exists.