code omni wheel with magnetometer