Updated CMakeLists.txt
Removed submodule and updated package.xml.
Updated driver.