uncomment adaption part in dynamic.cpp, ros_urdf correct now