Fixed the locking of the RViz enviroment when we execute the Cartesian Path.