// Connections
sbit LED  at LATA4_bit;
sbit LEDR at LATC2_bit;
sbit LEDG at LATC1_bit;
sbit LEDB at LATD0_bit;

unsigned short dutyLEDR,dutyLEDG,dutyLEDB;

unsigned int i,counterLEDR,counterLEDG,counterLEDB;

void Interrupt(){
  // 2550us = 2.55ms
  if (TMR0IF_bit){    
    TMR0IF_bit = 0;
    TMR0H         = 0x88;
    TMR0L         = 0x78;
    //Enter your code here
    if(dutyLEDR) LEDR=1;
    if(dutyLEDG) LEDG=1;
    if(dutyLEDB) LEDB=1;
    counterLEDR=0;
    counterLEDG=0;
    counterLEDB=0;
  }
  //10us
  if (TMR1IF_bit){
    TMR1IF_bit = 0;    
    TMR1H         = 0xFF;
    TMR1L         = 0x88;
    //Enter your code here
    if(counterLEDR >= dutyLEDR) LEDR=0;
    if(counterLEDG >= dutyLEDG) LEDG=0;
    if(counterLEDB >= dutyLEDB) LEDB=0;

    if(counterLEDR<255) counterLEDR++;
    if(counterLEDG<255) counterLEDG++;
    if(counterLEDB<255) counterLEDB++;
  }
}

void InitTimer0(){
  T0CON         = 0x88;
  TMR0H         = 0x88;
  TMR0L         = 0x78;
  GIE_bit       = 1;
  TMR0IE_bit    = 1;
}
void InitTimer1(){
  T1CON         = 0x01;
  TMR1IF_bit    = 0;
  TMR1H         = 0xFF;
  TMR1L         = 0x88;
  TMR1IE_bit    = 1;
  INTCON        = 0xC0;
}
void setRGB(unsigned short R, unsigned short G, unsigned short B){
  //PWM1_Set_Duty(R);
  //PWM2_Set_Duty(G);
  //dutyLEDB=B;
  
  dutyLEDR=R;
  dutyLEDG=G;
  dutyLEDB=B;
}

void animateRGB(unsigned short R, unsigned short G, unsigned short B){
  
  while((dutyLEDR != R) || (dutyLEDG != G) || (dutyLEDB != B)){
    if(R>dutyLEDR) dutyLEDR++;
    else if(R<dutyLEDR) dutyLEDR--;

    if(G>dutyLEDG) dutyLEDG++;
    else if(G<dutyLEDG) dutyLEDG--;

    if(B>dutyLEDB) dutyLEDB++;
    else if(B<dutyLEDB) dutyLEDB--;
    
    delay_ms(10);
  }

}

void main() {
  TRISA=0b00000000;// [][][][LED][][][][]
  TRISC=0b00000000;// [][][][][][LEDR][LEDG][]
  TRISD=0b00000000;// [][][][][][][][LEDB]

  LATA=0x00;
  LATC=0x00;
  LATD=0x00;
  
  dutyLEDR=0;
  dutyLEDG=0;
  dutyLEDB=0;

  /*
  PWM1_Init(5000);
  PWM1_Set_Duty(dutyLEDR);
  PWM1_Start();

  PWM2_Init(5000);
  PWM2_Set_Duty(dutyLEDG);
  PWM2_Start();
  */
  
  InitTimer0();
  InitTimer1();
  
  while(1){
    /*LEDR=0; LEDG=0; LEDB=0; delay_ms(1000);
    LEDR=1; LEDG=0; LEDB=0; delay_ms(1000);
    LEDR=0; LEDG=1; LEDB=0; delay_ms(1000);
    LEDR=0; LEDG=0; LEDB=1; delay_ms(1000);*/

    /*for(i=0; i<255; i++){
      dutyLEDR=i;
      PWM1_Set_Duty(dutyLEDR);
      delay_ms(10);
    }

    for(i=0; i<255; i++){
      dutyLEDR=(255-i);
      PWM1_Set_Duty(dutyLEDR);
      delay_ms(10);
    }

    for(i=0; i<255; i++){
      dutyLEDG=i;
      PWM2_Set_Duty(dutyLEDG);
      delay_ms(10);
    }

    for(i=0; i<255; i++){
      dutyLEDG=(255-i);
      PWM2_Set_Duty(dutyLEDG);
      delay_ms(10);
    } */
    

    //setRGB(0,0,255);  // Blue
    
    
    /*for(i=0; i<255; i++){
      dutyLEDB=i;
      delay_ms(10);
    }

    for(i=0; i<255; i++){
      dutyLEDB=(255-i);
      delay_ms(10);
    } */

    /*
    setRGB(255,0,0);  // R
    delay_ms(500);
    setRGB(0,255,0);  // G
    delay_ms(500);
    setRGB(0,0,255);  // B
    delay_ms(500);
    setRGB(255,255,0);  // Yellow
    delay_ms(500);
    setRGB(255,127,0);  // Orange
    delay_ms(500);
    setRGB(255,0,150);  // Purple
    delay_ms(500);
    setRGB(255,255,255);  // White
    delay_ms(500);
    */
    animateRGB(255,0,0);  // R
    animateRGB(0,255,0);  // G
    animateRGB(0,0,255);  // B
    animateRGB(255,255,0);  // Yellow
    animateRGB(255,127,0);  // Orange
    animateRGB(255,0,150);  // Purple
    animateRGB(255,255,255);  // White
  }
}