#include<xc.h>
#define _XTAL_FREQ 4000000
 
void I2C_Master_Init(const unsigned long c){
  SSP2CON1 = 0x28;                //SSP2 Module as Master
  SSP2CON2 = 0x00;
  SSP2CON3 = 0x00;
  SSP2ADD = (_XTAL_FREQ/(4*c))-1; //Setting Clock Speed
  SSP2STAT = 0x80;
  
  //SSP2CLKPPS = 0x14;              //PPS Settings
  //SSP2DATPPS = 0x15;
  //RC4PPS = 0x1a;
  //RC5PPS = 0x1b;
}
void I2C_Master_Wait(){
  while ((SSP2STAT & 0x04) || (SSP2CON2 & 0x1F)); //Transmit is in progress
    
}
void I2C_Master_Start(){
  I2C_Master_Wait();    
  SSP2CON2bits.SEN = 1;           //Initiate start condition
}
void I2C_Master_RepeatedStart(){
  I2C_Master_Wait();
  SSP2CON2bits.RSEN = 1;          //Initiate repeated start condition
}
void I2C_Master_Stop(){
  I2C_Master_Wait();
  SSP2CON2bits.PEN = 1;           //Initiate stop condition
}
void I2C_Master_Write(unsigned d){
  I2C_Master_Wait();
  SSP2BUF = d;                    //Write data to SSP2BUF
}
unsigned short I2C_Master_Read(unsigned short a){
  unsigned short temp;
  I2C_Master_Wait();
  SSP2CON2bits.RCEN = 1;
  I2C_Master_Wait();
  temp = SSP2BUF;                 //Read data from SSP2BUF
  I2C_Master_Wait();
  SSP2CON2bits.ACKDT = a;         //Acknowledge bit    1:NACK  0:ACK
  SSP2CON2bits.ACKEN = 1;         //Acknowledge sequence
  return temp;
}