//WIFI動くおもちゃソースプログラム
#include <xc.h>

#pragma config PLLDIV   = 5         // (20 MHz crystal on PICDEM FS USB board)
#pragma config CPUDIV   = OSC1_PLL2
#pragma config USBDIV   = 2         // Clock source from 96MHz PLL/2
#pragma config FOSC     = HSPLL_HS
#pragma config FCMEN    = OFF
#pragma config IESO     = OFF
#pragma config PWRT     = OFF
#pragma config BOR      = ON
#pragma config BORV     = 3
#pragma config VREGEN   = ON      //USB Voltage Regulator
#pragma config WDT      = OFF
#pragma config WDTPS    = 32768
#pragma config MCLRE    = ON
#pragma config LPT1OSC  = OFF
#pragma config PBADEN   = OFF
//#pragma config CCP2MX   = ON
#pragma config STVREN   = ON
#pragma config LVP      = OFF
//#pragma config ICPRT    = OFF       // Dedicated In-Circuit Debug/Programming
#pragma config XINST    = OFF       // Extended Instruction Set
#pragma config CP0      = OFF
#pragma config CP1      = OFF
//#pragma config CP2      = OFF
//#pragma config CP3      = OFF
#pragma config CPB      = OFF
//#pragma config CPD      = OFF
#pragma config WRT0     = OFF
#pragma config WRT1     = OFF
//#pragma config WRT2     = OFF
//#pragma config WRT3     = OFF
#pragma config WRTB     = OFF       // Boot Block Write Protection
#pragma config WRTC     = OFF
//#pragma config WRTD     = OFF
#pragma config EBTR0    = OFF
#pragma config EBTR1    = OFF
//#pragma config EBTR2    = OFF
//#pragma config EBTR3    = OFF
#pragma config EBTRB    = OFF

#define _XTAL_FREQ  48000000             //__delay_ms
#define	SW1         PORTEbits.RE0
#define	SW2         PORTEbits.RE1
#define	LED         PORTEbits.RE2





void init(void);
char UART_Init(const long int baudrate);
void UART_Write(char data);
char UART_TX_Empty();
void UART_Write_Text(char *text);
char UART_Data_Ready();
char UART_Read();
void UART_Read_Text(char *Output, unsigned int length);

void UARTreadTEXT_1();
void UARTreadTEXT_2();
void MyWait(int iT);
void MyWait_2(int iT);

void RUN1(void);
void RUN2(void);
void RUN3(void);
void RUN4(void);

//int n;
char UARTreadBuffer[256];//バッファ
char gN=0;//受信文字数
char gChar;//コマンド

void init(void)
{
    ADCON1  =	0b00001111;
    TRISA   =	0b00000000;
    TRISB   =	0b00000000;
    TRISC   =	0b00110000;         //D-,D+
    TRISD   =	0b00000000;
    TRISE   =   0b00000011;         //SW1,2=INPUT LED=OUTPUT
    LATA    =	0b00000000;
    LATB    =	0b00000000;
    LATC    =	0b00000000;
    LATD    =	0b00000000;
    LATE    =	0b00000000;

}

void main(void)
{
    init();//初期設定
    UART_Init(115200);//UART初期設定、ボーレイト設定
    //割り込み使用時は以下を有効にします。
    RCIF = 0; //reset RX pin flag
    RCIP = 1; //high priority
    RCIE = 1; //Enable RX interrupt
    PEIE = 1; //Enable pheripheral interrupt (serial port is a pheripheral)
    INTCONbits.GIE = 1;//Global Interrupt Enable bit

    int i;
    LED=0;
    //for ( int i = 0; i < 300; i++ ) __delay_ms( 10 ); //10mS
    while(SW1==1)
   {
        UARTreadTEXT_1();
    }

    UART_Write_Text("AT+CWMODE=1\r\n");
    MyWait(100);
    UARTreadTEXT_1();

    UART_Write_Text("AT+CIPSTART=\"TCP\",\"192.168.11.2\",13000\r\n");
    MyWait(200);
    UARTreadTEXT_1();
    UART_Write_Text("AT+CIPMODE=1\r\n");
   MyWait(200);
    UARTreadTEXT_1();
    UART_Write_Text("AT+CIPSEND\r\n");
   MyWait(200);
    UARTreadTEXT_1();

    UART_Write_Text(">OK\r\n");
    gN=0;
    __delay_ms(15);
    //UARTreadTEXT();
    UART_Write_Text(">OK\r\n");
    //UART_Write_Text(">OK\r\n");
    //UART_Write_Text(">OK\r\n");


    //gN=2;
    int i,j;
    PORTBbits.RB1=1;

    for (  i = 0; i < 10; i++ )
    {
        PORTDbits.RD0=1;
        PORTDbits.RD1=1;
        PORTDbits.RD2=1;
        PORTDbits.RD3=1;
        PORTDbits.RD4=1;
        PORTDbits.RD5=1;
        PORTDbits.RD6=1;
        PORTDbits.RD7=1;
        __delay_ms( 1 );
        __delay_us( 500 );
        PORTDbits.RD0=0;
        PORTDbits.RD1=0;
        PORTDbits.RD2=0;
        PORTDbits.RD3=0;
        PORTDbits.RD4=0;
        PORTDbits.RD5=0;
        PORTDbits.RD6=0;
        PORTDbits.RD7=0;
        for (  j = 0; j < 2; j++ )__delay_ms( 10 );
    }

    while(1)
    {
        LED=1;
         MyWait_2(200);
        UARTreadTEXT_2();

        switch (gChar)
        {
            case '1':
                UART_Write_Text("BT1=RUN\r\n");
                RUN1();
                break;
            case '2':
                UART_Write_Text("BT2=RUN\r\n");
                RUN2();
                break;
            case '3':
                UART_Write_Text("BT3=RUN\r\n");
                RUN3();
                break;
            case '4':
                UART_Write_Text("BT4=RUN\r\n");
                RUN4();
                break;
            default:
                break;
        }



    }//end while
}

void interrupt SYS_InterruptHigh(void)
{
    if(PIR1bits.RCIF == 1)
    {
        UARTreadBuffer[gN] = UART_Read();
        gN++;
        //PIR1bits.RCIF=0;
        //LED=1;
    }
}



char UART_Init(const long int baudrate)
{
  unsigned int x;
  BRGH = 1;                                     //Setting High Baud Rate
  x = (_XTAL_FREQ - baudrate*16)/(baudrate*16); //SPBRG for High Baud Rate
  if(x>255)                                       //If High Baud Rage Required
  {
    BRGH = 0;
    x = (_XTAL_FREQ - baudrate*64)/(baudrate*64);   //SPBRG for Low Baud Rate
  }
  if(x<256)
  {
    SPBRG = x;                                    //Writing SPBRG Register
    SYNC = 0;                                     //Setting Asynchronous Mode, ie UART
    SPEN = 1;                                     //Enables Serial Port
    TRISC7 = 1;                                   //As Prescribed in Datasheet
    TRISC6 = 1;                                   //As Prescribed in Datasheet
    CREN = 1;                                     //Enables Continuous Reception
    TXEN = 1;                                     //Enables Transmission
    return 1;                                     //Returns 1 to indicate Successful Completion
  }
  return 0;                                       //Returns 0 to indicate UART initialization failed
}

void UART_Write(char data)
{
  while(!TRMT);
  TXREG = data;
}

char UART_TX_Empty()
{
  return TRMT;
}

void UART_Write_Text(char *text)
{
  int i;
  for(i=0;text[i]!='\0';i++)
    UART_Write(text[i]);
}

char UART_Data_Ready()
{
  return RCIF;
}

char UART_Read()
{
  while(!RCIF);
  return RCREG;
}

void UART_Read_Text(char *Output, unsigned int length)
{
  unsigned int i;
  for(int i=0;i<length;i++)
  Output[i] = UART_Read();
}

void MyWait(int iT)
{
    int i,ii;
    for(ii=1;ii<iT;ii++)
    {
        __delay_ms(10);
        if(gN>=1)
        {
            for(i=1;i<gN;i++)
            {
                if(UARTreadBuffer[i-1]=='O' && UARTreadBuffer[i]=='K')
                {
                    __delay_ms(5);
                    return;
                }

            }
        }
    }
}

void MyWait_2(int iT)
{
    int i,ii;
    for(ii=1;ii<iT;ii++)
    {
        __delay_ms(10);
        if(gN>=1)
        {
            for(i=1;i<gN;i++)
            {
                if(UARTreadBuffer[i-1]=='B' && UARTreadBuffer[i]=='T')
                {
                    gChar=UARTreadBuffer[i+1];
                    __delay_ms(5);
                    return;
                }

            }
        }
    }
}




void UARTreadTEXT_1()
{
    int i;
    char Buffer[256];
    if(gN>=1)
    {
        char iN=gN;
        gN=0;
        for(i=0;i<iN;i++)
        {
            Buffer[i]=UARTreadBuffer[i];
        }
    }
    int test=0;
}
void UARTreadTEXT_2()
{
    int i;
    char Buffer[256];
    if(gN>=1)
    {
       char iN=gN;
       gN=0;
       for(i=0;i<iN;i++)
       {
           Buffer[i]=UARTreadBuffer[i];
       }
       Buffer[iN]=0x00;
       UART_Write_Text(Buffer);
    }
}

void RUN1(void)
{
    int i;

    for (  i = 0; i < 20; i++ )
    {
        PORTDbits.RD3=1;
        PORTDbits.RD4=1;
        PORTDbits.RD5=1;
        __delay_ms( 1 );
        PORTDbits.RD3=0;
        __delay_ms( 1 );
        PORTDbits.RD4=0;
        PORTDbits.RD5=0;
        __delay_ms( 10 );
    }
    for (  i = 0; i < 30; i++ ){__delay_ms( 10 );}

    for (  i = 0; i < 20; i++ )
    {
        PORTDbits.RD0=1;
        PORTDbits.RD1=1;
        PORTDbits.RD2=1;
        __delay_ms( 1 );
        PORTDbits.RD0=0;
        PORTDbits.RD2=0;
        __delay_ms( 1 );
        PORTDbits.RD1=0;
        __delay_ms( 10 );
    }

    for (  i = 0; i < 20; i++ )
    {
        PORTDbits.RD3=1;
        PORTDbits.RD4=1;
        PORTDbits.RD5=1;
        __delay_ms( 1 );
        PORTDbits.RD4=0;
        PORTDbits.RD5=0;
        __delay_ms( 1 );
        PORTDbits.RD3=0;
        __delay_ms( 10 );
    }
    for (  i = 0; i < 30; i++ ){__delay_ms( 10 );}

    for (  i = 0; i < 20; i++ )
    {
        PORTDbits.RD0=1;
        PORTDbits.RD1=1;
        PORTDbits.RD2=1;
        __delay_ms( 1 );
        PORTDbits.RD1=0;
        __delay_ms( 1 );
        PORTDbits.RD0=0;
        PORTDbits.RD2=0;
        __delay_ms( 10 );
    }
}

void RUN2(void)
{
    int i;

    for (  i = 0; i < 30; i++ )
    {
        PORTDbits.RD3=1;
        PORTDbits.RD4=1;
        PORTDbits.RD5=1;
        __delay_ms( 1 );
        PORTDbits.RD3=0;
        __delay_ms( 1 );
        PORTDbits.RD4=0;
        PORTDbits.RD5=0;
        __delay_ms( 10 );
    }
    for (  i = 0; i < 30; i++ ){__delay_ms( 10 );}

    for (  i = 0; i < 30; i++ )
    {
        PORTDbits.RD0=1;
        PORTDbits.RD1=1;
        PORTDbits.RD2=1;
        __delay_ms( 1 );
        PORTDbits.RD1=0;
        __delay_ms( 1 );
        PORTDbits.RD0=0;
        PORTDbits.RD2=0;
        __delay_ms( 10 );
    }


    for (  i = 0; i < 30; i++ )
    {
        PORTDbits.RD3=1;
        PORTDbits.RD4=1;
        PORTDbits.RD5=1;
        __delay_ms( 1 );
        PORTDbits.RD4=0;
        PORTDbits.RD5=0;
        __delay_ms( 1 );
        PORTDbits.RD3=0;
        __delay_ms( 10 );
    }
    for (  i = 0; i < 30; i++ ){__delay_ms( 10 );}

    for (  i = 0; i < 30; i++ )
    {
        PORTDbits.RD0=1;
        PORTDbits.RD1=1;
        PORTDbits.RD2=1;
        __delay_ms( 1 );
         PORTDbits.RD0=0;
        PORTDbits.RD2=0;
        __delay_ms( 1 );
        PORTDbits.RD1=0;
        __delay_ms( 10 );
    }
}
void RUN3(void)
{
    int i,j;

    for (  i = 0; i < 3; i++ )
    {
        PORTDbits.RD6=1;
        PORTDbits.RD7=1;
        __delay_ms( 1 );
        PORTDbits.RD6=0;
        __delay_ms( 1 );
        PORTDbits.RD7=0;
        for (  j = 0; j < 5; j++ )__delay_ms( 10 );
    }

    for (  i = 0; i < 5; i++ )
        {
             PORTDbits.RD6=1;
             PORTDbits.RD7=1;
            __delay_ms( 1 );
            __delay_us( 500 );
            PORTDbits.RD6=0;
            PORTDbits.RD7=0;
            for (  j = 0; j < 5; j++ )__delay_ms( 10 );
        }

    for (  i = 0; i < 3; i++ )
    {
        PORTDbits.RD6=1;
        PORTDbits.RD7=1;
        __delay_ms( 1 );
        PORTDbits.RD7=0;
        __delay_ms( 1 );
        PORTDbits.RD6=0;
        for (  j = 0; j < 5; j++ )__delay_ms( 10 );
    }

        for (  i = 0; i < 5; i++ )
        {
             PORTDbits.RD6=1;
             PORTDbits.RD7=1;
            __delay_ms( 1 );
            __delay_us( 500 );
            PORTDbits.RD6=0;
            PORTDbits.RD7=0;
            for (  j = 0; j < 5; j++ )__delay_ms( 10 );
        }
}

void RUN4(void)
{
        int i,j;

    for (  i = 0; i < 3; i++ )
    {
        PORTDbits.RD6=1;
        PORTDbits.RD7=1;
        __delay_ms( 1 );

        __delay_ms( 1 );
        PORTDbits.RD7=0;
        PORTDbits.RD6=0;
        for (  j = 0; j < 5; j++ )__delay_ms( 10 );
    }

    for (  i = 0; i < 5; i++ )
        {
             PORTDbits.RD6=1;
             PORTDbits.RD7=1;
            __delay_ms( 1 );
            __delay_us( 500 );
            PORTDbits.RD6=0;
            PORTDbits.RD7=0;
            for (  j = 0; j < 5; j++ )__delay_ms( 10 );
        }

    for (  i = 0; i < 3; i++ )
    {
        PORTDbits.RD6=1;
        PORTDbits.RD7=1;
        __delay_ms( 1 );
        PORTDbits.RD6=0;
        PORTDbits.RD7=0;
        __delay_ms( 1 );

        for (  j = 0; j < 5; j++ )__delay_ms( 10 );
    }

        for (  i = 0; i < 5; i++ )
        {
             PORTDbits.RD6=1;
             PORTDbits.RD7=1;
            __delay_ms( 1 );
            __delay_us( 500 );
            PORTDbits.RD6=0;
            PORTDbits.RD7=0;
            for (  j = 0; j < 5; j++ )__delay_ms( 10 );
        }
}