some changes to cmake and ready for integrate of icub
re-organize and link icub to control