fix bug in use of setFloatingBaseLink