CMake needs to be refactored and cleaned up. I made an attempt on [cmake_cleanup_branch](https://github.com/robotology-playground/xsens-mvn/tree/cmake_cleanup), still work in progress. cc @traversaro