From 925d0670c45e1100e412070fa0ce2405604f219a Mon Sep 17 00:00:00 2001
From: Attila Veghelyi <aveghelyi@dension.com>
Date: Thu, 29 Jun 2023 16:24:54 +0200
Subject: Init repo

---
 progP12.c | 666 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 666 insertions(+)
 create mode 100644 progP12.c

(limited to 'progP12.c')

diff --git a/progP12.c b/progP12.c
new file mode 100644
index 0000000..f86a44a
--- /dev/null
+++ b/progP12.c
@@ -0,0 +1,666 @@
+/**
+ * \file progP12.c - algorithms to program the PIC12 (12 bit word) family of microcontrollers
+ * Copyright (C) 2009-2016 Alberto Maccioni
+ *
+ * This program 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; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program 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 this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111 USA
+ * or see <http://www.gnu.org/licenses/>
+ */
+
+#include "common.h"
+
+void Read12F5xx(int dim,int dim2)
+// read 12 bit PIC
+// dim=program size 	dim2=config size
+// vdd before vpp
+// CONFIG @ 0x7FF (upon entering in program mode)
+// OSCCAL in last memory location
+// 4 ID + reserved area beyond code memory
+{
+	int k=0,z=0,i,j;
+	char s[256],t[256];
+	if(dim2<4) dim2=4;
+	sizeW=0x1000;
+	if(memCODE_W) free(memCODE_W);
+	memCODE_W=(WORD*)malloc(sizeof(WORD)*sizeW);
+	if(saveLog){
+		OpenLogFile();	//"Log.txt"
+		fprintf(logfile,"Read12F5xx(%d,%d)\n",dim,dim2);
+	}
+	unsigned int start=GetTickCount();
+	j=0;
+	bufferU[j++]=SET_PARAMETER;
+	bufferU[j++]=SET_T1T2;
+	bufferU[j++]=1;						//T1=1u
+	bufferU[j++]=100;					//T2=100u
+	bufferU[j++]=SET_PARAMETER;
+	bufferU[j++]=SET_T3;
+	bufferU[j++]=2000>>8;
+	bufferU[j++]=2000&0xff;
+	bufferU[j++]=EN_VPP_VCC;		//enter program mode
+	bufferU[j++]=0x0;
+	bufferU[j++]=SET_CK_D;
+	bufferU[j++]=0x0;
+	bufferU[j++]=EN_VPP_VCC;		//VDD
+	bufferU[j++]=0x1;
+	bufferU[j++]=EN_VPP_VCC;		//VDD+VPP
+	bufferU[j++]=0x5;
+	bufferU[j++]=NOP;
+	bufferU[j++]=READ_DATA_PROG;	//configuration word
+	bufferU[j++]=INC_ADDR;			// 7FF->000
+	bufferU[j++]=FLUSH;
+	for(;j<DIMBUF;j++) bufferU[j]=0x0;
+	PacketIO(2);
+	for(z=0;z<DIMBUF-2&&bufferI[z]!=READ_DATA_PROG;z++);
+	if(z<DIMBUF-2){
+		memCODE_W[0xfff]=(bufferI[z+1]<<8)+bufferI[z+2];
+		PrintMessage("\r\n");
+		PrintMessage1(strings[S_ConfigWord],memCODE_W[0xfff]);	//"\r\nConfiguration word: 0x%03X\r\n"
+		switch(memCODE_W[0xfff]&0x03){
+			case 0:
+				PrintMessage(strings[S_LPOsc]);	//"LP oscillator\r\n"
+				break;
+			case 1:
+				PrintMessage(strings[S_XTOsc]);	//"XT oscillator\r\n"
+				break;
+			case 2:
+				PrintMessage(strings[S_IntOsc]);	//"Internal osc.\r\n"
+				break;
+			case 3:
+				PrintMessage(strings[S_RCOsc]);	//"RC oscillator\r\n"
+				break;
+		}
+		if(memCODE_W[0xfff]&0x04) PrintMessage(strings[S_WDTON]);	//"WDT ON\r\n"
+		else PrintMessage(strings[S_WDTOFF]);	//"WDT OFF\r\n"
+		if(memCODE_W[0xfff]&0x08) PrintMessage(strings[S_CPOFF]);	//"Code protection OFF\r\n"
+		else PrintMessage(strings[S_CPON]);	//"Code protection ON\r\n"
+		if(memCODE_W[0xfff]&0x10) PrintMessage(strings[S_MCLRON]);	//"Master clear ON\r\n"
+		else PrintMessage(strings[S_MCLROFF]);	//"Master clear OFF\r\n"
+	}
+	else PrintMessage(strings[S_NoConfigW]);	//"Impossible to read config word\r\n"
+//****************** read code ********************
+	PrintMessage(strings[S_CodeReading1]);		//reading code ...
+	PrintStatusSetup();
+	for(i=0,j=0;i<dim+dim2;i++){
+		bufferU[j++]=READ_DATA_PROG;
+		bufferU[j++]=INC_ADDR;
+		if(j>DIMBUF*2/4-3||i==dim+dim2-1){		//2 ins -> 4 ans
+			bufferU[j++]=FLUSH;
+			for(;j<DIMBUF;j++) bufferU[j]=0x0;
+			PacketIO(5);
+			for(z=0;z<DIMBUF-2;z++){
+				if(bufferI[z]==READ_DATA_PROG){
+					memCODE_W[k++]=(bufferI[z+1]<<8)+bufferI[z+2];
+					z+=2;
+				}
+			}
+			PrintStatus(strings[S_CodeReading],i*100/(dim+dim2),i);	//"Read: %d%%, addr. %03X"
+			j=0;
+			if(saveLog){
+				fprintf(logfile,strings[S_Log7],i,i,k,k);	//"i=%d(0x%X), k=%d(0x%X)\n"
+			}
+		}
+	}
+	PrintStatusEnd();
+	bufferU[j++]=NOP;				//exit program mode
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x1;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x0;
+	bufferU[j++]=SET_CK_D;
+	bufferU[j++]=0x0;
+	bufferU[j++]=FLUSH;
+	for(;j<DIMBUF;j++) bufferU[j]=0x0;
+	PacketIO(1);
+	unsigned int stop=GetTickCount();
+	for(i=k;i<0xfff;i++) memCODE_W[i]=0xfff;
+	if(k!=dim+dim2){
+		PrintMessage("\r\n");
+		PrintMessage2(strings[S_ReadErr],dim+dim2,k);	//"Error reading, requested %d words, read %d\r\n"
+	}
+	else PrintMessage(strings[S_Compl]);
+//****************** visualize ********************
+	for(i=0;i<4;i+=2){
+		PrintMessage4(strings[S_ChipID],i,memCODE_W[dim+i],i+1,memCODE_W[dim+i+1]);	//"ID%d: 0x%03X   ID%d: 0x%03X\r\n"
+	}
+	if(dim2>4){
+		PrintMessage1(strings[S_BKOsccal],memCODE_W[dim+4]);	//"Backup OSCCAL: 0x%03X\r\n"
+	}
+	PrintMessage(strings[S_CodeMem]);	//"\r\nCode memory\r\n"
+	s[0]=0;
+	int valid=0,empty=1;
+	char* aux=(char*)malloc((dim/COL+1)*(16+COL*5));
+	aux[0]=0;
+	for(i=0;i<dim;i+=COL){
+		valid=0;
+		for(j=i;j<i+COL&&j<dim;j++){
+			sprintf(t,"%03X ",memCODE_W[j]);
+			strcat(s,t);
+			if(memCODE_W[j]<0xfff) valid=1;
+		}
+		if(valid){
+			sprintf(t,"%04X: %s\r\n",i,s);
+			empty=0;
+			strcat(aux,t);
+		}
+		s[0]=0;
+	}
+	if(empty) PrintMessage(strings[S_Empty]);	//empty
+	else PrintMessage(aux);
+	free(aux);
+	if(dim2>5){
+		aux=(char*)malloc((dim2/COL+1)*(16+COL*5));
+		aux[0]=0;
+		s[0]=0;
+		PrintMessage(strings[S_ConfigResMem]);	//"\r\nConfig and reserved memory:\r\n"
+		empty=1;
+		for(i=dim;i<dim+dim2;i+=COL){
+			valid=0;
+			for(j=i;j<i+COL&&j<dim+64;j++){
+				sprintf(t,"%03X ",memCODE_W[j]);
+				strcat(s,t);
+				if(memCODE_W[j]<0xfff) valid=1;
+			}
+			if(valid){
+				sprintf(t,"%04X: %s\r\n",i,s);
+				empty=0;
+				strcat(aux,t);
+			}
+			s[0]=0;
+		}
+		if(empty) PrintMessage(strings[S_Empty]);	//empty
+		else PrintMessage(aux);
+		free(aux);
+	}
+	sprintf(str,strings[S_End],(stop-start)/1000.0);	//"\r\nEnd (%.2f s)\r\n"
+	PrintMessage(str);
+	if(saveLog){
+		fprintf(logfile,str);
+		CloseLogFile();
+	}
+	PrintStatusClear();			//clear status report
+}
+
+void Write12F5xx(int dim,int OscAddr)
+{
+// write 12 bit PIC
+// dim=program size     max~4300=10CC
+// OscAddr=OSCCAL address (saved at the beginning), -1 not to use it
+// vdd before vpp
+// CONFIG @ 0x7FF upon entering program mode
+// BACKUP OSCCAL @ dim+5 (saved at the beginning)
+// erase: BULK_ERASE_PROG (1001) +10ms
+// write: BEGIN_PROG (1000) + Tprogram 2ms + END_PROG2 (1110);
+	int k=0,z=0,i,j,w;
+	int err=0;
+	WORD osccal=-1,BKosccal=-1;
+	if(OscAddr>dim) OscAddr=dim-1;
+	if(OscAddr==-1) use_BKosccal=use_osccal=0;
+	if(sizeW<0x1000){
+		PrintMessage(strings[S_NoConfigW2]);	//"Can't find CONFIG (0xFFF)\r\n"
+		return;
+	}
+	if(saveLog){
+		OpenLogFile();	//"Log.txt"
+		fprintf(logfile,"Write12F5xx(%d,%d)\n",dim,OscAddr);
+	}
+	for(i=0;i<sizeW;i++) memCODE_W[i]&=0xFFF;
+	unsigned int start=GetTickCount();
+	j=0;
+	bufferU[j++]=SET_PARAMETER;
+	bufferU[j++]=SET_T1T2;
+	bufferU[j++]=1;						//T1=1u
+	bufferU[j++]=100;					//T2=100u
+	bufferU[j++]=EN_VPP_VCC;		//enter program mode
+	bufferU[j++]=0x0;
+	bufferU[j++]=SET_CK_D;
+	bufferU[j++]=0x0;
+	bufferU[j++]=EN_VPP_VCC;		//VDD
+	bufferU[j++]=0x1;
+	bufferU[j++]=NOP;
+	bufferU[j++]=EN_VPP_VCC;		//VDD+VPP
+	bufferU[j++]=0x5;
+	bufferU[j++]=NOP;
+	if(OscAddr!=-1){
+		for(i=-1;i<OscAddr-0xff;i+=0xff){
+			bufferU[j++]=INC_ADDR_N;
+			bufferU[j++]=0xff;
+		}
+		bufferU[j++]=INC_ADDR_N;
+		bufferU[j++]=OscAddr-i;
+		bufferU[j++]=READ_DATA_PROG;	// OSCCAL
+		if(OscAddr<dim){
+			bufferU[j++]=INC_ADDR_N;
+			bufferU[j++]=dim-OscAddr;
+		}
+		bufferU[j++]=INC_ADDR_N;
+		bufferU[j++]=0x4;				// 400->404
+		bufferU[j++]=READ_DATA_PROG;	// backup OSCCAL
+	}
+	bufferU[j++]=NOP;				//exit program mode
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x1;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x0;
+	bufferU[j++]=SET_CK_D;
+	bufferU[j++]=0x0;
+	bufferU[j++]=SET_PARAMETER;
+	bufferU[j++]=SET_T3;
+	bufferU[j++]=10000>>8;
+	bufferU[j++]=10000&0xff;
+	bufferU[j++]=WAIT_T3;
+	bufferU[j++]=FLUSH;
+	for(;j<DIMBUF;j++) bufferU[j]=0x0;
+	PacketIO(15);
+	if(OscAddr!=-1){
+		for(z=4;z<DIMBUF-2&&bufferI[z]!=READ_DATA_PROG;z++);
+		if(z<DIMBUF-2) osccal=(bufferI[z+1]<<8)+bufferI[z+2];
+		for(z+=3;z<DIMBUF-2&&bufferI[z]!=READ_DATA_PROG;z++);
+		if(z<DIMBUF-2) BKosccal=(bufferI[z+1]<<8)+bufferI[z+2];
+		if(osccal==-1||BKosccal==-1){
+			PrintMessage(strings[S_ErrOsccal]);	//"Error reading OSCCAL and BKOSCCAL"
+			PrintMessage("\r\n");
+			return;
+		}
+		PrintMessage1(strings[S_Osccal],osccal);	//"OSCCAL: 0x%03X\r\n"
+		PrintMessage1(strings[S_BKOsccal],BKosccal);	//"Backup OSCCAL: 0x%03X\r\n"
+ 	}
+//****************** erase memory ********************
+	PrintMessage(strings[S_StartErase]);	//"Erase ... "
+	j=0;
+	bufferU[j++]=EN_VPP_VCC;			// enter program mode
+	bufferU[j++]=0x1;
+	bufferU[j++]=NOP;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x5;
+	if(dim>OscAddr+1){				//12F519 (Flash+EEPROM)
+		bufferU[j++]=BULK_ERASE_PROG;	// Bulk erase
+		bufferU[j++]=WAIT_T3;			// delay T3=10ms
+		for(i=-1;i<dim-0xff;i+=0xff){	// 0x43F
+			bufferU[j++]=INC_ADDR_N;
+			bufferU[j++]=0xff;
+		}
+		bufferU[j++]=INC_ADDR_N;
+		bufferU[j++]=dim-i-1;
+		bufferU[j++]=BULK_ERASE_PROG;	// Bulk erase EEPROM
+		bufferU[j++]=WAIT_T3;			// delay T3=10ms
+		if(programID){
+			bufferU[j++]=INC_ADDR;
+			bufferU[j++]=BULK_ERASE_PROG;	// Bulk erase
+			bufferU[j++]=WAIT_T3;			// delay T3=10ms
+		}
+	}
+	else{							//12Fxxx
+		if(programID){
+			for(i=-1;i<dim-0xff;i+=0xff){
+				bufferU[j++]=INC_ADDR_N;
+				bufferU[j++]=0xff;
+			}
+			bufferU[j++]=INC_ADDR_N;
+			bufferU[j++]=dim-i;
+			bufferU[j++]=BULK_ERASE_PROG;	// Bulk erase
+			bufferU[j++]=WAIT_T3;			// delay T3=10ms
+		}
+		else{
+			bufferU[j++]=BULK_ERASE_PROG;	// Bulk erase
+			bufferU[j++]=WAIT_T3;			// delay T3=10ms
+		}
+	}
+	bufferU[j++]=EN_VPP_VCC;		// exit program mode
+	bufferU[j++]=0x1;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x0;
+	bufferU[j++]=WAIT_T3;			// delay T3=10ms before entering program mode
+	bufferU[j++]=EN_VPP_VCC;		// enter program mode
+	bufferU[j++]=0x1;
+	bufferU[j++]=NOP;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x5;
+	bufferU[j++]=INC_ADDR;				// 7FF->000
+	bufferU[j++]=SET_PARAMETER;
+	bufferU[j++]=SET_T3;
+	bufferU[j++]=2000>>8;				//T3=2ms
+	bufferU[j++]=2000&0xff;
+	bufferU[j++]=FLUSH;
+	for(;j<DIMBUF;j++) bufferU[j]=0x0;
+	PacketIO((dim>OscAddr+1)?50:30);
+	PrintMessage(strings[S_Compl]);	//"completed\r\n"
+//****************** write code ********************
+	PrintMessage(strings[S_StartCodeProg]);	//"Write code ... "
+	PrintStatusSetup();
+	int dim1=dim;
+	if(programID) dim1=dim+5;
+	if(memCODE_W[dim+4]>=0xFFF) memCODE_W[dim+4]=BKosccal;  //reload BKosccal if not present
+	if(use_BKosccal) memCODE_W[OscAddr]=BKosccal;
+	else if(use_osccal) memCODE_W[OscAddr]=osccal;
+	for(i=k=w=0,j=0;i<dim1;i++){
+		if(memCODE_W[i]<0xfff){
+			bufferU[j++]=LOAD_DATA_PROG;
+			bufferU[j++]=memCODE_W[i]>>8;		//MSB
+			bufferU[j++]=memCODE_W[i]&0xff;		//LSB
+			bufferU[j++]=BEGIN_PROG;
+			bufferU[j++]=WAIT_T3;				//Tprogram 2ms
+			bufferU[j++]=END_PROG2;
+			bufferU[j++]=WAIT_T2;				//Tdischarge
+			bufferU[j++]=READ_DATA_PROG;
+			w++;
+		}
+		bufferU[j++]=INC_ADDR;
+		if(j>DIMBUF-10||i==dim1-1){
+			PrintStatus(strings[S_CodeWriting],i*100/dim,i);	//"Write: %d%%, ind. %03X"
+			bufferU[j++]=FLUSH;
+			for(;j<DIMBUF;j++) bufferU[j]=0x0;
+			PacketIO(w*3+3);
+			w=0;
+			for(z=0;z<DIMBUF-7;z++){
+				if(bufferI[z]==INC_ADDR&&memCODE_W[k]>=0xfff) k++;
+				else if(bufferI[z]==LOAD_DATA_PROG&&bufferI[z+5]==READ_DATA_PROG){
+					if (memCODE_W[k]!=(bufferI[z+6]<<8)+bufferI[z+7]){
+						PrintMessage("\r\n");
+						PrintMessage3(strings[S_CodeWError],k,memCODE_W[k],(bufferI[z+6]<<8)+bufferI[z+7]);	//"Error writing address %3X: written %03X, read %03X"
+						err++;
+						if(max_err&&err>max_err){
+							PrintMessage1(strings[S_MaxErr],err);	//"Exceeded maximum number of errors (%d), write interrupted\r\n"
+							PrintMessage(strings[S_IntW]);	//"write interrupted"
+							i=dim1;
+							z=DIMBUF;
+						}
+					}
+					k++;
+					z+=8;
+				}
+			}
+			j=0;
+			if(saveLog){
+				fprintf(logfile,strings[S_Log8],i,i,k,k,err);	//"i=%d, k=%d, errors=%d\n"
+			}
+		}
+	}
+	PrintStatusEnd();
+	err+=i-k;
+	PrintMessage1(strings[S_ComplErr],err);	//"completed, %d errors\r\n"
+//****************** write CONFIG ********************
+	PrintMessage(strings[S_ConfigW]);	//"Write CONFIG ... "
+	int err_c=0;
+	bufferU[j++]=NOP;				//exit program mode
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x1;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x0;
+	bufferU[j++]=SET_CK_D;
+	bufferU[j++]=0x0;
+	bufferU[j++]=WAIT_T3;			//10 ms tra uscita e rientro prog. mode
+	bufferU[j++]=WAIT_T3;
+	bufferU[j++]=WAIT_T3;
+	bufferU[j++]=WAIT_T3;
+	bufferU[j++]=WAIT_T3;
+	bufferU[j++]=EN_VPP_VCC;		//enter program mode
+	bufferU[j++]=0x1;
+	bufferU[j++]=NOP;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x5;
+	bufferU[j++]=LOAD_DATA_PROG;	//config word
+	bufferU[j++]=memCODE_W[0xfff]>>8;			//MSB
+	bufferU[j++]=memCODE_W[0xfff]&0xff;			//LSB
+	bufferU[j++]=BEGIN_PROG;
+	bufferU[j++]=WAIT_T3;			//Tprogram 2ms
+	bufferU[j++]=END_PROG2;
+	bufferU[j++]=WAIT_T2;			//Tdischarge
+	bufferU[j++]=READ_DATA_PROG;
+	bufferU[j++]=NOP;				//exit program mode
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x1;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x0;
+	bufferU[j++]=SET_CK_D;
+	bufferU[j++]=0x0;
+	bufferU[j++]=FLUSH;
+	for(;j<DIMBUF;j++) bufferU[j]=0x0;
+	PacketIO(20);
+	unsigned int stop=GetTickCount();
+	for(z=0;z<DIMBUF-2&&bufferI[z]!=READ_DATA_PROG;z++);
+	if (~memCODE_W[0xfff]&((bufferI[z+1]<<8)+bufferI[z+2])){	//error if written 0 and read 1 (~W&R)
+		PrintMessage("\r\n");
+		PrintMessage2(strings[S_ConfigWErr],memCODE_W[0xfff],(bufferI[z+1]<<8)+bufferI[z+2]);	//"Error writing CONFIG:\r\nwritten %03X, read %03X\r\n"
+		err_c++;
+	}
+	err+=err_c;
+	if (z>DIMBUF-2){
+		PrintMessage("\r\n");
+		PrintMessage(strings[S_ConfigWErr2]);	//"Error writing CONFIG"
+	}
+	PrintMessage1(strings[S_ComplErr],err_c);	//"completed, %d errors\r\n"
+	if(saveLog){
+		fprintf(logfile,strings[S_Log8],i,i,k,k,err);	//"i=%d, k=%d, errors=%d\n"
+	}
+	sprintf(str,strings[S_EndErr],(stop-start)/1000.0,err,err!=1?strings[S_ErrPlur]:strings[S_ErrSing]);	//"\r\nEnd (%.2f s) %d %s\r\n\r\n"
+	PrintMessage(str);
+	if(saveLog){
+		fprintf(logfile,str);
+		CloseLogFile();
+	}
+	PrintStatusClear();			//clear status report
+}
+
+void Write12C5xx(int dim,int dummy)
+{
+// write 12 bit PIC with OTP
+// dim=program size     max~4300=10CC
+// vdd before vpp
+// CONFIG @ 0x7FF upon entering program mode
+// write: BEGIN_PROG (1000) + Tprogram 100us + END_PROG2 (1110);
+// 8 pulses + 11N overpulses
+	int k=0,z=0,i,j;
+	int err=0;
+	WORD osccal=-1;
+	int OscAddr=dim-1;
+	if(FWVersion<0x800){
+		PrintMessage1(strings[S_FWver2old],"0.8.0");	//"This firmware is too old. Version %s is required\r\n"
+		return;
+	}
+	if(sizeW<0x1000){
+		PrintMessage(strings[S_NoConfigW2]);	//"Can't find CONFIG (0xFFF)\r\n"
+		return;
+	}
+	if(saveLog){
+		OpenLogFile();	//"Log.txt"
+		fprintf(logfile,"Write12C5xx(%d)\n",dim);
+	}
+	for(i=0;i<sizeW;i++) memCODE_W[i]&=0xFFF;
+	unsigned int start=GetTickCount();
+	j=0;
+	bufferU[j++]=SET_PARAMETER;
+	bufferU[j++]=SET_T1T2;
+	bufferU[j++]=1;						//T1=1u
+	bufferU[j++]=100;					//T2=100u
+	bufferU[j++]=SET_PARAMETER;
+	bufferU[j++]=SET_MN;
+	bufferU[j++]=8;						//M=8 pulses
+	bufferU[j++]=11;					//N=11 overpulses
+	bufferU[j++]=EN_VPP_VCC;		//enter program mode
+	bufferU[j++]=0x0;
+	bufferU[j++]=SET_CK_D;
+	bufferU[j++]=0x0;
+	bufferU[j++]=EN_VPP_VCC;		//VDD
+	bufferU[j++]=0x1;
+	bufferU[j++]=NOP;
+	bufferU[j++]=EN_VPP_VCC;		//VDD+VPP
+	bufferU[j++]=0x5;
+	bufferU[j++]=NOP;
+	for(i=-1;i<OscAddr-0xff;i+=0xff){
+		bufferU[j++]=INC_ADDR_N;
+		bufferU[j++]=0xff;
+	}
+	bufferU[j++]=INC_ADDR_N;
+	bufferU[j++]=OscAddr-i;
+	bufferU[j++]=READ_DATA_PROG;	// OSCCAL
+	bufferU[j++]=NOP;				//exit program mode
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x1;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x0;
+	bufferU[j++]=SET_CK_D;
+	bufferU[j++]=0x0;
+	bufferU[j++]=SET_PARAMETER;
+	bufferU[j++]=SET_T3;
+	bufferU[j++]=10000>>8;
+	bufferU[j++]=10000&0xff;
+	bufferU[j++]=WAIT_T3;
+	bufferU[j++]=FLUSH;
+	for(;j<DIMBUF;j++) bufferU[j]=0x0;
+	PacketIO(15);
+	j=0;
+	for(z=4;z<DIMBUF-2&&bufferI[z]!=READ_DATA_PROG;z++);
+	if(z<DIMBUF-2) osccal=(bufferI[z+1]<<8)+bufferI[z+2];
+	if(osccal==-1){
+		PrintMessage(strings[S_ErrOsccal]);	//"Error reading OSCCAL and BKOSCCAL"
+		PrintMessage("\r\n");
+		return;
+	}
+	PrintMessage1(strings[S_Osccal],osccal);	//"OSCCAL: 0x%03X\r\n"
+	bufferU[j++]=EN_VPP_VCC;		// enter program mode
+	bufferU[j++]=0x1;
+	bufferU[j++]=NOP;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x5;
+	bufferU[j++]=INC_ADDR;				// 7FF->000
+	bufferU[j++]=READ_ADC;
+	bufferU[j++]=FLUSH;
+	for(;j<DIMBUF;j++) bufferU[j]=0x0;
+	PacketIO(2);
+	j=0;
+//****************** write code ********************
+	PrintMessage(strings[S_StartCodeProg]);	//"Write code ... "
+	PrintStatusSetup();
+	int N,Nt=0,Nmin=255,Nmax=0,xN=0;
+	int dim1=dim;
+	if(programID) dim1=dim+5;
+	if(use_osccal) memCODE_W[OscAddr]=osccal;
+	for(i=k=0,j=0;i<dim1;i++){
+		if(memCODE_W[i]<0xfff){
+			bufferU[j++]=PROG_C;				//prog&verify with 8 pulses and 11N overpulses
+			bufferU[j++]=memCODE_W[i]>>8;		//MSB
+			bufferU[j++]=memCODE_W[i]&0xff;		//LSB
+			bufferU[j++]=READ_DATA_PROG;
+			bufferU[j++]=READ_ADC;
+			bufferU[j++]=INC_ADDR;
+		}
+		else{
+			for(;memCODE_W[i]>=0xfff&&j<DIMBUF-1&&i<dim1;i++) bufferU[j++]=INC_ADDR;
+			i--;
+		}
+		PrintStatus(strings[S_CodeWriting],i*100/dim,i);	//"Write: %d%%, ind. %03X"
+		bufferU[j++]=FLUSH;
+		for(;j<DIMBUF;j++) bufferU[j]=0x0;
+		PacketIO(10+3);			//Tprogram max 100u*96 ~ 10ms
+		j=0;
+		if(bufferI[1]==PROG_C&&bufferI[3]==READ_DATA_PROG){
+			N=bufferI[2];
+				if(N<0xF0){
+					Nt+=N;
+					xN++;
+					if(N<Nmin)Nmin=N;
+					if(N>Nmax)Nmax=N;
+				}
+			if(memCODE_W[k]!=(bufferI[4]<<8)+bufferI[5]){
+					PrintMessage("\r\n");
+				PrintMessage3(strings[S_CodeWError],k,memCODE_W[k],(bufferI[4]<<8)+bufferI[5]);	//"Error writing address %3X: written %03X, read %03X"
+					err++;
+					if(max_err&&err>max_err){
+						PrintMessage1(strings[S_MaxErr],err);	//"Exceeded maximum number of errors (%d), write interrupted\r\n"
+						PrintMessage(strings[S_IntW]);	//"write interrupted"
+						i=dim1;
+						z=DIMBUF;
+					}
+				}
+				k++;
+				}
+		else for(z=0;z<DIMBUF;z++){
+			if(bufferI[z]==INC_ADDR&&memCODE_W[k]>=0xfff) k++;
+		}
+		if(saveLog){
+			fprintf(logfile,strings[S_Log8],i,i,k,k,err);	//"i=%d, k=%d, errors=%d\n"
+		}
+	}
+	PrintStatusEnd();
+	err+=i-k;
+	PrintMessage1(strings[S_ComplErr],err);	//"completed, %d errors\r\n"
+	if(saveLog && xN) fprintf(logfile,"Programming pulses: avg %.1f, min %d, max %d\r\n",(double)Nt/xN,Nmin,Nmax);
+//****************** write CONFIG ********************
+	if(memCODE_W[0xfff]<0xfff){
+	PrintMessage(strings[S_ConfigW]);	//"Write CONFIG ... "
+	int err_c=0;
+	bufferU[j++]=EN_VPP_VCC;		//exit program mode
+	bufferU[j++]=0x1;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x0;
+	bufferU[j++]=WAIT_T3;			//10 ms
+	bufferU[j++]=EN_VPP_VCC;		//enter program mode
+	bufferU[j++]=0x1;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x5;
+	bufferU[j++]=LOAD_DATA_PROG;	//config word
+	bufferU[j++]=memCODE_W[0xfff]>>8;			//MSB
+	bufferU[j++]=memCODE_W[0xfff]&0xff;			//LSB
+	bufferU[j++]=FLUSH;
+	for(;j<DIMBUF;j++) bufferU[j]=0x0;
+	PacketIO(12);
+	j=0;
+	for(i=0;i<20;i++){		//20 pulses
+		bufferU[j++]=BEGIN_PROG;
+		bufferU[j++]=WAIT_T2;			//Tprogram 100us
+		bufferU[j++]=END_PROG2;
+	}
+	bufferU[j++]=FLUSH;
+	for(;j<DIMBUF;j++) bufferU[j]=0x0;
+	j=0;
+	for(i=0;i<5;i++){		//20*5=100 pulses
+		PacketIO(3);
+	}
+	bufferU[j++]=READ_DATA_PROG;
+		bufferU[j++]=FLUSH;
+		for(;j<DIMBUF;j++) bufferU[j]=0x0;
+		PacketIO(2);
+		j=0;
+		if (~memCODE_W[0xfff]&((bufferI[2]<<8)+bufferI[3])){	//error if written 0 and read 1 (~W&R)
+			PrintMessage("\r\n");
+			PrintMessage2(strings[S_ConfigWErr],memCODE_W[0xfff],(bufferI[2]<<8)+bufferI[3]);	//"Error writing CONFIG:\r\nwritten %03X, read %03X\r\n"
+			err_c++;
+		}
+		err+=err_c;
+	}
+	PrintMessage1(strings[S_ComplErr],err);	//"completed, %d errors\r\n"
+//****************** exit ********************
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x1;
+	bufferU[j++]=EN_VPP_VCC;
+	bufferU[j++]=0x0;
+	bufferU[j++]=SET_CK_D;
+	bufferU[j++]=0x0;
+	bufferU[j++]=FLUSH;
+	for(;j<DIMBUF;j++) bufferU[j]=0x0;
+	PacketIO(2);
+	j=0;
+	unsigned int stop=GetTickCount();
+	if(saveLog){
+		fprintf(logfile,strings[S_Log8],i,i,k,k,err);	//"i=%d, k=%d, errors=%d\n"
+	}
+	sprintf(str,strings[S_EndErr],(stop-start)/1000.0,err,err!=1?strings[S_ErrPlur]:strings[S_ErrSing]);	//"\r\nEnd (%.2f s) %d %s\r\n\r\n"
+	PrintMessage(str);
+	if(saveLog){
+		fprintf(logfile,str);
+		CloseLogFile();
+	}
+	PrintStatusClear();			//clear status report
+}
-- 
cgit v1.2.3-54-g00ecf