Added setFloatingBaseLink and switchAnchorAndFloatingBase in idynutils