Fix movement.py UpdatePoseState - loop_monitor() method

[Cruiz102]

Issue Overview

The loop_monitor() method in this file has not been tested, and it is not sure that it is going to work well. To solve this issue, we need to test the behaviour of this function with the full uuv_simulation. We also need to include a test that ensures the correct functionality of this function.

Specific Task and Requirements:

1. Testing loop_monitor() Functionality
   Problem: The loop_monitor() method is untested, creating uncertainty about its performance in the UUV simulation.
   Proposed Solution:
   Develop a comprehensive test to evaluate the behavior of the loop_monitor() method within the context of the full UUV simulation.
   Include checks for expected outputs and robustness under various simulation conditions.

2. Simulation Environment Setup
   Task: Create a new file named test_movement.test to store scripts or commands needed to start the simulation nodes for this test.

Suggestion: Develop a function or script that verifies the availability and readiness of necessary hardware, particularly GPUs, before initiating the test.

[Cruiz102]

Test already runs but they fail. It is probably because there is a timeout in rostest and do not run the loop_monitor() function correctly. That test need debugging. The code seems to work with example.py but creating the Test is important to improve reliability.