#include<iostream>
#include<unistd.h>		//for usleep
#include<string.h>
#include"GPIO.h"


#define CON1		23	
#define CON2		112	
#define CON3		67	
#define DATA1		32	
#define DATA2		14	

#define ms_delay_1     50000
#define ms_delay_2      50000

using namespace exploringBB;
using namespace std;
GPIO outGPIO_CON2 (CON2), outGPIO_CON3 (CON3), outGPIO_DATA1 (DATA1);
GPIO inGPIO_DATA2 (DATA2), outGPIO_CON1 (CON1);
main (int argc, char *argv[])
{



  cout << "TX--->COMMAND(2)" << endl;
  outGPIO_CON1.setDirection (OUTPUT);
  outGPIO_CON1.setValue (LOW);
  //usleep (ms_delay_1);



  cout << "TX--->COMMAND(3)" << endl;
  outGPIO_CON1.setValue (HIGH);
  usleep (ms_delay_2);


  cout <<
    "TX--->WRITE_DATA(2130)-"
    << endl;
  outGPIO_CON2.setDirection (OUTPUT);	//112
//  outGPIO_CON1.setDirection (OUTPUT); //23
  outGPIO_DATA1.setDirection (OUTPUT);	//32
  outGPIO_CON3.setDirection (OUTPUT);	//67
  inGPIO_DATA2.setDirection (INPUT);	//14

  //write 2(0010)
  cout << "TX--->WRITE_DATA(2130)----------->TX 2" << endl;

  outGPIO_CON2.setValue (LOW);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);


  outGPIO_CON2.setValue (LOW);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);

  outGPIO_CON2.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);

  outGPIO_CON2.setValue (LOW);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);


  //write 1(0001)
  cout << "TX--->WRITE_DATA(2130)----------->TX 1" << endl;
  outGPIO_CON2.setValue (LOW);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);



  outGPIO_CON2.setValue (LOW);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);

  outGPIO_CON2.setValue (LOW);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);

  outGPIO_CON2.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);


  outGPIO_DATA1.setValue (HIGH);
  usleep (ms_delay_1);


  //write 3(0011)
  cout << "TX--->WRITE_DATA(2130)----------->TX 3" << endl;
  outGPIO_CON2.setValue (LOW);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);



  outGPIO_CON2.setValue (LOW);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);

  outGPIO_CON2.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);

  outGPIO_CON2.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);


  //write 0(0000)
  cout << "TX--->WRITE_DATA(2130)----------->TX 0" << endl;
  outGPIO_CON2.setValue (LOW);
  usleep(ms_delay_2);
  outGPIO_CON3.setValue (HIGH);
  usleep (ms_delay_2);
  outGPIO_CON3.setValue (LOW);
  usleep (ms_delay_1);

 
  cout << "End ...." << endl;
  while (1);

}