#include <stdio.h>
#include <stdlib.h>
#include <sys/time.h>   //      gettimeofday
#include <sys/stat.h>
#include <string.h>
#include <unistd.h>
#include <sys/types.h>
#include <fcntl.h>
#include <sys/mman.h>
#include <sys/ioctl.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <netdb.h>
#include <errno.h>

#include "serial.h"
#include "uartinf.h"
#include "confile.h"
#include "udp_util.h"

char _rx_data[1024];

struct  lc6600_param{
	int password;
	int  freq;
	int  power;
	int  bw;
	int  ap_sta;
	int  ip;
	int setup;
};

char index1[10];
char freq1[10];
char freq2[10];
char dbm1[5];
char dbm2[5];



int  setup_lc6600(struct  lc6600_param *pparam){
	int n_read;
	char *read_ok;
	char str[30];

	uart_write(ROUTE_UART, "AT+CFUN=0\r");
	n_read = uart_read(ROUTE_UART, _rx_data);
	read_ok = strstr(_rx_data,"OK");	
	if(read_ok == NULL){
		printf("can not exce AT+CFUN=0");
	}
	sleep(1);
	//password
	sprintf(str,"AT^DAPI=%d\r",pparam->password);
	uart_write(ROUTE_UART, str);
	printf("%s\n",str);
	n_read = uart_read(ROUTE_UART, _rx_data);
	read_ok = strstr(_rx_data,"OK");
	if(read_ok == NULL){
		printf("can not exce AT^DAPI");
	}
	sleep(1);
	// 1 center  2 station
	sprintf(str,"AT^DDTC=%d\r",pparam->ap_sta);
        uart_write(ROUTE_UART, str);
	printf("%s\n",str);
        n_read = uart_read(ROUTE_UART, _rx_data);
        read_ok = strstr(_rx_data,"OK");
        if(read_ok == NULL){
                printf("can not exce AT^DDTC");
        }
	sleep(1);

//	sprintf(str,"AT^DDTC=%d\r",pparam->ap_sta);
        uart_write(ROUTE_UART, "AT^DSTC=2\r");
        printf("AT^DSTC\n");
        n_read = uart_read(ROUTE_UART, _rx_data);
        read_ok = strstr(_rx_data,"OK");
        if(read_ok == NULL){
                printf("can not exce AT^DDSTC");
        }
        sleep(1);


	// 2 5M 3 10M 4 15M 5 20M  "25" dbm
	sprintf(str,"AT^DRPS=,%d,\"%d\"\r",pparam->bw,pparam->power);
        uart_write(ROUTE_UART, str);
	printf("%s\n",str);
        n_read = uart_read(ROUTE_UART, _rx_data);
        read_ok = strstr(_rx_data,"OK");
        if(read_ok == NULL){
                printf("can not exce AT^DRPS\n");
        }
	sleep(1);
	// 01 800M 04 1.4G  08 2.4G
	sprintf(str,"AT^DAOCNDI=0%d\r",pparam->freq);
        uart_write(ROUTE_UART, str);
	printf("%s\n",str);
        n_read = uart_read(ROUTE_UART, _rx_data);
        read_ok = strstr(_rx_data,"OK");
        if(read_ok == NULL){
                printf("can not exce AT^DAOCNDI\n");
        }

	sleep(1);


	 sprintf(str,"AT^NETIFCFG=2,\"192.168.2.%d\"\r",pparam->ip);
        uart_write(ROUTE_UART, str);
	printf("%s\n",str);
        n_read = uart_read(ROUTE_UART, _rx_data);
        read_ok = strstr(_rx_data,"OK");
        if(read_ok == NULL){
                printf("can not exce AT^DAOCNDI\n");
        }

	sleep(1);

	uart_write(ROUTE_UART, "AT+CFUN=1\r");
        n_read = uart_read(ROUTE_UART, _rx_data);
        read_ok = strstr(_rx_data,"OK");
        if(read_ok == NULL){
                printf("can not exce AT+CFUN=1");
        }

	

}
#if 1

int get_rx1_freq(char *rx1){
	
	char *s1;
	char *s2;
	char *s3;
	char *s4;
	int len;
	int i;

	s1=strchr(rx1,',');
	s2=strchr(s1+1,',');
	s3=strchr(s2+1,',');
	s4=strchr(s3+1,',');

	len= s2-s1-1;

	for(i=0;i<len;i++){
		freq1[i] = *(s1+1+i);
	}
	printf("freq %s\n",freq1);

	len=s4-s3-1-2; //"-44"

	for(i=0;i<len;i++){
		dbm1[i]=*(s3+2+i);
	}
	 printf("dbm1 %s\n",dbm1);

	return 0;	


}

int get_rx1_dbm(char *rx1){

        char *s1;
        char *s2;
        char *s3;
        char *s4;
        int len;
        int i;

        s1=strchr(rx1,',');
        s2=strchr(s1+1,',');
        s3=strchr(s2+1,',');
        s4=strchr(s3+1,',');

        len= s2-s1-1;

        for(i=0;i<len;i++){
                index1[i] = *(s1+1+i);
        }
        printf("index %s \n",index1);

        len=s3-s2-1-2; //"-44"
	if(strcmp(index1, "1") == 0){
	        for(i=0;i<len;i++){
        	        dbm1[i]=*(s2+2+i);
        	}
         	printf("dbm1 %s\n",dbm1);
	}else if(strcmp(index1, "2") == 0){
		for(i=0;i<len;i++){
			dbm2[i]=*(s2+2+i);
		}
	 	printf("dbm2 %s\n",dbm2);
	}
        return 0;


}

int get_rx2_dbm(char *rx1){

        char *s1;
        char *s2;
        char *s3;
        char *s4;
        char *s0;
        int len;
        int i;

	s0=strchr(rx1,':');
        s1=strchr(rx1,',');
        s2=strchr(s1+1,',');
        s3=strchr(s2+1,',');
        s4=strchr(s3+1,',');
     //printf("-%s \n",s1);  
	len =s1-s0-2;
        for(i=0;i<len;i++){
       
		index1[i]=*(s0+i+2);
       	}
	//printf("index %s \n",index1);
	
	len= s2-s1-1;

        for(i=0;i<len;i++){
                freq1[i] = *(s1+1+i);
        }
      //  printf("freq %s\n",freq1);

        len=s4-s3-2-1; //"-44"
	
	if(strcmp(index1, "1") == 0){
	        for(i=0;i<len;i++){
        	        dbm1[i]=*(s3+2+i);
        	}
         	printf("dbm1 %s\n",dbm1);
	}else if(strcmp(index1, "2") == 0){
		for(i=0;i<len;i++){
			dbm2[i]=*(s3+2+i);
		}
	 	printf("dbm2 %s\n",dbm2);
	}
	//printf("len %d \n",len);
        //for(i=0;i<len;i++){
        //        dbm2[i]=*(s3+i+2);
        //}
        // printf("dbm2 %s\n",dbm2);

        return 0;


}



int get_rx2_freq(char *rx2){

        char *s1;
        char *s2;
        char *s3;
        char *s4;
        int len;
        int i;

        s1=strchr(rx2,',');
        s2=strchr(s1+1,',');
        s3=strchr(s2+1,',');
        s4=strchr(s3+1,',');

        len= s2-s1-1;

        for(i=0;i<len;i++){
                freq2[i] = *(s1+1+i);
        }
        printf("freq %s\n",freq2);

        len=s4-s3-1-2; //"-44"

        for(i=0;i<len;i++){
                dbm2[i]=*(s3+2+i);
        }
         printf("dbm1 %s\n",dbm1);

        return 0;


}


#endif



int main (int argc, char *argv[])
{
    	int n_read;
    	int i;
    	struct  lc6600_param lc6600;

    	char buffer[1024];
    	char ip[13];
   
   	char *rx1;
    	char *rx2;    
	int rssi1;
	int rssi2;
	//int dbm1;
	//int dbm2;
	char *ip_str;
       
       	char *buffer_freq;
	char freq_str[6];
	int freq;
  	int fq;

	int fd_param;
	int *buffer_param;
  	
	int len;
    	n_read = uart_init(ROUTE_UART, "/dev/ttyAMA2", 115200, 'N');
    	if(n_read <=0 ) {
		printf("open /dev/ttyAMA2 failed\n");
		return -1;
    	}

	lc6600.ap_sta = atoi(argv[1]);


	fd_param = shm_open("/param.txt",O_RDWR|O_CREAT|O_EXCL,0777);
        if(fd_param < 0){
               fd_param = shm_open("/param.txt",O_RDWR,0777);
        }else
                ftruncate(fd_param,4096);
        buffer_param= mmap(NULL,4096,PROT_READ|PROT_WRITE,MAP_SHARED,fd_param,0);

#if 0
	uart_write(ROUTE_UART, "AT^DRPS?\r");
	n_read = uart_read(ROUTE_UART, _rx_data);
    	printf("%s\n",_rx_data);

	buffer_freq=strstr(_rx_data,"^DRPS:");
	strncpy(freq_str,buffer_freq+6,6);

	printf("drps : %s\n",freq_str);
	freq = atoi(freq_str);
	//printf("freq: %d\n",freq);

	buffer_param[3] = freq;
	
#endif
	
//	freq=atoi(argv[3]);
//	printf("freq %d \n",freq);
//	buffer_param[3]=freq;
//	buffer_param[0] = 0x55;
	//buffer_param[3] = 14300;
	if(lc6600.ap_sta == 1){
                uart_write(ROUTE_UART, "AT^DAPR=1\r");
               // n_read = uart_read(ROUTE_UART, _rx_data);
              //  printf("%s\n",_rx_data);

                while(1){

                        n_read = uart_read(ROUTE_UART, _rx_data);
               
			printf("%s\n",_rx_data);
			if(n_read > 50){

				if((strncmp(_rx_data+5,"PRI:",4)==0)||(strncmp(_rx_data+4,"PRI:",4)==0)||(strncmp(_rx_data+3,"PRI:",4)==0)||(strncmp(_rx_data+2,"PRI:",4)==0)||(strncmp(_rx_data+1,"PRI:",4)==0)||(strncmp(_rx_data+6,"PRI:",4)==0)){
                                	strncpy(buffer,_rx_data,n_read);
                                	//len=n_read;
                        	//}else {
			  //else if(len >=54 && len <178 ){
                                //	strncpy(buffer+len,_rx_data,n_read);
                                //	len+=n_read;
                        	//}
                        	//if(len > 100){

                                	rx1=strstr(buffer,"PRI:");//^DAPRI
					if(rx1){
						//printf("rx1 %s\n",rx1);
						get_rx1_dbm(rx1);
					}else{
						printf("rx1 null \n");
					}
					rssi1= atoi(dbm1);
					rssi2= atoi(dbm2);
					buffer_param[1] = rssi1;
					buffer_param[2] = rssi2;
                                	//len =0;
				}
				else {
					printf("no DAPRI \n");
				}
                   	}
			else {
				printf("n_read<50 \n");
			}
	
		}
        }else if(lc6600.ap_sta == 2){
                uart_write(ROUTE_UART, "AT^DRPR=1\r");
                while(1){

                        n_read = uart_read(ROUTE_UART, _rx_data);

                        printf("%s\n",_rx_data);
                        if(n_read > 30){

                                if(strncmp(_rx_data+2,"^DRPRI:",7)==0){
                                        strncpy(buffer,_rx_data,n_read);
                                        
					rx2=strstr(buffer,"^DRPRI:");//^DAPRI
                                        if(rx2){
                                                //printf("rx1 %s\n",rx1);
                                                get_rx2_dbm(rx2);
                                        }else {
						printf("no3\n");
					}
                                        rssi1= atoi(dbm1);
                                        rssi2= atoi(dbm2);
                                        buffer_param[1] = rssi1;
                                        buffer_param[2] = rssi2;
                                }else {
					printf("no2\n");
				}
                        }else{
				printf("no1\n");
			}

                }
        }
	
}