modif cmakelist
add plugins needed functions
update the copy
update headers
remove print that make bug
load init pose for fixed robots