wifi_ddwrt/setInitPose fully functional