Switching for kdl_codyco rovereto branch for tests