Removed old file
Compile time fixes
Changed KDL namespace