added setImuCfg; WIP