setImuCfg WIP