#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"

char _rx_data[1024];
unsigned char jingdu[] = {0x01, 0x03, 0x00, 0xcf, 0x00, 0x03,0x35,0xf4};
unsigned char weidu[] = {0x01, 0x03, 0x00, 0xd2, 0x00, 0x03,0xa5,0xf2};

int *switch_memory_open(void) {
        char buf[128];
        int fd;
        sprintf(buf, "/video_mode");
        fd = shm_open(buf, O_CREAT | O_RDWR, S_IRUSR | S_IWUSR);
        if(fd < 0) { perror("shm_open"); exit(1); }
        if (ftruncate(fd, 4096) == -1) { perror("ftruncate"); exit(1); }
        int *retval = mmap(NULL, 4096, PROT_READ | PROT_WRITE, MAP_SHARED, fd, 0);
        return retval;
}

void send_specified_bytes(UART_INTF uart_type,unsigned char *data) {
    // 定义要发送的字节数组：0x01 0x03 0x00 0xcf 0x00 0x03
    //unsigned char data[] = {0x01, 0x03, 0x00, 0xcf, 0x00, 0x03};
    // 计算数组长度（共6个字节）
    //int len = sizeof(data) / sizeof(data[0]);
    
    // 使用uart_write_len发送指定长度的字节序列
    int ret = uart_write_len(uart_type, (char*)data, 8);
    if (ret > 0) {
       // printf("成功发送 %d 字节\n", ret);
    } else {
        printf("发送失败，返回值: %d\n", ret);
    }
}
// 提取并解析经度（正值=东经，负值=西经）
void parse_longitude(unsigned char *data) {
    // 提取方向标识（第4-5位：0x00 0x45/0x00 0x57）
    uint16_t dir_flag = (uint16_t)data[3] << 8 | data[4];
    
    // 提取经度数值字节（第6-9位：0x0 0xae 0x1 0x0），拼接为0x00AE0100
    uint32_t lon_val = (uint32_t)data[5] << 24 | 
                       (uint32_t)data[6] << 16 | 
                       (uint32_t)data[7] << 8 | 
                       (uint32_t)data[8];

    // 计算基础经度值（小数点左移5位）
    double longitude = (double)lon_val / 100000.0;

    // 根据方向设置正负（东经=正，西经=负）
    if (dir_flag == 0x0057) {
        longitude = -longitude; // 西经取负
    }else if(dir_flag == 0x0053){
    	longitude = -longitude;
    } 
    else if ((dir_flag != 0x0045)||(dir_flag != 0x004E)) {
        printf("警告：未知方向标识 0x%04X\n", dir_flag);
    }

    // 打印结果（含方向说明和数值）
    printf("原始经度值：0x%08X（十进制：%u）\n", lon_val, lon_val);
    //printf("方向标识：0x%04X -> %s\n", dir_flag, 
    //       dir_flag == 0x0045 ? "东经" : (dir_flag == 0x0057 ? "西经" : "未知"));
    printf("实际经度：%.5f°\n", longitude);
}
int main (int argc, char *argv[])
{
    	int n_read;
    	int i;

    	int *buffer;
  	
    	int *switch_mode;
	switch_mode= switch_memory_open();
	
	n_read = uart_init(ROUTE_UART, "/dev/ttyAMA4", 9600, 'N');
    	if(n_read <=0 ) {
		printf("open /dev/ttyAMA4 failed\n");
		return -1;
    	}
	while(1){
	//	send_specified_bytes(ROUTE_UART,jingdu);
		n_read = uart_read(ROUTE_UART, _rx_data);

		if(n_read >0){
			//printf("%s\n",_rx_data);
			printf("jingdu 0x%02x 0x%2x 0x%2x 0x%2x 0x%2x 0x%2x 0x%2x 0x%2x \n",_rx_data[0],_rx_data[1],_rx_data[3],_rx_data[4],_rx_data[5],_rx_data[6],_rx_data[7],_rx_data[8]);
	//	parse_longitude(_rx_data);	
		}
	//	usleep(100000);
	//	send_specified_bytes(ROUTE_UART,weidu);
	//	n_read = uart_read(ROUTE_UART, _rx_data);
	//	if(n_read >0){
			//printf("%s\n",_rx_data);
			//printf("weidu 0x%2x 0x%2x 0x%2x 0x%2x 0x%2x 0x%2x 0x%2x 0x%2x \n",_rx_data[0],_rx_data[1],_rx_data[3],_rx_data[4],_rx_data[5],_rx_data[6],_rx_data[7],_rx_data[8]);
	//	parse_longitude(_rx_data);
	
	//	}
		usleep(2000000);
	}
}	

# if 0

	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);


			while(1){

                        	n_read = uart_get(ROUTE_UART, _rx_data);

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

					if(!strncmp("VGA",_rx_data,3)){
						printf("%s\n",_rx_data);
					//	sscanf(_rx_data,"VGA:%d RSSI:%f RSSI1:%f RSSI2:%f",&num,&rssi,&rssi1,&rssi2);
					

					buffer_rssi = strstr(_rx_data,"RSSI:");
					buffer_rssi1 = strstr(_rx_data,"RSSI1:");
					buffer_rssi2 = strstr(_rx_data,"RSSI2:");
					
					if( buffer_rssi &&  buffer_rssi1 &&  buffer_rssi2){
					
					strncpy(bit,buffer_rssi+5,6);
					rssi = atof(bit);
					strncpy(bit,buffer_rssi1+6,6);
					rssi1 = atof(bit);

					strncpy(bit,buffer_rssi2+6,6);
					rssi2 = atof(bit);

					buffer_param[0] = rssi;
                                        buffer_param[1] = rssi1;
                                        buffer_param[2] = rssi2;
					buffer_param[4] = 1434000;
					buffer_param[6] = 0;
					}

					printf("+++++%f %f %f %d\n", rssi,rssi1,rssi2,1434000);

					}else{

					buffer=strstr(_rx_data,"%)");
					buffer_rssi = strstr(_rx_data,"RSSI:");	
					buffer_rssi1 = strstr(_rx_data,"RSSI1:");	
					buffer_rssi2 = strstr(_rx_data,"RSSI2:");	
					if(buffer_rssi && buffer && n_read >30){
					printf("%s\n",buffer);
					//sscanf(_rx_data,"%d(%d) :VGA:%d RSSI:%f RSSI1:%f RSSI2:%f(air:vga:%d RSSI1: %d RSSI2: %d err:%d\%)%dkbps",&num,&num1,&vga,&rssi,&rssi1,&rssi2,&vga1,&air_rssi1,&air_rssi2,&err,&bitrate);

					strncpy(bit,buffer+2,4);
					bitrate=atoi(bit);

					strncpy(bit,buffer_rssi+5,4);
					rssi = atof(bit);
					strncpy(bit,buffer_rssi1+6,4);
                                        rssi1 = atof(bit);

					strncpy(bit,buffer_rssi2+6,4);
                                        rssi2 = atof(bit);

										
					
					printf("%f %f %f %d %d %d %d %d %d\n",rssi,rssi1,rssi2,snr,freq,vga1,air_rssi1,air_rssi2,bitrate);
					buffer_param[0] = rssi;
					buffer_param[1] = rssi1;
					buffer_param[2]	= rssi2;
					buffer_param[3] = 30;
					buffer_param[4] = 1434000;
					buffer_param[5] = bitrate;
					buffer_param[6] = 1;
					}
				}

				}
			}




#endif