TODO: Complete the already existing prototype of the integration test using the Talos simulation and the pd_controller already existing