// Generic code for the LED Breadboard part of the Innovations Module
// assert high. Code turns on/off all five LEDs every second.


#define ledOne 2
#define ledTwo 3
#define ledThree 4
#define ledFour 5
#define ledFive 6


void setup() {
    // put your setup code here, to run once:
    pinMode(ledOne, OUTPUT);
    pinMode(ledTwo, OUTPUT);
    pinMode(ledThree, OUTPUT);
    pinMode(ledFour, OUTPUT);
    pinMode(ledFive, OUTPUT);
}

void loop() {
    // put your main code here, to run repeatedly:
    digitalWrite(ledOne, LOW);
    digitalWrite(ledTwo, LOW);
    digitalWrite(ledThree, LOW);
    digitalWrite(ledFour, LOW);
    digitalWrite(ledFive, LOW);
    delay(1000); //1000 = 1 second

    digitalWrite(ledOne, HIGH);
    digitalWrite(ledTwo, HIGH);
    digitalWrite(ledThree, HIGH);
    digitalWrite(ledFour, HIGH);
    digitalWrite(ledFive, HIGH);
    delay(1000);
}

/*
* Chip Camp Car
* Michael Eyler
* May 2018
*/

#define enR 3 //Right motor enable (PWM)
#define R1 4 //Right motor port 1
#define R2 5 //Right motor port 2
#define enL 9 //Left motor enable (PWM)
#define L1 7 //Left motor port 1
#define L2 8 //Left motor port 2
int motorSpeed=130;



void setup() {
    pinMode(enR, OUTPUT);
    pinMode(R1, OUTPUT);
    pinMode(R2, OUTPUT);
    pinMode(enL, OUTPUT);
    pinMode(L1, OUTPUT);
    pinMode(L2, OUTPUT);
    analogWrite(enR,motorSpeed);
    analogWrite(enL,motorSpeed);
}

void loop() {
    //Go straight for 2 seconds
    forward(2000);
    //Go left for 0.5 seconds
    left(500);
}

void cease() {
    digitalWrite(R1,LOW);
    digitalWrite(R2,LOW);
    digitalWrite(L1,LOW);
    digitalWrite(L2,LOW);
}

void forward(int dis) {
    digitalWrite(R1,HIGH);
    digitalWrite(R2,LOW);
    digitalWrite(L1,HIGH);
    digitalWrite(L2,LOW);
    delay(dis);
    cease();
}

void left(int ang) {
    digitalWrite(R1,HIGH);
    digitalWrite(R2,LOW);
    digitalWrite(L1,LOW);
    digitalWrite(L2,HIGH);
    delay(ang);
    cease();
}

// BYU Chip Camp 2019
// Innovations Module - LED Frisbee
// Template code - turns on each light, one at a time


#define RED LOW,HIGH,HIGH
#define YELLOW LOW,LOW,HIGH
#define GREEN HIGH,LOW,HIGH
#define CYAN HIGH,LOW,LOW
#define BLUE HIGH,HIGH,LOW
#define MAGENTA LOW,HIGH,LOW
#define WHITE LOW,LOW,LOW
#define OFF HIGH,HIGH,HIGH

int LEDs[6][3] = {
    {20, 21, 19}, //LED1
    {17, 18, 16}, //LED2
    {3 , 4 , 2 }, //LED3
    {6 , 8 , 5 }, //LED4
    {10, 11, 9 }, //LED5
    {13, 14, 12} //LED6
    //RED, GREEN, BLUE
};

// Function that turns on a specified LED to a specific color
void writeRGB(int LEDNUM, int c1, int c2, int c3){
    digitalWrite(LEDs[LEDNUM-1][0], c1);
    digitalWrite(LEDs[LEDNUM-1][1], c2);
    digitalWrite(LEDs[LEDNUM-1][2], c3);
}

// Function that turns off all 6 LEDs
void clearLEDs()
{
    for(int x=1;x<=6;x++)
    {
        writeRGB(x,OFF);
    }
}

// put your setup code here, to run once:
void setup()
{
    // This code cycles through each pin and sets it up as an output
    for(int i = 0; i < 6; i++){
        for(int j = 0; j < 3; j++){
            pinMode(LEDs[i][j], OUTPUT);
        }
    }
    clearLEDs();
}

void loop()
{
    //Basic Colors - Red, Green, and Blue
    
    writeRGB(1,RED); //Turn the first one RED
    
    delay(750); //Wait 750 milliseconds
    
    writeRGB(2,GREEN); //Turn the second one GREEN
    
    delay(750);
    
    writeRGB(3,BLUE); //Turn the third one BLUE
    
    delay(750);
    
    writeRGB(4,WHITE); //White - All colors combined!
    
    delay(750);
    
    writeRGB(5,BLUE); //Turn the fifth one BLUE
    
    delay(750);
    
    writeRGB(6,GREEN); //Turn the sixth one GREEN
    
    delay(2000);
}