public void Initialize() { byte data = (byte)(((byte)(HMC5883L_AVERAGING_8 << (HMC5883L_CRA_AVERAGE_BIT - HMC5883L_CRA_AVERAGE_LENGTH + 1))) | ((byte)(HMC5883L_RATE_15 << (HMC5883L_CRA_RATE_BIT - HMC5883L_CRA_RATE_LENGTH + 1))) | ((byte)(HMC5883L_BIAS_NORMAL << (HMC5883L_CRA_BIAS_BIT - HMC5883L_CRA_BIAS_LENGTH + 1)))); _i2c.WriteByte(HMC5883L_RA_CONFIG_A, data); // write CONFIG_B register SetGain(HMC5883L_GAIN_1370); // write MODE register SetMode(HMC5883L_MODE_CONTINUOUS); }
private static void WriteRegister(I2CDevice device, byte register, byte value) { device.WriteByte(register); device.WriteByte(value); }