#include <string.h>
#include <stdlib.h>
#include <unistd.h>
#include <termio.h>
#include <stdio.h>
#include <sys/ioctl.h>
#include <sys/time.h>
#include <ctype.h>
#include <errno.h>
#include <fcntl.h>
//#include <cutils/properties.h>
#include <sys/utsname.h>
//#include <cutils/list.h>
//#include <cutils/log.h>
//#include <cutils/sockets.h>
#include <sys/reboot.h>
//#include <cutils/iosched_policy.h>

#undef LOG_TAG
#define LOG_TAG "LcdParamService"

typedef     unsigned short    uint16;
typedef     unsigned long     uint32;
typedef     unsigned char     uint8;


#define LCD_PARAMETE_FILE_UPATH         "find /media/demo/usb0 -name nodka_lcd"
#define LCD_PARAMETE_FILE_SDPATH         "find /nodka_test -name nodka_lcd"
//#define OEM_PARTITIOM_NODE_PATH         "/dev/block/by-name/lcdparam"
//#define BASEPARAMETER_PATH              "dev/block/platform/fe330000.sdhci/by-name/baseparameter"
#define BASEPARAMETER_PATH  			"/dev/block/by-name/baseparameter"
/*#define OEM_PARTITIOM_NODE_PATH         "data/oem"*/

/*#define RKNAND_GET_VENDOR_SECTOR0       _IOW('v', 16, unsigned int)*/
/*#define RKNAND_STORE_VENDOR_SECTOR0     _IOW('v', 17, unsigned int)*/


#define RKNAND_SYS_STORGAE_DATA_LEN 512  //oem size
/*#define VENDOR_SECTOR_OP_TAG        0x444E4556 // "VEND"*/

#define POLY    0xEDB88320L              //CRC stand
#define CONFIG_NUM  27
#define BASE_OFFSET 256 * 1024

char *key[CONFIG_NUM] =
{
	"panel-type",

	"unprepare-delay-ms",
	"enable-delay-ms",
	"disable-delay-ms",
	"prepare-delay-ms",
	"reset-delay-ms",
	"init-delay-ms",
	"width-mm",
	"height-mm",

	"clock-frequency",
	"hactive",
	"hfront-porch",     
	"hsync-len",
	"hback-porch",
	"vactive",
	"vfront-porch",
	"vsync-len",
	"vback-porch",
	"hsync-active",
	"vsync-active",
	"de-active",
	"pixelclk-active",

	"dsi,flags", 
	"dsi,format",
	"dsi,lanes",
	"panel-init-sequence",
	
	"nodka_lvds"
};

typedef struct tagRKNAND_SYS_STORGAE
{
    /*unsigned long tag;*/
    /*unsigned long len;*/
    unsigned char data[RKNAND_SYS_STORGAE_DATA_LEN];
}RKNAND_SYS_STORGAE;


static uint32 crc32_tab[256];
static uint32 nand_crc = 0;

char *strreplace(char *s, char old, char new)
{
	for (; *s; ++s)
		if (*s == old)
			*s = new;
	return s;
}

void rknand_print_hex_data(uint8 *s,uint32 * buf,uint32 len)
{
    uint32 i;
    printf("%s\n",s);
    for(i=0;i<len;i+=4)
    {
        printf("%lx %lx %lx %lx\n",buf[i],buf[i+1],buf[i+2],buf[i+3]);
    }
}


void init_crc32_tab(void)
{
    int i = 0;
    int j = 0;
    uint32 crc = 0;

    for(i = 0; i < 256; i++)
    {
        crc = (uint32)i;
        for(j = 0; j < 8; j++)
        {
            if(crc & 0x00000001L)
                crc = (crc >> 1) ^ POLY;
            else
                crc = crc >> 1;
        }
        crc32_tab[i] = crc;
    }

}

uint32 get_crc32(uint32 crc_init, uint8 *crc_buf, uint32 buf_size)
{
    uint32 crc = crc_init ^ 0xffffffff;

    init_crc32_tab();
    while(buf_size--)
        crc = (crc >> 8) ^ crc32_tab[(crc & 0xff) ^ *crc_buf++];
    return crc ^ 0xfffffff;
}

uint32 getfile_crc(FILE *fp)
{
    uint32 size = 4 *1024;
    uint8 crc_buf[size];
    uint32 readln = 0;
    uint crc = 0;

    while((readln = fread(crc_buf, sizeof(uint8), size, fp)) > 0)
        crc = get_crc32(crc, crc_buf, readln);

    return crc;

}

/*
 *去除字符串左端空格
 */
char *strtriml(char *pstr)
{
    int i = 0,j;
    j = strlen(pstr) - 1;
    while (isspace(pstr[i]) && (i <= j))
        i++;
    if (0<i)
        strcpy(pstr, &pstr[i]);
    return pstr;
}

/*
 *去除字符串右端空格
 */
char *strtrimr(char *pstr)
{
    int i;
    i = strlen(pstr) - 1;
    while (isspace(pstr[i]) && (i >= 0))
        pstr[i--] = '\0';
    return pstr;
}

/*
 *去除字符串两端空格
 */
char *strtrim(char *pstr)
{
    char *p;
    p = strtrimr(pstr);
    return strtriml(p);
}


char *strdelchr(char *pstr, int chr)
{
    int i = 0;
    int l = 0;
    int ll = 0;
   ll = l = strlen(pstr);

    while(i < l)
    {
        if(pstr[i] == chr)
        {
            memmove((pstr + i), (pstr + i + 1), (ll - i -1));
            pstr[ll - 1] = '\0';
            ll--;
        }
        i++;
    }
    /*     for(i = 0; i < l; i++) */
    /* { */
    /* if(pstr[i] == chr) */
    /* { */
    /* memmove((pstr + i), (pstr + i + 1), (l - i -1)); */
    /* pstr[l - 1] = '\0'; */
    /* break; */
    /* } */
    /* } */
    return pstr;
}


void strrmspace(char * str)
{
    char *p1, *p2;
    char ch;
    p1 = str; //first pointer
    p2 = str;  // second pointer to the remaining string
    if (p1==NULL) return;
    while (*p1)
    {
        if (*p1 != ' ')
        {
            ch = *p1;
            *p2 = ch;
            p1++;
            p2++;
        }
        else
        {
            p1++;
        }
    }
    *p2 = '\0';
}
uint32  getfile_crc_from_nand(void)
{
    int ret = 0;
    uint32 crc = 0;

    RKNAND_SYS_STORGAE sysData;

    int sys_fd;

    if (0 != access(BASEPARAMETER_PATH, R_OK | W_OK)){
	    printf("access fail!!!\n");
	    return -1;
    }

    memset(sysData.data, '\0', sizeof(sysData.data));
    /*sysData.tag = VENDOR_SECTOR_OP_TAG;*/
    /*sysData.len = RKNAND_SYS_STORGAE_DATA_LEN-8;*/
    /*sys_fd = fopen(OEM_PARTITIOM_NODE_PATH, "r");*/
    /*[>sys_fd = open("/dev/rknand_sys_storage",O_RDWR,0);<]*/
    /*if(sys_fd == NULL)*/
    /*{*/
	    /*printf("fopen err %s err=%d\n",OEM_PARTITIOM_NODE_PATH, sys_fd);*/
	    /*return -1;*/
    /*}*/

    sys_fd = open(BASEPARAMETER_PATH, O_RDONLY);

    if (sys_fd < 0)
    {
	    printf("fopen err %s sys_fd=,%d\n",BASEPARAMETER_PATH, sys_fd);
	    return -1;
    }
	  lseek(sys_fd, BASE_OFFSET, SEEK_SET);
    ret = read (sys_fd, (void*)&sysData, sizeof(sysData));
    if (ret < 0)
    {
	    printf("read err %s sys_fd=,%d\n",BASEPARAMETER_PATH, sys_fd );
	    return -1;
    }
	
    /*ret = ioctl(sys_fd, RKNAND_GET_VENDOR_SECTOR0, &sysData);*/
    /*fread((void*)&sysData,sizeof(sysData),1,sys_fd);*/
    /* rknand_print_hex_data("getfile_crc_from_nand data:",(uint32*)sysData.data,32); */
    /* crc = sysData.data[24 * 4]; */
    /* crc = (crc << 8) + sysData.data[24 * 4 + 1]; */
    /* crc = (crc << 8) + sysData.data[24 * 4 + 2]; */
    /* crc = (crc << 8) + sysData.data[24 * 4 + 3]; */
    /* printf("-luoxt- crc data = 0x%02x%02x%02x%02x", sysData.data[24 * 4], */
    /* sysData.data[24 * 4 + 1], */
    /* sysData.data[24 * 4 + 2], */
    /* sysData.data[24 * 4 + 3]); */

    for(int i = 0; i < CONFIG_NUM+1; i++){
    crc = sysData.data[i * 4];
    crc = (crc << 8) + sysData.data[i * 4 + 1];
    crc = (crc << 8) + sysData.data[i * 4 + 2];
    crc = (crc << 8) + sysData.data[i * 4 + 3];
    printf("-luoxt- %d nand crc data = 0X%02X%02X%02X%02X\n", i, sysData.data[i * 4],
            sysData.data[i * 4 + 1],
            sysData.data[i * 4 + 2],
            sysData.data[i * 4 + 3]);
    }


    crc = sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-4];
    crc = (crc << 8) + sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-3];
    crc = (crc << 8) + sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-2];
    crc = (crc << 8) + sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-1];
    printf("-luoxt- nand crc data = 0X%02X%02X%02X%02X\n", sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-4],
            sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-3],
            sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-2],
            sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-1]);
    close(sys_fd);

    return crc;
}

int rk_update_lcd_parameters_from_sdcard(void)
{

    int ret = 0;
    FILE *fp = 0;
    char line[1024] = {0};
    int i = 0;
    RKNAND_SYS_STORGAE sysData;
    int sys_fd = 0;
    static uint32 file_crc = 0; //file lcdparameter  crc data
    static int updated = 0;  // had store the param into the nand
    static char got_crc = 0; //get file crc flag
    char   lcdparameter_buf[128];
    FILE   *stream;

    memset( lcdparameter_buf, '\0', sizeof(lcdparameter_buf) );
    memset(sysData.data, '\0', sizeof(sysData.data));
	if((access(LCD_PARAMETE_FILE_UPATH,F_OK))!=-1) 
	{
		printf("update form udisk\n");
		stream = popen(LCD_PARAMETE_FILE_UPATH, "r");
	}
	else
	{
		printf("update form emmc\n");
		stream = popen(LCD_PARAMETE_FILE_SDPATH, "r");
	}
    fread( lcdparameter_buf, sizeof(char), sizeof(lcdparameter_buf), stream);
    strreplace(lcdparameter_buf,'\n','\0');
    pclose(stream);	    
	 
	/* 
    while(access(lcdparameter_buf, 0))
    {
        if(updated)
            updated = 0;
        if(got_crc)
            got_crc = 0;
        return -1;
    }
	*/
	
    if(!updated)
    {
        if (!got_crc)
        {
            fp = fopen(lcdparameter_buf, "r");
			//fp = fopen("/root/rk_lcd_parameters", "rb");
    		printf("---XYP_DEBUG--- ======== %s %d ========\n", __func__, __LINE__);
            if(fp == NULL)
            {
                printf("open %s failed\n", lcdparameter_buf);
                return -1;
            }
            else
            {
                printf("success  open  file %s \n", lcdparameter_buf);
            }

            file_crc = getfile_crc(fp);
            got_crc = 1;
            printf(" file crc is 0X%08lX nand_crc is 0X%08lX \n", file_crc, nand_crc );
	        fclose(fp);
        }

	/*sysData.tag = VENDOR_SECTOR_OP_TAG;*/
	/*sysData.len = RKNAND_SYS_STORGAE_DATA_LEN - 8;*/

		if((nand_crc != file_crc))
        {
            fp = fopen(lcdparameter_buf, "r");
            if(fp == NULL)
            {
                printf("open %s failed\n", lcdparameter_buf);
                return -1;
            }
            else
            {
                printf("success  open  file %s\n", lcdparameter_buf);
            }

	    
            while(fgets(line, 1023, fp))
            {
                char *p = strtrim(line);
                int len = strlen(p);
                if(len <= 0)
                {
                    continue;
                }
                else if(p[0]=='#')
                {
                    continue;
                }
                else if( (!(strstr(p, "="))) && (!(strstr(p, ";"))) && (!(strstr(p, "screen_"))))
                {
                    continue;
                }
                else
                {
                    // get key and value string like "screen_lvds_format = 1" spilt by ";"
                    char *key_val_str = strtok(p, ";");
                    char *value = strchr(key_val_str, '=');
		    char cmd[4] = {'\0'};
                    if(value == NULL)
                        continue;
                    for(i = 0; i < CONFIG_NUM; i++)
                    {
                        if(strstr(p, key[i]))
                        {
				char *val = strdelchr(value, '=');
				strrmspace(val);
				uint32 config1 = atoi(val);

				if (strstr(p, "panel-init-sequence"))
				{
					int count=0;
				        int cmdlen=strlen(val)/2;

					sysData.data[i * 4] =(uint8) (cmdlen >> 24);
					sysData.data[i * 4 + 1] =(uint8) (cmdlen >> 16);
					sysData.data[i * 4 + 2] =(uint8) (cmdlen >> 8);
					sysData.data[i * 4 + 3] =(uint8) (cmdlen >> 0);
					printf("-luoxt- %s=%lu val %s\n", key[i], config1, val);
					i ++;
					while(1)
					{
						cmd [0] = '0';
						cmd [1] = 'x';
						cmd [2] = *val;
						cmd [3] = *(++val);
						uint8 cmdu8 = strtol(cmd,NULL,16);
						sysData.data[i * 4 + count++] = cmdu8;

						printf("v1-luoxt-  cmd=%d count=%d total=%d\n", cmdu8, count, cmdlen);
						if (count < cmdlen)
							++val; //next cmd  
						else
							break;
					}

				}
				else{
					sysData.data[i * 4] =(uint8) (config1 >> 24);
					sysData.data[i * 4 + 1] =(uint8) (config1 >> 16);
					sysData.data[i * 4 + 2] =(uint8) (config1 >> 8);
					sysData.data[i * 4 + 3] =(uint8) (config1 >> 0);
					printf("-luoxt- %s=%lu val %s\n", key[i], config1, val);
				}
				break;
                        }
                    }

                }

            }
            // file crc data
            sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-4] = (uint8) (file_crc >> 24);
            sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-3] = (uint8) (file_crc >> 16);
            sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-2] = (uint8) (file_crc >> 8);
            sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-1] = (uint8) (file_crc >> 0);
            printf("-luoxt- crc32 = 0X%02X%02X%02X%02X\n", sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-4],
                    sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-3],
                    sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-2],
                    sysData.data[RKNAND_SYS_STORGAE_DATA_LEN-1]);

            /* rknand_print_hex_data("lcd paramters save:",(uint32*)sysData.data,32); */
            /*ret = ioctl(sys_fd, RKNAND_STORE_VENDOR_SECTOR0, &sysData);*/
			
            if (0 == access(BASEPARAMETER_PATH, 0))
            {
		        sys_fd = open(BASEPARAMETER_PATH, O_WRONLY);

		    if (sys_fd < 0)
		    {
			    printf("open err %s err=%d\n",BASEPARAMETER_PATH, sys_fd);
			    return -1;
		    }

		  	lseek(sys_fd, BASE_OFFSET, SEEK_SET);
		    ret = write (sys_fd, (void*)&sysData.data[0], RKNAND_SYS_STORGAE_DATA_LEN);
		    if (ret < 0)
		    {
			    printf("read err %s err=%d\n",BASEPARAMETER_PATH, sys_fd);
			    return -1;
		    }
			}

            close(sys_fd);
            if(ret==-1){
                printf("save lcdparam error\n");
            }
            else
            {
                updated = 1;
                nand_crc = file_crc;
                fclose(fp);
                sync();
				reboot(RB_AUTOBOOT);
            }
            fclose(fp);
            return ret;
        }
    }
    return ret;
}

int main(void)
{
	char command[128];
	strcpy( command, "dd if=/dev/zero of=/dev/block/by-name/baseparameter" );
    printf("CLEAN PARAMETERS\n");
	system(command);
    nand_crc = getfile_crc_from_nand();
    while(1)
    {

        rk_update_lcd_parameters_from_sdcard();
        //gettimeofday(&tv,NULL);
        //fprintf(stderr, "[%ld] rk_update_lcd_parameters_from_sdcard sleep....\n", tv.tv_usec);
        //usleep(100000);
        sleep(5);
    }
    return 0;
}