void initI2C(void) {
   
   
    // Configure the internal oscillator for 16 MHz
    OSCCON1bits.NOSC = 0b110;    // Set internal oscillator to HFINTOSC
    OSCFRQbits.HFFRQ = 0b110;    // Set HFINTOSC to 16 MHz

    // Set RC3 (SCL) and RC4 (SDA) as input pins for I2C
    TRISCbits.TRISC0 = 1;   // SCL (RC0) as input
    TRISCbits.TRISC1 = 1;   // SDA (RC1) as input

    // Configure MSSP module for I2C Master mode
    SSP1CON1bits.SSPM = 0b1000;   // I2C Master mode, clock = FOSC / (4 * (SSPADD + 1))
   
    // Calculate and set SSPADD value for I2C clock speed of 100 kHz
    SSP1ADD = ((_XTAL_FREQ / 4) / 100000) - 1;   // 100 kHz I2C clock speed at 16 MHz oscillator frequency
   
    // Enable MSSP module
    SSP1CON1bits.SSPEN = 1;
}