/*
 * Copyright (C) 2005-2020 Darron Broad
 * All rights reserved.
 *
 * This file is part of Pickle Microchip PIC ICSP.
 *
 * Pickle Microchip PIC ICSP is free software: you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as published
 * by the Free Software Foundation.
 *
 * Pickle Microchip PIC ICSP is distributed in the hope that it will be
 * useful, but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General
 * Public License for more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with Pickle Microchip PIC ICSP. If not, see http://www.gnu.org/licenses/
 */

#define DEBUG

#include "pickle.h"

/******************************************************************************
 *
 * Session
 *
 *****************************************************************************/

extern struct pickle p;

/*****************************************************************************
 *
 * Hardware operations
 *
 *****************************************************************************/

struct pic_ops pic16n_ops = {
	.arch				= ARCH16BIT,
	.align				= sizeof(uint8_t),
	.selector			= pic16n_selector,
	.bootloader			= pic16n_bootloader,
	.program_begin			= pic16n_program_begin,
	.program_data			= pic16n_program_data,
	.program_end			= pic16n_program_end,
	.verify_begin			= pic16n_program_verify,
	.verify_data			= pic16n_verify_data,
	.verify_end			= pic16n_standby,
	.view_data			= pic16n_view_data,
	.read_config_memory		= pic16n_read_config_memory,
	.get_program_count		= pic16n_get_program_count,
	.get_program_size		= pic16n_get_program_size,
	.get_data_size			= pic16n_get_data_size,
	.get_executive_size		= NULL,
	.get_boot_size			= NULL,
	.read_program_memory_block	= pic16n_read_program_memory_block,
	.read_data_memory_block		= pic16n_read_data_memory_block,
	.write_panel			= pic16n_write_panel,
	.bulk_erase			= pic16n_bulk_erase,
	.write_osccal			= NULL,
	.write_bandgap			= NULL,
	.write_calib			= NULL,
	.row_erase			= NULL,
	.dumpdeviceid			= pic16n_dumpdeviceid,
	.dumpconfig			= pic16n_dumpconfig,
	.dumposccal			= NULL,
	.dumpdevice			= pic16n_dumpdevice,
	.dumpadj			= 2,
	.dumphexcode			= pic16n_dumphexcode,
	.dumpinhxcode			= pic16n_dumpinhxcode,
	.dumphexdata			= pic16n_dumphexdata,
	.dumpinhxdata			= pic16n_dumpinhxdata,
	.debug				= NULL,
};

uint32_t
pic16n_arch(void)
{
	p.pic = &pic16n_ops;

	return p.pic->arch;
}

/*****************************************************************************
 *
 * Hardware configuration
 *
 *****************************************************************************/

struct pic16n_config pic16n_conf;

/*****************************************************************************
 *
 * Hardware config masks
 *
 *  DS40001772B TABLE B-4: SUMMARY OF CONFIGURATION WORDS
 *  DS40001836A TABLE B-4: SUMMARY OF CONFIGURATION WORDS
 *  DS40001886B TABLE B-4: SUMMARY OF CONFIGURATION WORDS
 *  DS40001927A TABLE B-4: SUMMARY OF CONFIGURATION WORDS
 *  DS40001874F TABLE B-1: CONFIGURATION WORD AND MASK
 *  DS40002079C Table 6-1.â€?Configuration Byte and Mask
 *
 * In the following tables ZERO represents undocumented configuration bits
 *
 *****************************************************************************/

/*                          0 1L 1 1H 2 2L 3 2H 4 3L 5 3H 6 4L 7 4H 8 5L 9 5H A 6L B 6H */
uint8_t DS40001772B_B4[] = {0x77,0x29,0xE3,0xBF,0x7F,0x3F,0xFF,0x37,0x03,ZERO,0xFF,0x02};
uint8_t DS40001836A_B4[] = {0x77,0x2B,0xFF,0xBF,0x7F,0x3F,0x9F,0x2F,0x01,0x00};
uint8_t DS40001886B_B4[] = {0x77,0x2B,0xFF,0xBF,0x7F,0x3F,0x9F,0x2F,0x01,0x00};
uint8_t DS40001927A_B4[] = {0x77,0x2B,0xFF,0xBF,0x7F,0x3F,0x9F,0x2F,0x01,0x00};
uint8_t DS40001874F_B1[] = {0x77,0x29,0xE3,0xBF,0x7F,0x3F,0xFF,0x37,0x03,0x00,0xFF,0x02};

/*                          1    2    3    4    5    6    7    8    9    A    B    C    */
uint8_t DS40002079C_61[] = {0x77,0x29,0xFF,0xBF,0x7F,0x3F,0x3F,0x8F,0x00,0x01};

/*****************************************************************************
 *
 * Hardware algorithm map
 *
 *****************************************************************************/

struct pic16n_dsmap pic16n_map[] =
{
/*Device name	Device id	Data-sheet	Flash		 Config   EEProm	Latches Inf/Con/Id	MASKS*/
{"PIC18F24K40", PIC18F24K40,    DS40001772B,	PIC16N_WORD(16), 12,      256,		64,	0,0,16,		DS40001772B_B4},
{"PIC18F25K40", PIC18F25K40,    DS40001772B,	PIC16N_WORD(32), 12,      256,		64,	0,0,16,		DS40001772B_B4},
{"PIC18F45K40", PIC18F45K40,    DS40001772B,	PIC16N_WORD(32), 12,      256,		64,	0,0,16,		DS40001772B_B4},
{"PIC18F26K40", PIC18F26K40,    DS40001772B,	PIC16N_WORD(64), 12,      1024,		64,	0,0,16,		DS40001772B_B4},
{"PIC18F46K40", PIC18F46K40,    DS40001772B,	PIC16N_WORD(64), 12,      1024,		64,	0,0,16,		DS40001772B_B4},
{"PIC18F27K40", PIC18F27K40,    DS40001772B,	PIC16N_WORD(128),12,      1024,		128,	0,0,16,		DS40001772B_B4},
{"PIC18F47K40", PIC18F47K40,    DS40001772B,	PIC16N_WORD(128),12,      1024,		128,	0,0,16,		DS40001772B_B4},
{"PIC18LF24K40",PIC18LF24K40,   DS40001772B,	PIC16N_WORD(16), 12,      256,		64,	0,0,16,		DS40001772B_B4},
{"PIC18LF25K40",PIC18LF25K40,   DS40001772B,	PIC16N_WORD(32), 12,      256,		64,	0,0,16,		DS40001772B_B4},
{"PIC18LF45K40",PIC18LF45K40,   DS40001772B,	PIC16N_WORD(32), 12,      256,		64,	0,0,16,		DS40001772B_B4},
{"PIC18LF26K40",PIC18LF26K40,   DS40001772B,	PIC16N_WORD(64), 12,      1024,		64,	0,0,16,		DS40001772B_B4},
{"PIC18LF46K40",PIC18LF46K40,   DS40001772B,	PIC16N_WORD(64), 12,      1024,		64,	0,0,16,		DS40001772B_B4},
{"PIC18LF27K40",PIC18LF27K40,   DS40001772B,	PIC16N_WORD(128),12,      1024,		128,	0,0,16,		DS40001772B_B4},
{"PIC18LF47K40",PIC18LF47K40,   DS40001772B,	PIC16N_WORD(128),12,      1024,		128,	0,0,16,		DS40001772B_B4},

{"PIC18F24K42", PIC18F24K42,    DS40001836A,	PIC16N_WORD(16), 10,      256,		64,	32,5,16,	DS40001836A_B4},
{"PIC18F25K42", PIC18F25K42,    DS40001836A,	PIC16N_WORD(32), 10,      256,		64,	32,5,16,	DS40001836A_B4},
{"PIC18LF24K42",PIC18LF24K42,   DS40001836A,	PIC16N_WORD(16), 10,      256,		64,	32,5,16,	DS40001836A_B4},
{"PIC18LF25K42",PIC18LF25K42,   DS40001836A,	PIC16N_WORD(32), 10,      256,		64,	32,5,16,	DS40001836A_B4},

{"PIC18F26K42", PIC18F26K42,    DS40001886B,	PIC16N_WORD(64), 10,      1024,		128,	32,5,16,	DS40001886B_B4},
{"PIC18F27K42", PIC18F27K42,    DS40001886B,	PIC16N_WORD(128),10,      1024,		128,	32,5,16,	DS40001886B_B4},
{"PIC18F45K42", PIC18F45K42,    DS40001886B,	PIC16N_WORD(32), 10,      256,		128,	32,5,16,	DS40001886B_B4},
{"PIC18F46K42", PIC18F46K42,    DS40001886B,	PIC16N_WORD(64), 10,      1024,		128,	32,5,16,	DS40001886B_B4},
{"PIC18F47K42", PIC18F47K42,    DS40001886B,	PIC16N_WORD(128),10,      1024,		128,	32,5,16,	DS40001886B_B4},
{"PIC18F55K42", PIC18F55K42,    DS40001886B,	PIC16N_WORD(32), 10,      256,		128,	32,5,16,	DS40001886B_B4},
{"PIC18F56K42", PIC18F56K42,    DS40001886B,	PIC16N_WORD(64), 10,      1024,		128,	32,5,16,	DS40001886B_B4},
{"PIC18F57K42", PIC18F57K42,    DS40001886B,	PIC16N_WORD(128),10,      1024,		128,	32,5,16,	DS40001886B_B4},
{"PIC18LF26K42",PIC18LF26K42,   DS40001886B,	PIC16N_WORD(64), 10,      1024,		128,	32,5,16,	DS40001886B_B4},
{"PIC18LF27K42",PIC18LF27K42,   DS40001886B,	PIC16N_WORD(128),10,      1024,		128,	32,5,16,	DS40001886B_B4},
{"PIC18LF45K42",PIC18LF45K42,   DS40001886B,	PIC16N_WORD(32), 10,      256,		128,	32,5,16,	DS40001886B_B4},
{"PIC18LF46K42",PIC18LF46K42,   DS40001886B,	PIC16N_WORD(64), 10,      1024,		128,	32,5,16,	DS40001886B_B4},
{"PIC18LF47K42",PIC18LF47K42,   DS40001886B,	PIC16N_WORD(128),10,      1024,		128,	32,5,16,	DS40001886B_B4},
{"PIC18LF55K42",PIC18LF55K42,   DS40001886B,	PIC16N_WORD(32), 10,      256,		128,	32,5,16,	DS40001886B_B4},
{"PIC18LF56K42",PIC18LF56K42,   DS40001886B,	PIC16N_WORD(64), 10,      1024,		128,	32,5,16,	DS40001886B_B4},
{"PIC18LF57K42",PIC18LF57K42,   DS40001886B,	PIC16N_WORD(128),10,      1024,		128,	32,5,16,	DS40001886B_B4},

{"PIC18F25K83", PIC18F25K83,    DS40001927A,	PIC16N_WORD(32), 10,      1024,		128,	32,5,16,	DS40001927A_B4},
{"PIC18F26K83", PIC18F26K83,    DS40001927A,	PIC16N_WORD(64), 10,      1024,		128,	32,5,16,	DS40001927A_B4},
{"PIC18LF25K83",PIC18LF25K83,   DS40001927A,	PIC16N_WORD(32), 10,      1024,		128,	32,5,16,	DS40001927A_B4},
{"PIC18LF26K83",PIC18LF26K83,   DS40001927A,	PIC16N_WORD(64), 10,      1024,		128,	32,5,16,	DS40001927A_B4},

{"PIC18F46Q10",	PIC18F46Q10,    DS40001874F,	PIC16N_WORD(64), 12,      1024,		2,	0,0,256,	DS40001874F_B1},
{"PIC18F45Q10",	PIC18F45Q10,    DS40001874F,	PIC16N_WORD(32), 12,      256,		2,	0,0,256,	DS40001874F_B1},
{"PIC18F26Q10",	PIC18F26Q10,    DS40001874F,	PIC16N_WORD(64), 12,      1024,		2,	0,0,256,	DS40001874F_B1},
{"PIC18F25Q10",	PIC18F25Q10,    DS40001874F,	PIC16N_WORD(32), 12,      256,		2,	0,0,256,	DS40001874F_B1},
{"PIC18F24Q10",	PIC18F24Q10,    DS40001874F,	PIC16N_WORD(16), 12,      256,		2,	0,0,256,	DS40001874F_B1},
{"PIC18F27Q10",	PIC18F27Q10,    DS40001874F,	PIC16N_WORD(128),12,      1024,		2,	0,0,256,	DS40001874F_B1},
{"PIC18F47Q10",	PIC18F47Q10,    DS40001874F,	PIC16N_WORD(128),12,      1024,		2,	0,0,256,	DS40001874F_B1},

{"PIC18F25Q43", PIC18F25Q43,    DS40002079D,	PIC16N_WORD(32), 10,      1024,		2,	32,5,32,	DS40002079C_61},
{"PIC18F26Q43", PIC18F26Q43,    DS40002079D,	PIC16N_WORD(64), 10,      1024,		2,	32,5,32,	DS40002079C_61},
{"PIC18F27Q43", PIC18F27Q43,    DS40002079D,	PIC16N_WORD(128),10,      1024,		2,	32,5,32,	DS40002079C_61},
{"PIC18F45Q43", PIC18F45Q43,    DS40002079D,	PIC16N_WORD(32), 10,      1024,		2,	32,5,32,	DS40002079C_61},
{"PIC18F46Q43", PIC18F46Q43,    DS40002079D,	PIC16N_WORD(64), 10,      1024,		2,	32,5,32,	DS40002079C_61},
{"PIC18F47Q43", PIC18F47Q43,    DS40002079D,	PIC16N_WORD(128),10,      1024,		2,	32,5,32,	DS40002079C_61},
{"PIC18F55Q43", PIC18F55Q43,    DS40002079D,	PIC16N_WORD(32), 10,      1024,		2,	32,5,32,	DS40002079C_61},
{"PIC18F56Q43", PIC18F56Q43,    DS40002079D,	PIC16N_WORD(64), 10,      1024,		2,	32,5,32,	DS40002079C_61},
{"PIC18F57Q43", PIC18F57Q43,    DS40002079D,	PIC16N_WORD(128),10,      1024,		2,	32,5,32,	DS40002079C_61},

{"(null)",      0,              0,              0,               0,       0,		0,	0,0,0,		0},
/*Device name	Device id	Data-sheet	Flash		 Config   EEProm	Latches Inf/Con/Id	MASKS*/
};
#define PIC16N_SIZE ((sizeof(pic16n_map) / sizeof(struct pic16n_dsmap)) - 1)

/* Default device (null) */
uint32_t pic16n_index = PIC16N_SIZE;

void
pic16n_selector(void)
{
	uint32_t i;
	char *dnames[PIC16N_SIZE];

	for (i = 0; i < PIC16N_SIZE; ++i) {
		dnames[i] = pic16n_map[i].devicename;
	}
	qsort(dnames, PIC16N_SIZE, sizeof(char *), pic_cmp);
	for (i = 0; i < PIC16N_SIZE; ++i) {
		if ((i % PIC_NCOLS) == (PIC_NCOLS - 1)) {
			sprintf(buf, "%s\n", dnames[i]);
            myprintf(buf);
		} else {
			sprintf(buf, "%s\t", dnames[i]);
            myprintf(buf);
        }
	}
	if (i % PIC_NCOLS) {
		sprintf(buf, "\n");
        myprintf(buf);
    }
	sprintf(buf, "Total: %u\n", (uint32_t)PIC16N_SIZE);
    myprintf(buf);
}

void
pic16n_bootloader(void)
{
	uint32_t dev, i;
	char s[BUFLEN];

	for (dev = 0; pic16n_map[dev].deviceid; ++dev) {
		if (pic16n_map[dev].datasheet == DS40001874F) /* XXX unsupported */
			continue;
		if (pic16n_map[dev].datasheet == DS40002079D) /* XXX unsupported */
			continue;

		for (i = 0; pic16n_map[dev].devicename[i] && i < BUFLEN; ++i)
			s[i] = tolower(pic16n_map[dev].devicename[i]);
		s[i] = 0;
		sprintf(buf, "#IFDEF __%s\n", &pic16n_map[dev].devicename[3]);
        myprintf(buf);
		sprintf(buf, "    LIST        P=%s\n", pic16n_map[dev].devicename);
        myprintf(buf);
		sprintf(buf, "    #INCLUDE    \"p%s.inc\"\n", &s[3]);
        myprintf(buf);
		sprintf(buf, "    NOLIST\n");
        myprintf(buf);
		sprintf(buf, "    #DEFINE     ERASE_FLASH 0x94\n");
        myprintf(buf);
		sprintf(buf, "    #DEFINE     WRITE_FLASH 0x84\n");
        myprintf(buf);
		sprintf(buf, "    #DEFINE     MAX_FLASH   0x%X\n",
			pic16n_map[dev].flash << 1);
        myprintf(buf);
		if (pic16n_map[dev].eeprom) {
		    sprintf(buf, "    #DEFINE     MAX_EE      %d ; X 64\n",
			    pic16n_map[dev].eeprom / 64);
            myprintf(buf);
        }
		sprintf(buf, "    #DEFINE     ROWSIZE     %d\n",
			pic16n_map[dev].latches);
        myprintf(buf);
		sprintf(buf, "    #DEFINE     ERASESIZE   %d\n",
			pic16n_map[dev].latches);
        myprintf(buf);
		sprintf(buf, "    #DEFINE     TYPE        2\n");
        myprintf(buf);
		sprintf(buf, "#ENDIF\n");
        myprintf(buf);
	}
}

/*****************************************************************************
 *
 * Program/Verify mode
 *
 *****************************************************************************/

/*
 * ENTER HVP/LVP PROGRAM/VERIFY MODE
 *
 * ENTRY - VDD FIRST
 */
void
pic16n_program_verify(void)
{
	/* RESET & ACQUIRE GPIO */
	io_set_vpp(VPPLOW);
	/* DS40001753B TENTS(100ns) */
	io_usleep(1000);

	/* PGD + PGC + PGM(N/A) LOW */
	io_set_pgd(LOW);
	io_set_pgc(LOW);
	io_usleep(1000);

	/* INPUT DATA ON CLOCK RISING EDGE, MSB FIRST */
	io_configure(FALSE, TRUE);

	/* LVP */
	if (p.key == LVPKEY) {
		/* VPP HIGH */
		io_set_vpp(VPPHIGH);
		/* TENTH(250ns) */
		io_usleep(250);

		/* VPP LOW */
		io_set_vpp(VPPLOW);
		/* TENTH(250ns) */
		io_usleep(250);

		/* PROGRAM/VERIFY ENTRY CODE */
		io_program_out(MCHPKEY, 32);
		/* UNSPECIFIED */
		io_usleep(250);
	}
	/* HVP */
	else {
		/* VPP HIGH */
		io_set_vpp(VPPHIGH);
		/* DS40001753B TENTS(100ns) */
		io_usleep(250);
	}
}

/*
 * EXIT HVP/LVP PROGRAM/VERIFY MODE
 *
 * EXIT - VDD LAST
 */
void
pic16n_standby(void)
{
	/* PGD + PGC + VPP + PGM(N/A) LOW */
	io_set_pgd(LOW);
	io_set_pgc(LOW);
	io_set_vpp(VPPLOW);
}

/*****************************************************************************
 *
 * Hardware functions
 *
 *****************************************************************************/

/*I/O*************************************************************************/

/*
 * LOAD DATA FOR NVM
 *  0x00 PC = PC
 *  0x02 PC = PC + 2 CODE
 *  0x02 PC = PC + 1 DATA
 *
 * DS40001772B-page 12
 */
static void
pic16n_load_data_for_nvm(uint32_t word, uint8_t j /* 0 || 1 */)
{
	io_program_out(j << 1, 8);
	/* TDLY 1us */
	io_program_out(word << 1, 24);
	/* TDLY 1us */
}

/*
 * READ DATA FROM NVM
 *  0xFC PC = PC
 *  0xFE PC = PC + 2 CODE
 *  0xFE PC = PC + 1 DATA
 *
 * DS40001772B-page 10
 * DS40001874F-page 10
 * DS40002079D-page 13
 */
static uint32_t
pic16n_read_data_from_nvm(uint8_t j /* 0 || 1 */)
{
	uint32_t word;

	io_program_out(0xFC | (j << 1), 8);
	/* TDLY 1us */
	word = io_program_in(24);
	/* TDLY 1us */

	word = (word >> 1) & PIC16N_WORD_MASK;

	return word;
}

/*
 * INCREMENT ADDRESS
 *  0xF8 PC = PC + 2 CODE
 *  0xF8 PC = PC + 1 DATA
 *
 * DS40001772B-page 10
 * DS40001874F-page 10
 * DS40002079D-page 13
 */
void
pic16n_increment_address(void)
{
	io_program_out(0xF8, 8);
	/* TDLY 1us */
}

/*
 * LOAD PC ADDRESS
 *  0x80 PC = address
 *
 * DS40001772B-page 10
 * DS40001874F-page 10
 * DS40002079D-page 13
 */
void
pic16n_load_pc_address(uint32_t address)
{
	io_program_out(0x80, 8);
	/* TDLY 1us */
	io_program_out(address << 1, 24);
	/* TDLY 1us */
}

/*PROG************************************************************************/

/*
 * BEGIN INTERNALLY TIMED PROGRAMMING
 *  0xE0
 *
 * DS40001772B-page 12
 * DS40001772B TPINT(2.8ms PROGRAM) TPINT(5.6ms CONFIG/EEPROM)
 */
void
pic16n_begin_internally_timed_programming(uint32_t t)
{
	io_program_out(0xE0, 8);
	/* TPINT */
	io_usleep(t);
}

/*
 * BEGIN EXTERNALLY TIMED PROGRAMMING
 *  0xC0
 *
 * DS40001772B-page 12
 * DS40001772B TPEXT(2.1ms PROGRAM) (NOT CONFIG)
 */
void
pic16n_begin_externally_timed_programming(uint32_t t)
{
	io_program_out(0xC0, 8);
	/* TPEXT */
	io_usleep(t);
}

/*
 * END EXTERNALLY TIMED PROGRAMMING
 *  0x82
 *
 * DS40001772B-page 12
 * DS40001772B TDIS(300us PROGRAM)
 */
void
pic16n_end_externally_timed_programming(uint32_t t)
{
	io_program_out(0x82, 8);
	/* TDIS */
	io_usleep(t);
}

/*
 * PROGRAM DATA COMMAND
 *  0xC0 PC = PC
 *  0xE0 PC = PC + 2
 *
 * DS40001874F-page 10
 * DS40001874F TPINT(65us PROGRAM & CONFIG) TPDFM (11ms EEPROM)
 *
 * DS40002079D-page 13
 */
void
pic16n_program_data_command(uint16_t word, uint8_t j /* 0 || 1 */, uint32_t t)
{
	io_program_out(j ? 0xE0 : 0xC0, 8);
	/* TDLY 1us */
	io_program_out(word << 1, 24);
	/* TPINT or TPDFM */
	io_usleep(t);
}

/*ERASE***********************************************************************/

/*
 * BULK ERASE MEMORY (PRELOAD PC)
 *  0x18
 *
 * PC = 0x000000 ERASE PROGRAM AND CONFIG
 * PC = 0x300000 ERASE PROGRAM AND CONFIG AND USERID
 * PC = 0x310000 ERASE EEPROM
 *
 * DS40001772B-page 12
 * DS40001772B TERAB(25.2ms PIC18F26K40)
 *
 * DS40001874F-page 10
 * DS40002079D-page 13
 */
void
pic16n_bulk_erase_memory(uint32_t t)
{
	io_program_out(0x18, 8);
	io_usleep(t);
}

/*
 * BULK ERASE MEMORY
 *  0x18
 *
 * DS40002079D-page 16
 *
 * 24-bit payload
 *
 * Bit 1: Data EEPROM		0x02
 * Bit 2: Flash memory		0x04
 * Bit 3: User ID memory	0x08
 * Bit 4: Configuration memory	0x10
 *
 * TERAB 11ms
 */
void
pic16n_bulk_erase_memory_Q43(uint32_t t)
{
	io_program_out(0x18, 8);
	io_program_out(0x1E, 24);
	io_usleep(t);
}

/*
 * ROW ERASE MEMORY (PRELOAD PC)
 *  0xF0
 *
 * DS40001772B-page 12
 * DS40001772B TERAR(2.8ms)
 */
void
pic16n_row_erase_memory(uint32_t t)
{
	io_program_out(0xF0, 8);
	io_usleep(t);
}

/*****************************************************************************
 *
 * Compound functions
 *
 *****************************************************************************/

void
pic16n_bulk_erase(void)
{
	pic16n_program_verify();

	switch (pic16n_map[pic16n_index].datasheet) {

	case DS40002079D:
		pic16n_bulk_erase_memory_Q43(PIC16N_TERAB_Q43);
		break;

	case DS40001874F:
		pic16n_load_pc_address(PIC16N_USERID_ADDR);
		pic16n_bulk_erase_memory(PIC16N_TERAB_Q10);

		pic16n_load_pc_address(PIC16N_EEPROM_ADDR);
		pic16n_bulk_erase_memory(PIC16N_TERAB_Q10);
		break;

	default:
		pic16n_load_pc_address(PIC16N_USERID_ADDR);
		pic16n_bulk_erase_memory(PIC16N_TERAB);

		if (pic16n_map[pic16n_index].eeprom) {
			pic16n_load_pc_address(PIC16N_EEPROM_ADDR);
			pic16n_bulk_erase_memory(PIC16N_TERAB);
		}
		break;
	}

	pic16n_standby();
}

#if 0
void
pic16n_row_erase(uint32_t row, uint32_t nrows)
{
	SYS_FS_FilePrintf(stderr, "%s()\n", __func__);
}
#endif

/*****************************************************************************
 *
 * Read block data
 *
 *****************************************************************************/

/*
 * READ CONFIGURATION MEMORY AND STORE DEVICE MAP INDEX
 */
int
pic16n_read_config_memory(void)
{
	uint32_t dev;
	uint16_t word;

	/* NULL device */
	pic16n_index = PIC16N_SIZE;

	/* Reset configuraton */
	memset(&pic16n_conf, 0, sizeof(pic16n_conf));

	pic16n_program_verify();
	pic16n_load_pc_address(PIC16N_REVID_ADDR);

	pic16n_conf.revisionid = pic16n_read_data_from_nvm(1);	/* Revisionid */
	pic16n_conf.deviceid = pic16n_read_data_from_nvm(1);	/* Deviceid   */

	/* Device detect */
	for (dev = 0; pic16n_map[dev].deviceid; ++dev) {
		if (pic16n_map[dev].deviceid == pic16n_conf.deviceid) {
			break;
		}
	}
	if (pic16n_map[dev].deviceid == 0) {
		/*
		 * VELLEMAN K8048 SWITCH IN STANDBY [0000]
		 * VELLEMAN K8048 NO POWER          [3FFF]
		 * VELLEMAN K0848 SWITCH IN RUN     [3FFF]
		 * VELLEMAN K0848 SWITCH IN PROG    [XXXX]
		 */
		if (pic16n_conf.deviceid == 0x0000 || pic16n_conf.deviceid == 0x3FFF) {
			sprintf(buf, "%s: information: %s\n",
				__func__, io_fault(pic16n_conf.deviceid));
            myprintf(buf);
		} else {
			sprintf(buf, "%s: information: device unknown: [%04X]\n",
				__func__, pic16n_conf.deviceid);
            myprintf(buf);
		}
		pic16n_standby();
		return -1;
	}

	/* Device recognised */
	pic16n_index = dev;

	/*
	 * USER ID and CONFIG words are mapped to bytes because PIC18 HEX uses byte addressing.
	 */

	/* User ID */
	pic16n_load_pc_address(PIC16N_USERID_ADDR);
	for (uint32_t i = 0; i < pic16n_map[pic16n_index].idsize; i += 2) {
		word = pic16n_read_data_from_nvm(1);
		pic16n_conf.userid[i] = word;
		pic16n_conf.userid[i + 1] = word >> 8;
	}

	/* Config word(s) */
	pic16n_load_pc_address(PIC16N_CONFIG_ADDR);
	if (pic16n_map[pic16n_index].datasheet == DS40002079D) {
		for (uint32_t i = 0; i < pic16n_map[pic16n_index].config; ++i) {
			pic16n_conf.config[i] = pic16n_read_data_from_nvm(1);
			if (pic16n_map[pic16n_index].masks && (p.config & CONFIGAND))
				pic16n_conf.config[i] &= pic16n_map[pic16n_index].masks[i];
		}
	} else {
		for (uint32_t i = 0; i < pic16n_map[pic16n_index].config; i += 2) {
			word = pic16n_read_data_from_nvm(1);
			pic16n_conf.config[i] = word;
			pic16n_conf.config[i + 1] = word >> 8;
			if (pic16n_map[pic16n_index].masks && (p.config & CONFIGAND)) {
				pic16n_conf.config[i] &= pic16n_map[pic16n_index].masks[i];
				pic16n_conf.config[i + 1] &= pic16n_map[pic16n_index].masks[i + 1];
			}
		}
	}

	/* Device information area */
	if (pic16n_map[pic16n_index].devinfo) {
		if (pic16n_map[pic16n_index].datasheet == DS40002079D)
			pic16n_load_pc_address(PIC16N_DEVINFO_ADDR_Q43);
		else
			pic16n_load_pc_address(PIC16N_DEVINFO_ADDR);
		for (uint32_t i = 0; i < pic16n_map[pic16n_index].devinfo && i < PIC16N_DEVINFO_MAX; ++i)
			pic16n_conf.devinfo[i] = pic16n_read_data_from_nvm(1);
	}

	/* Device configuration information */
	if (pic16n_map[pic16n_index].devconf) {
		if (pic16n_map[pic16n_index].datasheet == DS40002079D)
			pic16n_load_pc_address(PIC16N_DEVCONF_ADDR_Q43);
		else
			pic16n_load_pc_address(PIC16N_DEVCONF_ADDR);
		for (uint32_t i = 0; i < pic16n_map[pic16n_index].devconf && i < PIC16N_DEVCONF_MAX; ++i)
			pic16n_conf.devconf[i] = pic16n_read_data_from_nvm(1);
	}

	pic16n_standby();

	return 0;
}

/*
 * GET PROGRAM COUNT
 *
 *  RETURN NUMBER OF PARTITIONS
 */
uint32_t
pic16n_get_program_count(void)
{
	return 1;
}

/*
 * GET PROGRAM FLASH SIZE
 *
 *  RETURN SIZE IN WORDS
 */
uint32_t
pic16n_get_program_size(uint32_t *addr, uint32_t partition)
{
	*addr = 0;

	return pic16n_map[pic16n_index].flash;
}

/*
 * GET DATA EEPROM/FLASH SIZE
 *
 *  RETURN SIZE IN BYTES
 */
uint32_t
pic16n_get_data_size(uint32_t *addr)
{
	if (pic16n_map[pic16n_index].datasheet == DS40002079D)
		*addr = PIC16N_EEPROM_ADDR_Q43;
	else
		*addr = PIC16N_EEPROM_ADDR;

	return pic16n_map[pic16n_index].eeprom;
}

/*
 * READ PROGRAM FLASH MEMORY BLOCK ADDR .. ADDR + SIZE
 *
 *  RETURN ADDR
 */
uint32_t
pic16n_read_program_memory_block(uint32_t addr, uint32_t size)
{
	uint32_t i;
	uint32_t databuf;
    SYS_FS_HANDLE fileHandle;

	pic16n_program_verify();
	pic16n_load_pc_address(addr);

	fileHandle = SYS_FS_FileOpen("/mnt/mydrive/data.bin", (SYS_FS_FILE_OPEN_WRITE));
	for (i = 0; i < size; ++i) {
		databuf = (uint32_t)pic16n_read_data_from_nvm(1);
        SYS_FS_FilePrintf(fileHandle, "%c", databuf>>8);
        SYS_FS_FilePrintf(fileHandle, "%c", databuf);
    }
    SYS_FS_FileClose(fileHandle);

	pic16n_standby();

	return addr;
}

/*
 * READ DATA EEPROM BLOCK ADDR .. ADDR + SIZE
 *
 *  RETURN ADDR
 */
uint32_t
pic16n_read_data_memory_block(uint32_t addr, uint16_t size)
{
	uint32_t i;
    SYS_FS_HANDLE fileHandle;
	uint16_t databuf;

	pic16n_program_verify();
	pic16n_load_pc_address(addr);

	fileHandle = SYS_FS_FileOpen("/mnt/mydrive/data.bin", (SYS_FS_FILE_OPEN_WRITE));
	for (i = 0; i < size; i++) {
		databuf = (uint16_t)pic16n_read_data_from_nvm(1);
        SYS_FS_FilePrintf(fileHandle, "%c", databuf);
    }
    SYS_FS_FileClose(fileHandle);

	pic16n_standby();

	return addr;
}

/*****************************************************************************
 *
 * Program Code Panel
 *
 *****************************************************************************/

/*
 * WRITE PANEL
 */
void
pic16n_write_panel(uint32_t region, uint32_t address, uint32_t *panel, uint32_t panel_size)
{
	uint16_t word;

	if (panel_size == 2) { /* DS40001874F || DS40002079D */
		word = panel[0] | panel[1] << 8;
		pic16n_load_pc_address(address);
		pic16n_program_data_command(word, 0, PIC16N_TPINT_Q);
	} else {
		for (uint32_t i = 0; i < panel_size; i += 2) {
			word = panel[i] | panel[i + 1] << 8;
			pic16n_load_data_for_nvm(word, 1);
		}
		pic16n_load_pc_address(address);
		pic16n_begin_internally_timed_programming(PIC16N_TPINT_CODE);
	}
}

/*****************************************************************************
 *
 * Program Data/EEPROM
 *
 *****************************************************************************/

/*
 * WRITE Data/EEPROM WORD
 */
void
pic16n_write_data_memory(uint32_t address, uint16_t word)
{

	pic16n_load_pc_address(address);
	switch (pic16n_map[pic16n_index].datasheet) {
	case DS40001874F:
	case DS40002079D:
		pic16n_program_data_command(word, 0, PIC16N_TPDFM_Q);
		break;

	default:pic16n_load_data_for_nvm(word, 0);
		pic16n_begin_internally_timed_programming(PIC16N_TPINT_CONFIG);
		break;
	}
}

/*****************************************************************************
 *
 * Program UserID/Config
 *
 *****************************************************************************/

/*
 * WRITE USERID WORD
 *
 *  RETURN WORD
 */
uint16_t
pic16n_write_userid_word(uint16_t word)
{
	switch (pic16n_map[pic16n_index].datasheet) {
	case DS40001874F:
		pic16n_program_data_command(word, 0, PIC16N_TPINT_Q10);
		break;

	case DS40002079D:
		pic16n_program_data_command(word, 0, PIC16N_TPINT_Q43);
		break;

	default:pic16n_load_data_for_nvm(word, 0);
		pic16n_begin_internally_timed_programming(PIC16N_TPINT_CONFIG);
		break;
	}

	word = (uint16_t)pic16n_read_data_from_nvm(1);

	return word;
}

/*
 * WRITE CONFIG WORD
 *
 *  RETURN WORD
 */
uint16_t
pic16n_write_config_word(uint16_t word)
{
	switch (pic16n_map[pic16n_index].datasheet) {
	case DS40001874F:
		pic16n_program_data_command(word, 0, PIC16N_TPINT_Q10);
		break;

	case DS40002079D:
		pic16n_program_data_command(word, 0, PIC16N_TPDFM_Q43);
		break;

	default:pic16n_load_data_for_nvm(word, 0);
		pic16n_begin_internally_timed_programming(PIC16N_TPINT_CONFIG);
		break;
	}

	word = (uint16_t)pic16n_read_data_from_nvm(1);

	return word;
}

/*
 * WRITE CONFIG
 *
 *  RETURN 0 ON ERROR ELSE PROGRAM COUNT
 */
uint32_t
pic16n_write_config(void)
{
	uint16_t wdata, vdata;

	pic16n_program_verify();

	pic16n_load_pc_address(PIC16N_USERID_ADDR);
	for (uint32_t i = 0; i < pic16n_map[pic16n_index].idsize; i += 2) {
		wdata = pic16n_conf.userid[i] | pic16n_conf.userid[i + 1] << 8;
		vdata = pic16n_write_userid_word(wdata);
		if (vdata != wdata) {
			sprintf(buf, "%s: error: USERID%d write failed: read [%04X] expected [%04X]\n",
				__func__, i, vdata, wdata);
            myprintf(buf);
			pic16n_standby();
			return 0;
		}
	}

	pic16n_load_pc_address(PIC16N_CONFIG_ADDR);
	switch (pic16n_map[pic16n_index].datasheet) {
	case DS40002079D:
		for (uint32_t i = 0; i < pic16n_map[pic16n_index].config; ++i) {
			wdata = pic16n_conf.config[i];
			if (pic16n_map[pic16n_index].masks && (p.config & CONFIGSET)) {
				wdata |= ~(pic16n_map[pic16n_index].masks[i] | 0xFF00);
			}
			vdata = pic16n_write_config_word(wdata);
			if (pic16n_map[pic16n_index].masks && (p.config & CONFIGVER)) {
				wdata &= pic16n_map[pic16n_index].masks[i];
				vdata &= pic16n_map[pic16n_index].masks[i];
			}
			if (vdata != wdata) {
				sprintf(buf, "%s: error: CONFIG%d write failed: read [%02X] expected [%02X]\n",
					__func__, i + 1, vdata, wdata);
                myprintf(buf);
				pic16n_standby();
				return 0;
			}
		}
		break;

	default:for (uint32_t i = 0; i < pic16n_map[pic16n_index].config; i += 2) {
			wdata = pic16n_conf.config[i] | pic16n_conf.config[i + 1] << 8;
			if (pic16n_map[pic16n_index].masks && (p.config & CONFIGSET)) {
				wdata |= ~(pic16n_map[pic16n_index].masks[i] |
					pic16n_map[pic16n_index].masks[i + 1] << 8);
			}
			vdata = pic16n_write_config_word(wdata);
			if (pic16n_map[pic16n_index].masks && (p.config & CONFIGVER)) {
				uint16_t mask = pic16n_map[pic16n_index].masks[i] |
					pic16n_map[pic16n_index].masks[i + 1] << 8;
				wdata &= mask;
				vdata &= mask;
			}
			if (vdata != wdata) {
				sprintf(buf, "%s: error: CONFIG%d write failed: read [%04X] expected [%04X]\n",
					__func__, i + 1, vdata, wdata);
                myprintf(buf);
				pic16n_standby();
				return 0;
			}
		}
		break;
	}

	pic16n_standby();

	return pic16n_map[pic16n_index].idsize + pic16n_map[pic16n_index].config;
}

/*****************************************************************************
 *
 * Programming
 *
 *****************************************************************************/

/*
 * DETERMINE MEMORY REGION: CODE, ID, CONFIG or DATA
 *
 *  RETURN PIC_REGIONCODE:
 *      0 .. FLASH SIZE - 1
 *
 *  RETURN PIC_REGIONID:
 *      0x200000 .. 0x200007
 *
 *  RETURN PIC_REGIONCONFIG:
 *      0x300000 .. 0x30000B
 *
 *  RETURN PIC_REGIONDATA:
 *      0x310000 .. 0x31XXXX
 *      or
 *      0x380000 .. 0x38XXXX
 */
uint16_t
pic16n_getregion(uint32_t address)
{
	/* CODE */
	if (address < (pic16n_map[pic16n_index].flash << 1)) {
		return PIC_REGIONCODE;
	}
	/* ID */
	if (address >= PIC16N_USERID_ADDR && address < (PIC16N_USERID_ADDR +
		pic16n_map[pic16n_index].idsize)) {
		return PIC_REGIONID;
	}
	/* CONFIG */
	if (address >= PIC16N_CONFIG_ADDR && address < (PIC16N_CONFIG_ADDR +
		pic16n_map[pic16n_index].config)) {
		return PIC_REGIONCONFIG;
	}
	/* DATA EEPROM */
	if (pic16n_map[pic16n_index].eeprom) {
		switch (pic16n_map[pic16n_index].datasheet) {
		case DS40002079D:
			if (address >= PIC16N_EEPROM_ADDR_Q43 &&
				address < (PIC16N_EEPROM_ADDR_Q43 + pic16n_map[pic16n_index].eeprom)) {
				return PIC_REGIONDATA;
			}
			break;

		default:if (address >= PIC16N_EEPROM_ADDR &&
				address < (PIC16N_EEPROM_ADDR + pic16n_map[pic16n_index].eeprom)) {
				return PIC_REGIONDATA;
			}
		}
	}
	if (p_f==0) {sprintf(buf, "%s: warning: address unsupported [%04X]\n",
		    __func__, address);
        myprintf(buf);
    }
	return PIC_REGIONNOTSUP;
}

/*
 * INIT REGION FOR WRITING (ID & CONFIG DELAYED)
 *
 *  RETURN REGION IF WRITING SUPPORTED
 */
uint32_t
pic16n_init_writeregion(uint32_t region)
{
	switch (region) {
	case PIC_REGIONCODE:
		pic16n_load_pc_address(0); /* Reset latch address */
		pic_write_panel(PIC_PANEL_BEGIN, region, pic16n_map[pic16n_index].latches, 0);
		/* Follow through */
	case PIC_REGIONID:
	case PIC_REGIONCONFIG:
	case PIC_REGIONDATA:
		return region;
	}
	if (p_f==0) {sprintf(buf, "%s: warning: region unsupported [%d]\n",
		    __func__, region);
        myprintf(buf);
    }
	return PIC_REGIONNOTSUP;
}

/*
 * WRITE REGION (CACHE ID & CONFIG)
 */
void
pic16n_writeregion(uint32_t address, uint32_t region, uint16_t data)
{
	switch (region) {
	case PIC_REGIONCODE:
		pic_write_panel(PIC_PANEL_UPDATE, address, data, 0);
		return;
	case PIC_REGIONID:
		pic16n_conf.userid[address - PIC16N_USERID_ADDR] = data;
		return;
	case PIC_REGIONCONFIG:
		pic16n_conf.config[address - PIC16N_CONFIG_ADDR] = data;
		return;
	case PIC_REGIONDATA:
		pic16n_write_data_memory(address, data);
		return;
	}
}

/*
 * INIT REGION FOR VERIFY
 *
 *  RETURN REGION IF VERIFY SUPPORTED
 */
uint32_t
pic16n_init_verifyregion(uint32_t region)
{
	if (region == PIC_REGIONNOTSUP) {
		if (p_f==0) {sprintf(buf, "%s: warning: region unsupported [%d]\n",
			    __func__, region);
            myprintf(buf);
        }
	}

	return region;
}

/*
 * GET VERIFY DATA FOR REGION
 */
uint16_t
pic16n_verifyregion(uint32_t address, uint32_t region, uint16_t index, uint16_t wdata, uint8_t mode)
{
	if (region == PIC_REGIONNOTSUP) {
		if (p_f==0) {sprintf(buf, "%s: warning: region unsupported [%d]\n",
			    __func__, region);
            myprintf(buf);
        }
		return wdata;
	}

	if (index == 0)
		pic16n_load_pc_address(address);

	switch (mode) {
	case PIC16N_VERIFY_BYTE:
		return pic16n_read_data_from_nvm(1) & 0xFF;

	case PIC16N_VERIFY_HIGHLOW:
		if (address & 1)
			return pic16n_read_data_from_nvm(1) >> 8;	/* HIGH */
		else
			return pic16n_read_data_from_nvm(1) & 0xFF;	/* LOW */
		break;

	case PIC16N_VERIFY_WORD:
		return pic16n_read_data_from_nvm(1);

	default:if (p_f==0) {sprintf(buf, "%s: warning: mode unsupported [%d]\n",
			        __func__, mode);
                myprintf(buf);
            }
	}

	return wdata;
}

/*****************************************************************************
 *
 * Program & verify
 *
 *****************************************************************************/

/*
 * BEGIN PROGRAMMING
 */
void
pic16n_program_begin(void)
{
	pic16n_program_verify();

	memset(pic16n_conf.userid, -1, sizeof(uint8_t) * pic16n_map[pic16n_index].idsize);
	memset(pic16n_conf.config, -1, sizeof(uint8_t) * PIC16N_CONFIG_MAX);
}

/*
 * PROGRAM DATA
 */
uint32_t
pic16n_program_data(uint32_t current_region, pic_data *pdata)
{
	uint32_t address, new_region;

	for (uint32_t i = 0; i < pdata->nbytes; ++i) {
		address = pdata->address + i;
		new_region = pic16n_getregion(address);
		if (new_region != current_region) {
			pic_write_panel(PIC_PANEL_END, PIC_VOID, PIC_VOID, 0);
			current_region = pic16n_init_writeregion(new_region);
		}
		if (current_region == PIC_REGIONNOTSUP)
			continue;
		pic16n_writeregion(address, current_region, pdata->bytes[i]);
	}
	return current_region;
}

/*
 * END PROGRAMMING
 */
void
pic16n_program_end(int config)
{
	pic_write_panel(PIC_PANEL_END, PIC_VOID, PIC_VOID, 0);
	pic16n_standby();
	if (config)
		pic16n_write_config();
}

/*
 * VERIFY DATA
 */
uint32_t
pic16n_verify_data(uint32_t current_region, pic_data *pdata, uint32_t *fail)
{
	uint32_t address, new_region;
	uint16_t wdata, vdata;

	for (uint32_t i = 0; i < pdata->nbytes;) {
		address = pdata->address + i;
		new_region = pic16n_getregion(address);
		if (new_region != current_region)
			current_region = pic16n_init_verifyregion(new_region);
		/* PIC_REGIONNOTSUP */
		if (current_region == PIC_REGIONNOTSUP) {
			i += 1;
		}
		/* PIC_REGIONDATA */
		else if (current_region == PIC_REGIONDATA) {
			/* EEPROM BYTE */
			wdata = pdata->bytes[i];
			vdata = pic16n_verifyregion(address, current_region, i, wdata, PIC16N_VERIFY_BYTE);
			if (vdata != wdata) {
				if (p_f == 0) {sprintf(buf, "%s: error: read [%02X] expected [%02X] at [%06X]\n",
					   __func__, vdata, wdata, address);
                    myprintf(buf);
				}
				pdata->bytes[i] = vdata;
				(*fail) += 1;
			}
			i += 1;
		}
		/*
		 * PIC_REGIONCODE
		 * PIC_REGIONCONFIG
		 * PIC_REGIONID
		 */
		else if ((pic16n_map[pic16n_index].datasheet == DS40002079D && current_region == PIC_REGIONCONFIG)) {
			/* Q43 CONFIG BYTE */
			wdata = pdata->bytes[i];
			vdata = pic16n_verifyregion(address, current_region, i, wdata, PIC16N_VERIFY_BYTE);
			if (pic16n_map[pic16n_index].masks && (p.config & CONFIGVER)) {
				uint8_t a = address - PIC16N_CONFIG_ADDR;
				wdata &= pic16n_map[pic16n_index].masks[a];
				vdata &= pic16n_map[pic16n_index].masks[a];
			}
			if (vdata != wdata) {
				if (p_f == 0) {sprintf(buf, "%s: error: read [%02X] expected [%02X] at [%06X]\n",
					    __func__, vdata, wdata, address);
                    myprintf(buf);
				}
				pdata->bytes[i] = vdata;
				(*fail) += 1;
			}
			i += 1;
		}
		else if ((pdata->nbytes - i) == 1) {
			/* CODE/ID/CONFIG BYTE */
			wdata = pdata->bytes[i];
			vdata = pic16n_verifyregion(address, current_region, i, wdata, PIC16N_VERIFY_HIGHLOW);
			if (current_region == PIC_REGIONCONFIG) {
				if (pic16n_map[pic16n_index].masks && (p.config & CONFIGVER)) {
					uint8_t a = address - PIC16N_CONFIG_ADDR;
					wdata &= pic16n_map[pic16n_index].masks[a];
					vdata &= pic16n_map[pic16n_index].masks[a];
				}
			}
			if (vdata != wdata) {
				if (p_f == 0) {sprintf(buf, "%s: error: read [%02X] expected [%02X] at [%06X]\n",
					   __func__, vdata, wdata, address);
                    myprintf(buf);
				}
				pdata->bytes[i] = vdata;
				(*fail) += 1;
			}
			i += 1;
		}
		else {
			/* CODE/ID/CONFIG WORD */
			wdata = pdata->bytes[i] | pdata->bytes[i + 1] << 8;
			vdata = pic16n_verifyregion(address, current_region, i, wdata, PIC16N_VERIFY_WORD);
			if (current_region == PIC_REGIONCONFIG) {
				if (pic16n_map[pic16n_index].masks && (p.config & CONFIGVER)) {
					uint8_t a = address - PIC16N_CONFIG_ADDR;
					if (a < PIC16N_CONFIG_MAX) {
						uint16_t mask = pic16n_map[pic16n_index].masks[a] |
							pic16n_map[pic16n_index].masks[a + 1] << 8;
						wdata &= mask;
						vdata &= mask;
					} else {
						if (p_f==0) {sprintf(buf, "%s: warning: config address invalid [%06X]\n",
							    __func__, address);
                            myprintf(buf);
                        }
					}
				}
			}
			if (vdata != wdata) {
				if (p_f == 0) {sprintf(buf, "%s: error: read [%04X] expected [%04X] at [%06X]\n",
					    __func__, vdata, wdata, address);
                     myprintf(buf);
				}
				pdata->bytes[i] = vdata;
				pdata->bytes[i + 1] = vdata >> 8;
				(*fail) += 2;
			}
			i += 2;
		}
	}
	return current_region;
}

/*
 * VIEW DATA
 */
void
pic16n_view_data(pic_data *pdata)
{
	sprintf(buf, "[%06X] ", pdata->address);
    myprintf(buf);
	for (uint32_t i = 0; i < pdata->nbytes; ++i) {
		sprintf(buf, "%02X ", pdata->bytes[i]);
        myprintf(buf);
    }
	sprintf(buf, "\n");
    myprintf(buf);
}

/*****************************************************************************
 *
 * Diagnostic functions
 *
 *****************************************************************************/

/*
 * DUMP DEVICE ID DETAILS
 */
void
pic16n_dumpdeviceid(void)
{
	uint32_t a, i, j;
	uint16_t word;

	sprintf(buf, "[000000] [PROGRAM]  %04X WORDS (%04X ROWS OF %04X WORDS)\n",
		pic16n_map[pic16n_index].flash,
		2 * pic16n_map[pic16n_index].flash / pic16n_map[pic16n_index].latches,
		pic16n_map[pic16n_index].latches / 2);
    myprintf(buf);

	if (pic16n_map[pic16n_index].idsize <= 16) {
		for (i = j = 0; i < pic16n_map[pic16n_index].idsize; i += 2, ++j) {
			word = pic16n_conf.userid[i] | pic16n_conf.userid[i + 1] << 8;
			sprintf(buf, "[%06X] [USERID%d]  %04X\n", PIC16N_USERID_ADDR + i, j, word);
            myprintf(buf);
		}
	} else for (i = 0; i < pic16n_map[pic16n_index].idsize; i += 16) {
		sprintf(buf, "[%04X] [USERID%02X] ", PIC16N_USERID_ADDR + i, i / 2);
        myprintf(buf);
		for (j = 0; j < 16; j += 2) {
			word = pic16n_conf.userid[i + j] | pic16n_conf.userid[i + j + 1] << 8;
			if (j != 14) {
				sprintf(buf, "%04X ", word);
			    myprintf(buf);
            } else {
				sprintf(buf, "%04X\n", word);
                myprintf(buf);
            }
		}
	}

	pic16n_dumpconfig(PIC_BRIEF, 0);

	if (pic16n_map[pic16n_index].eeprom) {
		if (pic16n_map[pic16n_index].datasheet == DS40002079D)
			a = PIC16N_EEPROM_ADDR_Q43;
		else
			a = PIC16N_EEPROM_ADDR;
		sprintf(buf, "[%06X] [DATA]     %04X BYTES\n", a, pic16n_map[pic16n_index].eeprom);
        myprintf(buf);
	}

	/* Device information area */
	if (pic16n_map[pic16n_index].devinfo) {
		if (pic16n_map[pic16n_index].datasheet == DS40002079D)
			a = PIC16N_DEVINFO_ADDR_Q43;
		else
			a = PIC16N_DEVINFO_ADDR;
		for (uint32_t i = 0; i < pic16n_map[pic16n_index].devinfo; i += 8) {
			sprintf(buf, "[%04X] [DEVINF%02X] ", a + 2 * i, 2 * i);
            myprintf(buf);
			uint32_t j;
			for (j = 0; j < 7; ++j) {
				sprintf(buf, "%04X ", pic16n_conf.devinfo[i + j]);
                myprintf(buf);
            }
			sprintf(buf, "%04X\n", pic16n_conf.devinfo[i + j]);
            myprintf(buf);
		}
	}

	/* Device configuration information */
	if (pic16n_map[pic16n_index].devconf) {
		sprintf(buf, "[%04X] [ERASE]    %04X\n", PIC16N_ERASE, pic16n_conf.devconf[0]);
        myprintf(buf);
		sprintf(buf, "[%04X] [LATCHES]  %04X\n", PIC16N_LATCHES, pic16n_conf.devconf[1]);
        myprintf(buf);
		sprintf(buf, "[%04X] [ROWS]     %04X\n", PIC16N_ROWS, pic16n_conf.devconf[2]);
        myprintf(buf);
		sprintf(buf, "[%04X] [EEPROM]   %04X\n", PIC16N_EEPROM, pic16n_conf.devconf[3]);
        myprintf(buf);
		sprintf(buf, "[%04X] [PINS]     %04X\n", PIC16N_PINS, pic16n_conf.devconf[4]);
        myprintf(buf);
	}

	sprintf(buf, "[3FFFFC] [REVISION] %04X MAJ:%02X MIN:%02X\n",
		pic16n_conf.revisionid,
		(pic16n_conf.revisionid >> PIC16N_MAJOR_SHIFT) & PIC16N_REV_MASK,
		pic16n_conf.revisionid & PIC16N_REV_MASK);
    myprintf(buf);
	sprintf(buf, "[3FFFFE] [DEVICEID] %04X %s\n", pic16n_conf.deviceid,	
		pic16n_map[pic16n_index].devicename);
    myprintf(buf);
}

/*
 * DUMP CONFIG WORD DETAILS FOR DEVICE
 */
void
pic16n_dumpconfig(uint32_t mode, uint32_t partition)
{
	if (pic16n_map[pic16n_index].datasheet == DS40002079D) {
		for (uint32_t i = 0; i < pic16n_map[pic16n_index].config; ++i) {
			sprintf(buf, "[%06X] [CONFIG%d] ", PIC16N_CONFIG_ADDR + i, i + 1);
            myprintf(buf);
			if (i < 9) {
				sprintf(buf, " ");
                myprintf(buf);
            }
			sprintf(buf, "%02X\n", pic16n_conf.config[i]);
            myprintf(buf);
		}
	} else {
		for (uint32_t i = 0; i < pic16n_map[pic16n_index].config; i += 2) {
			sprintf(buf, "[%06X] [CONFIG%d]  %04X\n",
				PIC16N_CONFIG_ADDR + i, i / 2 + 1,
				(pic16n_conf.config[i + 1] << 8) | pic16n_conf.config[i]);
            myprintf(buf);
		}
	}
#ifdef VERBOSE
	if (mode == PIC_VERBOSE) switch (pic16n_map[pic16n_index].datasheet) {
	default:break;
	}
#endif
}

/*
 * DUMP HEX FLASH WORDS
 */
void
pic16n_dumphexcode(uint32_t address, uint32_t size)
{
	uint32_t i, j, nlines = 0;
    SYS_FS_HANDLE fp;
    unsigned char databuf[16];
    uint32_t dataint[8];

	fp = SYS_FS_FileOpen("/mnt/mydrive/data.bin", (SYS_FS_FILE_OPEN_READ));
	for (i = 0; i < size; address += 16, i += 8) {
        SYS_FS_FileRead(fp, databuf,16);
        for (j = 0; j < 8; ++j) {
          dataint[j]=((uint32_t)databuf[2*j]<<8)|((uint32_t)databuf[2*j+1]);
        }
		if (pic_mtcode(PIC16N_WORD_MASK, 8, dataint))
			continue;
		sprintf(buf, "[%06X] ", address);
        myprintf(buf);
		for (j = 0; j < 8; ++j) {
			sprintf(buf, "%04X ", dataint[j] & PIC16N_WORD_MASK);
            myprintf(buf);
        }
		for (j = 0; j < 8; ++j) {
			sprintf(buf, "%c", PIC_CHAR(0xFF & dataint[j]));
            myprintf(buf);
			sprintf(buf, "%c", PIC_CHAR(0xFF & (dataint[j] >> 8)));
            myprintf(buf);
		}
		sprintf(buf, "\n");
        myprintf(buf);
		nlines++;
	}
    SYS_FS_FileClose(fp);
	if (!nlines) {
		sprintf(buf, "%s: information: flash empty\n", __func__);
        myprintf(buf);  
    }
}

/*
 * DUMP INHX32 FLASH WORDS
 */
void
pic16n_dumpinhxcode(uint32_t address, uint32_t size)
{
	uint32_t i, j;

	/* 16-bit: Extended address */
	pic_dumpaddr(address, 1, 0);
    SYS_FS_HANDLE fp;
    unsigned char databuf[16];
    uint32_t dataint[8];

	fp = SYS_FS_FileOpen("/mnt/mydrive/data.bin", (SYS_FS_FILE_OPEN_READ));
	for (i = 0; i < size; address += 16, i += 8) {
        SYS_FS_FileRead(fp, databuf,16);
        for (j = 0; j < 8; ++j) {
          dataint[j]=((uint32_t)databuf[2*j]<<8)|((uint32_t)databuf[2*j+1]);
        }
		if (pic_mtcode(PIC16N_WORD_MASK, 8, dataint))
			continue;
		/* 16-bit: Extended address */
		pic_dumpaddr(address, 0, 0);

		uint8_t cc, hb, lb;
		hb = address >> 8;
		lb = address;
		sprintf(buf, ":%02X%02X%02X00", 16, hb, lb);
        myprintf(buf);
		cc = 16 + hb + lb + 0x00;
		for (j = 0; j < 8; ++j) {
			lb = dataint[j];
			hb = dataint[j] >> 8;
			sprintf(buf, "%02X%02X", lb, hb);
            myprintf(buf);
			cc = cc + lb + hb;
		}
		sprintf(buf, "%02X\n", (0x0100 - cc) & 0xFF);
        myprintf(buf);
	}
    SYS_FS_FileClose(fp);
}

/*
 * DUMP HEX DATA EEPROM BYTES
 */
void
pic16n_dumphexdata(uint32_t address, uint32_t size)
{
	uint32_t i, j, nlines = 0;
    SYS_FS_HANDLE fp;
    unsigned char databuf[16];
    uint16_t dataint[16];

	fp = SYS_FS_FileOpen("/mnt/mydrive/data.bin", (SYS_FS_FILE_OPEN_READ));
	for (i = 0; i < size; address += 16, i += 16) {
        SYS_FS_FileRead(fp, databuf,16);
        for (j = 0; j < 16; ++j) {
          dataint[j]=(uint16_t)databuf[j];
        }
		if (pic_mtdata(0xFF, 16, dataint))
			continue;
		sprintf(buf, "[%06X] ", address);
        myprintf(buf);
		for (j = 0; j < 16; ++j) {
			sprintf(buf, "%02X ", dataint[j]);
            myprintf(buf);
        }
		for (j = 0; j < 16; ++j) {
			sprintf(buf, "%c", PIC_CHAR(0xFF & dataint[j]));
            myprintf(buf);
        }
		sprintf(buf, "\n");
        myprintf(buf);
		nlines++;
	}
	SYS_FS_FileClose(fp);
	if (!nlines) {
		sprintf(buf, "%s: information: data empty\n", __func__);
        myprintf(buf);
    }
}

/*
 * DUMP INHX32 DATA EEPROM BYTES
 */
void
pic16n_dumpinhxdata(uint32_t address, uint32_t size)
{
	uint32_t i, j;
    SYS_FS_HANDLE fp;
    unsigned char databuf[16];
    uint16_t dataint[16];

	/* PIC18: Extended address = 0x0031 / 0x0038 (EEPROM: 0x310000 / 0x38000) */
	if (pic16n_map[pic16n_index].datasheet == DS40002079D)
		pic_dumpaddr(PIC16N_EEPROM_ADDR_Q43, 1, 0);
	else
		pic_dumpaddr(PIC16N_EEPROM_ADDR, 1, 0);

	fp = SYS_FS_FileOpen("/mnt/mydrive/data.bin", (SYS_FS_FILE_OPEN_READ));
	for (i = 0; i < size; address += 16, i += 16) {
        SYS_FS_FileRead(fp, databuf,16);
        for (j = 0; j < 16; ++j) {
          dataint[j]=(uint16_t)databuf[j];
        }
		if (pic_mtdata(0xFF, 16, dataint))
			continue;

		uint8_t cc, hb, lb;
		hb = address >> 8;
		lb = address;
		sprintf(buf, ":%02X%02X%02X00", 16, hb, lb);
        myprintf(buf);
		cc = 16 + hb + lb + 0x00;
		for (j = 0; j < 16; ++j) {
			lb = dataint[j];
			sprintf(buf, "%02X", lb);
            myprintf(buf);
			cc = cc + lb;
		}
		sprintf(buf, "%02X\n", (0x0100 - cc) & 0xFF);
        myprintf(buf);
	}
    SYS_FS_FileClose(fp);
}

/*
 * DUMP INHX32 DEVICE CONFIGURATION
 */
void
pic16n_dumpdevice(void)
{
	uint32_t i;

	/* PIC18: Extended address = 0x0020 (USERID: 0x200000) */
	pic_dumpaddr(PIC16N_USERID_ADDR, 1, 0);

	for (i = 0; i < pic16n_map[pic16n_index].idsize; i += 2)
		pic_dumpword16(i / 2, pic16n_conf.userid[i] | pic16n_conf.userid[i + 1] << 8);

	/* PIC18: Extended address = 0x0030 (CONFIG: 0x300000) */
	pic_dumpaddr(PIC16N_CONFIG_ADDR, 1, 0);

	if (pic16n_map[pic16n_index].datasheet == DS40002079D) {
		for (i = 0; i < pic16n_map[pic16n_index].config; ++i)
			pic_dumpbyte(i, pic16n_conf.config[i]);
	} else {
		for (i = 0; i < pic16n_map[pic16n_index].config; i += 2)
			pic_dumpword16(i / 2, pic16n_conf.config[i] | pic16n_conf.config[i + 1] << 8);
	}
}
