Bug fix in kdl_export, more to do