/*
  Blink

  Turns an LED on for one second, then off for one second, repeatedly.

  Most Arduinos have an on-board LED you can control. On the UNO, MEGA and ZERO
  it is attached to digital pin 13, on MKR1000 on pin 6. LED_BUILTIN is set to
  the correct LED pin independent of which board is used.
  If you want to know what pin the on-board LED is connected to on your Arduino
  model, check the Technical Specs of your board at:
  https://www.arduino.cc/en/Main/Products

  modified 8 May 2014
  by Scott Fitzgerald
  modified 2 Sep 2016
  by Arturo Guadalupi
  modified 8 Sep 2016
  by Colby Newman

  This example code is in the public domain.

  http://www.arduino.cc/en/Tutorial/Blink
*/

#include "16LED_text.h"

int LED1 = 19;  // PC5(A5) "L" is lit
int LED2 = 18;  // PC4(A4)
int LED3 = 17;  // PC3(A3)
int LED4 = 16;  // PC2(A2)
int LED5 = 15;  // PC1(A1)
int LED6 = 14;  // PC0(A0)
int LED7 = 13;  // PB5
int LED8 = 12;  // PB4
int LED9 = 11;  // PB3
int LED10 = 10; // PB2
int LED11 = 9;  // PB1
int LED12 = 8;  // PB0
int LED13 = 7;  // PD7
int LED14 = 6;  // PD6
int LED15 = 5;  // PD5
int LED16 = 4;  // PD4
int S3 = 3;     // PD3: Select-SW
int S2 = 2;     // PD2: Start-SW
                // PD1: TxD
                // PD0: RxD
int sel_SW = 0x08; // PD3
int stt_SW = 0x04; // PD2
                
int dMask7  = 0x07;    // (0000 0xxx)
int dMask15 = 0x0F;    // (0000 xxxx)

int ver = 1;    // ver 0.01
int mode = 0;
int item_num = 0;   // item No.
int line;
int dbg_count = 0;

int task = 0;
unsigned long tim0;
unsigned int dLED;

int blink_task = 0;
unsigned long  blink_tim0;

int tMessage[] = {&mes0, &mes1, &mes2, &mes3, &mes4, &mes5, &mes6, &mes7};
int lMessage[] = {sizeof(mes0)/2,sizeof(mes1)/2,sizeof(mes2)/2,sizeof(mes3)/2,sizeof(mes4)/2,sizeof(mes5)/2,sizeof(mes6)/2,sizeof(mes7)/2};



// the setup function runs once when you press reset or power the board
void setup() {
  // initialize digital pin LED_BUILTIN as an output.
  //pinMode(LED_BUILTIN, OUTPUT);
  pinMode(LED1, OUTPUT);
  digitalWrite(LED1, HIGH);
  pinMode(LED2, OUTPUT);
  digitalWrite(LED2, HIGH);
  pinMode(LED3, OUTPUT);
  digitalWrite(LED3, HIGH);
  pinMode(LED4, OUTPUT);
  digitalWrite(LED4, HIGH);
  
  pinMode(LED5, OUTPUT);
  digitalWrite(LED5, HIGH);
  pinMode(LED6, OUTPUT);
  digitalWrite(LED6, HIGH);
  pinMode(LED7, OUTPUT);
  digitalWrite(LED7, HIGH);
  pinMode(LED8, OUTPUT);
  digitalWrite(LED8, HIGH);
  
  pinMode(LED9, OUTPUT);
  digitalWrite(LED9, HIGH);
  pinMode(LED10, OUTPUT);
  digitalWrite(LED10, HIGH);
  pinMode(LED11, OUTPUT);
  digitalWrite(LED11, HIGH);
  pinMode(LED12, OUTPUT);
  digitalWrite(LED12, HIGH);
  
  pinMode(LED13, OUTPUT);
  digitalWrite(LED13, HIGH);
  pinMode(LED14, OUTPUT);
  digitalWrite(LED14, HIGH);
  pinMode(LED15, OUTPUT);
  digitalWrite(LED15, HIGH);
  pinMode(LED16, OUTPUT);
  digitalWrite(LED16, HIGH);
  
  pinMode(S3, INPUT);
  pinMode(S2, INPUT);

  Serial.begin(9600);
  Serial.println("16LED v0.05");

  if (~PIND & sel_SW) {mode =100;}  // selSW ON => goto Test0

  
}

// the loop function runs over and over again forever
void loop() {
  switch (mode) {
    case 0:
      selItem();  // Item select
      break;
    case 1:
      showMess(tMessage[item_num], lMessage[item_num]); //
      //test0();
      break;
    case 100:
      chkSelOFF();  // Select SW OFF check
      break;
    case 101:
      test0();    // LED1 to 16 ON/OFF
      break;
    case 102:
      test1();    // Switch Check
      break;

    default:
      mode = 0;
      break;
  }
}



//
//  ***** Test Mode *****
//    void test0(void)    // LED No.16 to 1 ON/OFF
//    void test1(void)    // Switch Check
//
//  ***** Normal Mode *****
//    void selItem(void)  // Select Item
//    void showMess(int *mes, int len)  // show Message


void showMess(int *mes, int len) {
  
  switch (task) {
    case 0:
      line = 0;
      task++;
      tim0 = micros();
      Serial.print("Start ");
      Serial.print(item_num);
      Serial.println();
      break;
    case 1:
      if ((micros() - tim0) > 200000) {task++; }
      break;
    case 2:
      //setLED(mes0[line]);
      setLED(mes[line]);
      tim0 = micros();
      task++;
      break;
    case 3:
      if ((micros() - tim0) > 3000) {
        //if (line < sizeof(mes0)-1) {
        if (line < len-1) {
          line++;
          task--;
        } else {
          task++;
          tim0 = micros();
          setLED(0);
          } 
      }
      break;
    case 4:
      if ((micros() - tim0) > 200000) {task++; }
      break;

    default:
      task = 0;
      mode =0;
//      Serial.println("End");
      break;
  }
}

//  ***** Mode = 0 *****

void selItem(void) {    // Select Item
  chkSelSW();   // item select
  blinkItem();  // item No. Blinking
  chkSttSW();   // Start SW check
  
  
}

void blinkItem(void) {
  unsigned int l;
      
  switch (blink_task) {
    case 0:
      l = 0x8000;
      for (int i=0; i<item_num; i++) { l = l >> 1; }
      setLED(l);        // LED ON
      
        blink_tim0 = micros();
        blink_task++;
      break;
    case 1:
      dbg_count++;
      if ((micros() - blink_tim0) > 50000){
        setLED(0);      // LED OFF
      
        blink_tim0 = micros();
        blink_task++;
      }
      break;
    case 2:
      if ((micros() - blink_tim0) > 900000){
        blink_task++;
      }
      break;
    
    default:
      //Serial.println(dbg_count);
      //delay(10);
      blink_task = 0;
      break;
  }
}

void chkSttSW(void) {   // Start SW check
  if (~PIND & stt_SW) {
    mode = 1;
    task = 0;
    //Serial.println("Start");
    }
}

void chkSelSW(void) { // item select
  switch (task) {
    case 0:   // SW ON check
      if (~PIND & sel_SW) {
        item_num = (item_num + 1) & dMask7;
        Serial.print("SW ON , Item = ");
        Serial.print(item_num);
        
        task++;
        }
      break;
    case 1:   // SW OFF check
      if (PIND & sel_SW) {
        
        tim0 = micros();
        task++;
        }
      break;
    case 2:   // wait
      if ((micros() - tim0) > 300000){
        task++;
      }
      break;

    default:
      task = 0;
      break;
  }
}

void test1(void) {    // Switch Check
  switch (task) {
    case 0:   // LED ON
      //Serial.println(PIND, HEX);
      if ((~PIND & (sel_SW | stt_SW)) != 0x00) {
        Serial.println((PIND & (sel_SW | stt_SW)), BIN);  // (xxxx xx00)
        setLED(~PIND & (sel_SW | stt_SW));   // LED ON
      
        tim0 = micros();
        task++;
      }
      break;
    case 1: // wait & LED OFF
      if ((micros() - tim0) > 300000){
        setLED(0);    // LED OFF
        task++;
        }
      break;
      
    default:
      task = 0;
      break;
  }
}


void test0(void) {  
  blinkTest();  // LED16 to 1 ON/OFF
  chk_T0_SW();  // Select SW check
  
}


void chk_T0_SW(void) {  // Select SW check
  if (~PIND & sel_SW) {
    Serial.println("goto Test1");
    mode = 102;
  }
}

void blinkTest(void) {  // LED16 to 1 ON/OFF
  switch (task) {
    case 0:   // LED ON
      if (dLED == 0) {dLED = 0x8000;}
      setLED(dLED);   // LED ON
      dLED = dLED >> 1;
      
      tim0 = micros();
      task++;
      break;
    case 1: // wait & LED OFF
      if ((micros() - tim0) > 100000){
        setLED(0);    // LED OFF
        
        tim0 = micros();
        task++;
        }
      break;
    case 2: // wait
      if ((micros() - tim0) > 400000){
        task ++;
      }
      break;
      
    default:
      task = 0;
      break;
  }
  
}

void chkSelOFF(void) {  // Select SW OFF check
  if (PIND & sel_SW) {
    Serial.println("goto Test0");
    mode = 101;
  }
}

void setLED(unsigned int data) {
  unsigned int p,d;
  
  p = PORTC & 0xc0;           // (xx00 0000)
  d = ~(data >> 10);          // (00cc cccc) bb bbbb dddd
  PORTC = p | (d & 0x3F);     // (00cc cccc) 

  p = PORTB & 0xc0;           // (xx00 0000)
  d = ~(data  >> 4);          // (00bb bbbb) dddd
  PORTB = p | (d & 0x3F);     // (00bb bbbb)

  p = PORTD & 0x0f;           // (0000 xxxx)
  d = ~(data << 4);           // bbbb (dddd 0000)
  PORTD = p | (d & 0xf0) ;    // (dddd 0000)
}