added setworldpose to velcmd