#include <Wire.h>

/*
* SN74HC165N_shift_reg
*
* Program to shift in the bit values from a SN74HC165N 8-bit
* parallel-in/serial-out shift register.
*
* This sketch demonstrates reading in 16 digital states from a
* pair of daisy-chained SN74HC165N shift registers while using
* only 4 digital pins on the Arduino.
*
* You can daisy-chain these chips by connecting the serial-out
* (Q7 pin) on one shift register to the serial-in (Ds pin) of
* the other.
*
* Of course you can daisy chain as many as you like while still
* using only 4 Arduino pins (though you would have to process
* them 4 at a time into separate unsigned long variables).
*
*/

uint8_t bytes_right;
uint8_t bytes_left;
uint8_t hex_left;
uint8_t hex_right;
/* How many shift register chips are daisy-chained.
*/
#define NUMBER_OF_SHIFT_CHIPS 2

/* Width of data (how many ext lines).
*/
#define DATA_WIDTH NUMBER_OF_SHIFT_CHIPS * 8

/* Width of pulse to trigger the shift register to read and latch.
*/
#define PULSE_WIDTH_USEC 5

/* Optional delay between shift register reads.
*/
#define POLL_DELAY_MSEC 1

/* You will need to change the "int" to "long" If the
* NUMBER_OF_SHIFT_CHIPS is higher than 2.
*/
#define BYTES_VAL_T unsigned int

//SN74HC595
int LED = 13;
int num = 0;
int Slave1_PR[1][2];

// ST_CP pin 12
int latchPin=10; // white
// SH_CP pin 11
int clockIn=11; // blue
// DS pin 14
int dataIn=12; // black

//I2C
int x = 0;
int dt=250;

//SN74HC165
int ploadPin = 7; // Connects to Parallel load pin the 165
int clockEnablePin = 4; // Connects to Clock Enable pin the 165
int dataPin = 5; // Connects to the Q7 pin the 165
int clockPin = 6; // Connects to the Clock pin the 165

byte dataArrayLeft;
byte dataArrayRight;

BYTES_VAL_T pinValues;
BYTES_VAL_T oldPinValues;

/* This function is essentially a "shift-in" routine reading the
* serial Data from the shift register chips and representing
* the state of those pins in an unsigned integer (or long).
*/
BYTES_VAL_T read_shift_regs()
{
long bitVal;
BYTES_VAL_T bytesVal = 0;

/* Trigger a parallel Load to latch the state of the data lines,
*/
digitalWrite(clockEnablePin, HIGH);
digitalWrite(ploadPin, LOW);
delayMicroseconds(PULSE_WIDTH_USEC);
digitalWrite(ploadPin, HIGH);
digitalWrite(clockEnablePin, LOW);

/* Loop to read each bit value from the serial out line
* of the SN74HC165N.
*/
for(int i = 0; i < DATA_WIDTH; i++)
{
bitVal = digitalRead(dataPin);

/* Set the corresponding bit in bytesVal.
*/
bytesVal |= (bitVal << ((DATA_WIDTH-1) - i));

/* Pulse the Clock (rising edge shifts the next bit).
*/
digitalWrite(clockPin, HIGH);
delayMicroseconds(PULSE_WIDTH_USEC);
digitalWrite(clockPin, LOW);
}

return(bytesVal);
}

/* Dump the list of zones along with their current status.
*/
void display_pin_values()
{
//Serial.print("PinValues:\r\n");
//Serial.print(pinValues, HEX);
//Serial.print("\r\n");

//Serial.print("\nInvert PinValues:\r\n");
//Serial.print(~pinValues, HEX);
//Serial.print("\r\n");
}

void setup()
{
Serial.begin(9600);

pinMode (LED, OUTPUT);
// Start the I2C Bus as Slave on address 2
Wire.begin(1);
// Attach a function to trigger when something is received.
Wire.onReceive(receiveEvent);

// Serial.begin(9600);

/* Initialize our digital pins...
*/
// 74HC165 pins
pinMode(ploadPin, OUTPUT);
pinMode(clockEnablePin, OUTPUT);
pinMode(clockPin, OUTPUT);
pinMode(dataPin, INPUT);

// 74HC595 pins
pinMode(latchPin,OUTPUT);
pinMode(dataIn,OUTPUT);
pinMode(clockIn,OUTPUT);

digitalWrite(latchPin, LOW);
digitalWrite(clockPin, LOW);
digitalWrite(ploadPin, HIGH);

/* Read in and display the pin states at startup.
*/
pinValues = read_shift_regs();
display_pin_values();
oldPinValues = pinValues;

//send photoresistor data to master
pinMode(A0, INPUT);
}

void I2C_Counter() {
if (x == 1) {
digitalWrite(LED, HIGH);
}
else {
digitalWrite(LED, LOW);
}

if (x == 6) {
digitalWrite(LED, HIGH);
delay(500);
digitalWrite(LED, LOW);
}

}

//I2C counter that blinks LED 13 for the devices in order 1 to 5. All 5 come on when x == 6
void receiveEvent(int bytes) {
x = Wire.read(); // read one character from the I2C

}

void loop()
{
I2C_Counter();

// send photoresistor data to master

/* Read the state of all zones.
*/
pinValues = read_shift_regs();

bytes_right = ~pinValues >> 8;
bytes_left = ~pinValues & 0x00FF;
//Serial.print("Bytes Right\r\n");
//Serial.print(bytes_right, HEX);
//Serial.print("\r\n");
//Serial.print("Bytes Left\r\n");
//Serial.print(bytes_left, HEX);
//Serial.print("\r\n");

//Serial.print(pinValues, HEX);
//Serial.print("\r\n");

uint8_t hex_left = (bytes_left);
uint8_t hex_right = (bytes_right);
//Serial.print("Hex Right\r\n");
//Serial.print(hex_right);
//Serial.print("\r\n");
//Serial.print("Hex Left\r\n");
//Serial.print(hex_left);
//Serial.print("\r\n");

if(pinValues != oldPinValues)
{
// Serial.print("*Pin value change detected*\r\n");
display_pin_values();
oldPinValues = pinValues;

delay(POLL_DELAY_MSEC);
}

//Write to LEDs
digitalWrite(latchPin, LOW);
shiftOut(dataIn, clockIn, LSBFIRST, hex_right);
digitalWrite(latchPin, LOW);
shiftOut(dataIn, clockIn, LSBFIRST, hex_left );

//ST_CP HIGH change LEDs
digitalWrite(latchPin, HIGH);

//Photoresistor A0
int valueA0 = analogRead(A0);
Serial.println("Analog value A0 : ");
Serial.println(valueA0);
delay(3000);

}