// File: /workspace/github_cpp_makefile_star2_O2/chenhn123[P]wdt_util_src/wdt_ct/w8760_funcs.cpp
// Function: wh_w8760_dev_program_4k_chunk_verify(WdtDevice*, ChunkInfoEx*, int)
int wh_w8760_dev_program_4k_chunk_verify(WDT_DEV* pdev, CHUNK_INFO_EX* pInputChunk, int option)
{
	int retval = 0;
	int size;
	int start_addr = 0;
	int page_size;
	int retry_count = 0;
	int is_first_page = 0;
	char* pdata;
	UINT32 calc_checksum, read_checksum;
	CHUNK_INFO_EX	*pChunk = pInputChunk;
	FUNC_PTR_STRUCT_DEV_OPERATION funcs;

	memset(&funcs, 0, sizeof(FUNC_PTR_STRUCT_DEV_OPERATION));
	
	printf("start 4k chunk program ...\n");
	pdev->dev_state = DS_PROGRAM;

	retval = wh_w8760_dev_set_n_check_device_mode(pdev, W8760_MODE_FLASH_PROGRAM, 0, 0);
	if (!retval)
		return retval;
		
	UINT32 value = (pInputChunk->length + 255) >> 8;
	value |= (((pChunk->chuckInfo.targetStartAddr >> 8) << 16) & 0xFFFF0000);
	retval = wh_w8760_dev_send_commands(pdev, WH_CMD_FLASH_UNLOCK, value);
	if (!retval)
		return retval;
	if(pdev->board_info.dev_type == FW_WDT8762)
	{
		if(pChunk->chuckInfo.targetStartAddr == 0x5d000)
		{
			printf("Erase Sector 0x0000 \n");
			retval = wh_w8760_dev_flash_erase(pdev, 0x0000, 0x1000);
			if (!retval)
				return retval;
		}
	}

	size = pChunk->chuckInfo.length;	
	start_addr = pChunk->chuckInfo.targetStartAddr;
	pdata =	(char*) pChunk->pData;

	if (size > WDT_PAGE_SIZE) {
		is_first_page = 1;
		size = size - WDT_PAGE_SIZE;
		start_addr = start_addr + WDT_PAGE_SIZE;
		pdata = pdata + WDT_PAGE_SIZE;
	}

	while (size) {
		if (size > (int) WDT_PAGE_SIZE)	{
			page_size = WDT_PAGE_SIZE;
			size = size - WDT_PAGE_SIZE;
		} else	{
			page_size = size;
			size = 0;
		}

		for (retry_count = 0; retry_count < RETRY_COUNT; retry_count ++) {		
			retval = wh_w8760_dev_send_commands(pdev, WH_CMD_FLASH_ERASE4K, start_addr);
			
			if (!retval)
				continue;

			retval = wh_w8760_dev_flash_write_data(pdev, (BYTE*) pdata, start_addr, page_size);
			if (!retval)
				continue;

			calc_checksum = misr_for_bytes(0, (BYTE*) pdata, 0, page_size);

			retval = wh_w8760_dev_flash_get_checksum(pdev, &read_checksum, start_addr, page_size);

			if (read_checksum == calc_checksum)
				break;
			else
				printf("checksum failed (%d): %d <> %d\n", retry_count, read_checksum, calc_checksum);
		}

		if (retry_count == RETRY_COUNT)	{
			printf("***** retry failed *****\n");
			break;
		}

		start_addr = start_addr + page_size;
		pdata =	pdata + page_size;

		/* keep the first page to write to the flash in the last loop */
		if (size == 0 && is_first_page) {		
			size = WDT_PAGE_SIZE;
			start_addr = pChunk->chuckInfo.targetStartAddr;
			pdata = (char*) pChunk->pData;
			is_first_page = 0;		
		}
		
	}

	retval = wh_w8760_dev_send_commands(pdev, WH_CMD_FLASH_LOCK, 0);
	if (!retval)
		return retval;
	
	if (retry_count == RETRY_COUNT) {
		printf("stop 4k chunk program : fail \n");
		return 0;
	}

	return 1;
}

// Assembly:
pushq %rbp
pushq %r15
pushq %r14
pushq %r13
pushq %r12
pushq %rbx
subq $0x28, %rsp
movq %rsi, %r14
movq %rdi, %rbx
leaq 0x5efe(%rip), %rdi      # 0xa77d
callq 0x2270
movl $0x3, 0x278(%rbx)
xorl %ebp, %ebp
movq %rbx, %rdi
movl $0x96, %esi
xorl %edx, %edx
xorl %ecx, %ecx
callq 0x3f5f
testl %eax, %eax
je 0x4a7d
movl $0xff, %eax
addl 0x20(%r14), %eax
shrl $0x8, %eax
movl (%r14), %edx
shll $0x8, %edx
andl $0xffff0000, %edx       # imm = 0xFFFF0000
orl %eax, %edx
pushq $0x11
popq %rsi
movq %rbx, %rdi
callq 0x44ac
testl %eax, %eax
je 0x4a7d
movl $0x2000, %ecx           # imm = 0x2000
xorl 0x188(%rbx), %ecx
movl (%r14), %eax
movl %eax, %edx
xorl $0x5d000, %edx          # imm = 0x5D000
orl %ecx, %edx
jne 0x4918
leaq 0x6199(%rip), %rdi      # 0xaa90
callq 0x2270
xorl %ebp, %ebp
movq %rbx, %rdi
xorl %esi, %esi
movl $0x1000, %edx           # imm = 0x1000
callq 0x45f6
testl %eax, %eax
je 0x4a7d
movl (%r14), %eax
movl 0x4(%r14), %ecx
movq %r14, 0x18(%rsp)
movq 0x18(%r14), %rdx
leal -0x1000(%rcx), %r14d
leal 0x1000(%rax), %ebp
leaq 0x1000(%rdx), %r15
cmpl $0x1001, %ecx           # imm = 0x1001
cmovll %eax, %ebp
cmovlq %rdx, %r15
cmovll %ecx, %r14d
setge %dl
movl $0x1000, %ecx           # imm = 0x1000
notb %dl
movl %edx, 0xc(%rsp)
testl %r14d, %r14d
je 0x4a55
leal -0x1000(%r14), %eax
cmpl %ecx, %r14d
movl $0x1000, %r13d          # imm = 0x1000
cmovll %r14d, %r13d
xorl %r12d, %r12d
movq %r14, 0x20(%rsp)
cmpl $0x1001, %r14d          # imm = 0x1001
cmovll %r12d, %eax
movl %eax, 0x10(%rsp)
cmpl $0x3, %r12d
je 0x4a44
movq %rbx, %rdi
movl %ebp, %esi
movl $0x1000, %edx           # imm = 0x1000
callq 0x45f6
testl %eax, %eax
je 0x49ff
movq %rbx, %rdi
movq %r15, %rsi
movl %ebp, %edx
movl %r13d, %ecx
callq 0x462b
testl %eax, %eax
je 0x49ff
xorl %edi, %edi
movq %r15, %rsi
xorl %edx, %edx
movl %r13d, %ecx
callq 0x7ddb
movzwl %ax, %r14d
movq %rbx, %rdi
leaq 0x14(%rsp), %rsi
movl %ebp, %edx
movl %r13d, %ecx
callq 0x4686
movl 0x14(%rsp), %edx
cmpl %r14d, %edx
je 0x4a04
leaq 0x5c7c(%rip), %rdi      # 0xa66e
movl %r12d, %esi
movl %r14d, %ecx
xorl %eax, %eax
callq 0x2050
incl %r12d
jmp 0x498c
addl %r13d, %ebp
movslq %r13d, %rax
addq %rax, %r15
movl 0x10(%rsp), %ecx
testl %ecx, %ecx
setne %al
movl 0xc(%rsp), %edx
orb %dl, %al
movl %ecx, %r14d
testb $0x1, %al
movl $0x1000, %ecx           # imm = 0x1000
jne 0x4958
movq 0x18(%rsp), %rax
movl (%rax), %ebp
movq 0x18(%rax), %r15
movl $0x1000, %r14d          # imm = 0x1000
xorl %edx, %edx
jmp 0x4952
leaq 0x5d66(%rip), %rdi      # 0xa7b1
callq 0x2270
movq 0x20(%rsp), %r14
pushq $0x7c
popq %rsi
movq %rbx, %rdi
callq 0x437d
xorl %ebp, %ebp
testl %eax, %eax
setne %bpl
je 0x4a7d
testl %r14d, %r14d
je 0x4a7d
leaq 0x5d54(%rip), %rdi      # 0xa7ca
callq 0x2270
xorl %ebp, %ebp
movl %ebp, %eax
addq $0x28, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq