//
//
// hello.RGB.45.c
//
// RGB LED software PWM hello-world
//
// Neil Gershenfeld
// 11/10/10
//
// (c) Massachusetts Institute of Technology 2010
// Permission granted for experimental and personal use;
// license for commercial sale available from MIT.
//

#include <avr/io.h>
#include <util/delay.h>

#define output(directions,pin) (directions |= pin) // set port direction for output
#define set(port,pin) (port |= pin) // set port pin
#define clear(port,pin) (port &= (~pin)) // clear port pin
#define pin_test(pins,pin) (pins & pin) // test for port pin
#define bit_test(byte,bit) (byte & (1 << bit)) // test for bit set
#define PWM_delay() _delay_us(25) // PWM delay
#define long_delay() _delay_ms(90) // long delay
#define medium_delay() _delay_ms(70) // medium delay

//My LED output pins will be PA7, PB2, and PB0 (2nd, 5th, and 6th on LHS)
//each LED pin is one of the colors
#define led1_port PORTA
#define led1_direction DDRA
#define led1_pin_out (1 << PA7)
#define led2_port PORTB
#define led2_direction DDRB
#define led2_pin_out (1 << PB2)
#define led3_port PORTB
#define led3_direction DDRB
#define led3_pin_out (1 << PB0)
//Putting pins at low will turn them on, since other side is VCC

int main(void) {
   //
   // main
   //
   static char chr, high, low;
   unsigned char i;
//   int value, high, low;
   uint16_t value;
   //
   // set clock divider to /1
   //
   CLKPR = (1 << CLKPCE);
   CLKPR = (0 << CLKPS3) | (0 << CLKPS2) | (0 << CLKPS1) | (0 << CLKPS0);
   //
   // initialize output pins
   //
   //set(serial_port, serial_pin_out);
   //output(serial_direction, serial_pin_out);
   //

//initialize LED pins
//opposite day for clear and set? (VCC vs GND?)
   set(led1_port, led1_pin_out);
   output(led1_direction, led1_pin_out);
   set(led2_port, led2_pin_out);
   output(led2_direction, led2_pin_out);
   set(led3_port, led3_pin_out);
   output(led3_direction, led3_pin_out);

//Blink each color a few times at start to verify them.
for(i=0; i<10; ++i){
   clear(led1_port, led1_pin_out);
   medium_delay();
   set(led1_port, led1_pin_out);
   medium_delay();

   clear(led2_port, led2_pin_out);
   medium_delay();
   set(led2_port, led2_pin_out);
   medium_delay();

   clear(led3_port, led3_pin_out);
   medium_delay();
   set(led3_port, led3_pin_out);
   medium_delay();
}

   set(led1_port, led1_pin_out);
   set(led2_port, led2_pin_out);
   set(led3_port, led3_pin_out);

//My input pins (ADC) are PA2 and PA3 (4th and 5th on RHS)--these are defined later
   // init A/D
   //
//One set for each pressure sensor!  But for now just do one, assume if you're not standing on one foot you're standing on the other
//Old version
//   ADMUX = (0 << REFS2) | (0 << REFS1) | (0 << REFS0) // Vcc ref
//      | (0 << ADLAR) // right adjust
//      | (0 << MUX3) | (0 << MUX2) | (1 << MUX1) | (1 << MUX0); // ADC3 (PB3)
//   ADCSRA = (1 << ADEN) // enable
//      | (1 << ADPS2) | (1 << ADPS1) | (1 << ADPS0); // prescaler /128



//Look at table 16-4
//Also table 22 (no REFS2)
   ADMUX = (0 << REFS1) | (0 << REFS0) // Vcc ref
      | (0 << ADLAR) // right adjust
      | (0 << MUX5) | (0 << MUX4) | (0 << MUX3) | (0 << MUX2) | (1 << MUX1) | (0 << MUX0); // ADC2 (PA2) 000010  MUX pattern for PA2 
   ADCSRA = (1 << ADEN) // enable
      | (1 << ADPS2) | (1 << ADPS1) | (1 << ADPS0); // prescaler /128



//   ADMUX = (0 << REFS1) | (0 << REFS0) // Vcc ref
//      | (0 << ADLAR) // right adjust
//      | (0 << MUX5) | (0 << MUX4) | (0 << MUX3) | (0 << MUX2) | (1 << MUX1) | (1 << //MUX0); // ADC3 PA3 has pattern 000011
//   ADCSRA = (1 << ADEN) // enable
//      | (1 << ADPS2) | (1 << ADPS1) | (1 << ADPS0); // prescaler /128

   //
   // main loop
   //
   while (1) {
      // initiate conversion
      //
      ADCSRA |= (1 << ADSC);
      //
      // wait for completion
      //
      while (ADCSRA & (1 << ADSC))
         ;
      //
      // send result
      //
      chr = ADCL;
      high=chr;
//      put_char(&serial_port, serial_pin_out, chr);
      //char_delay();

      chr = ADCH;
      low=chr;
  //    put_char(&serial_port, serial_pin_out, chr);
    //  char_delay();
	//try to combine the values
      value = 256*high + low;
      //put_char(&serial_port, serial_pin_out, value);
      //char_delay();

//And try to do the light: different colors depending on the amount of pressure
//Right now this is basically just giving me two colors--we rarely hit the midpoint pressure spot.
    if(value>2.85){
        clear(led1_port, led1_pin_out);
	 set(led2_port, led2_pin_out);
	 set(led3_port, led3_pin_out);
         medium_delay();
}
//TURN ON LIGHT
else{
    if(value>1.85){
	 set(led1_port, led1_pin_out);
        clear(led2_port, led2_pin_out);
	 set(led3_port, led3_pin_out);
         medium_delay();
	}
else{
        set(led1_port, led1_pin_out);
	 set(led2_port, led2_pin_out);
        clear(led3_port, led3_pin_out);
         medium_delay();
	}

}

      }
   }