* src/pic/device.c,
[fw/sdcc] / src / pic / pcode.c
index fc5de12cc524b57ec1f5c9a21e6d39f7dec4db1e..daa0a9f3392ac7e9fff2aff594fd9de2b5fe28a2 100644 (file)
 
 
 #include "pcode.h"
+#include "pcodeflow.h"
 #include "ralloc.h"
+#include "device.h"
+
+pCode *findFunction(char *fname);
+
+static void FixRegisterBanking(pBlock *pb,int cur_bank);
 
 #if defined(__BORLANDC__) || defined(_MSC_VER)
 #define STRCASECMP stricmp
 #define STRCASECMP strcasecmp
 #endif
 
+/****************************************************************/
+/****************************************************************/
+
+peepCommand peepCommands[] = {
+
+  {NOTBITSKIP, "_NOTBITSKIP_"},
+  {BITSKIP, "_BITSKIP_"},
+  {INVERTBITSKIP, "_INVERTBITSKIP_"},
+
+  {-1, NULL}
+};
+
+
+
 // Eventually this will go into device dependent files:
-pCodeOpReg pc_status    = {{PO_STATUS,  "STATUS"}, -1, NULL,NULL};
-pCodeOpReg pc_indf      = {{PO_INDF,    "INDF"}, -1, NULL,NULL};
-pCodeOpReg pc_fsr       = {{PO_FSR,     "FSR"}, -1, NULL,NULL};
-pCodeOpReg pc_pcl       = {{PO_PCL,     "PCL"}, -1, NULL,NULL};
-pCodeOpReg pc_pclath    = {{PO_PCLATH,  "PCLATH"}, -1, NULL,NULL};
+pCodeOpReg pc_status    = {{PO_STATUS,  "STATUS"}, -1, NULL,0,NULL};
+pCodeOpReg pc_indf      = {{PO_INDF,    "INDF"}, -1, NULL,0,NULL};
+pCodeOpReg pc_fsr       = {{PO_FSR,     "FSR"}, -1, NULL,0,NULL};
+pCodeOpReg pc_intcon    = {{PO_INTCON,  ""}, -1, NULL,0,NULL};
+pCodeOpReg pc_pcl       = {{PO_PCL,     "PCL"}, -1, NULL,0,NULL};
+pCodeOpReg pc_pclath    = {{PO_PCLATH,  "PCLATH"}, -1, NULL,0,NULL};
 
-static int mnemonics_initialized = 0;
+pCodeOpReg pc_wsave     = {{PO_GPR_REGISTER,  "WSAVE"}, -1, NULL,0,NULL};
+pCodeOpReg pc_ssave     = {{PO_GPR_REGISTER,  "SSAVE"}, -1, NULL,0,NULL};
+pCodeOpReg pc_psave     = {{PO_GPR_REGISTER,  "PSAVE"}, -1, NULL,0,NULL};
 
+static int mnemonics_initialized = 0;
 
 static hTab *pic14MnemonicsHash = NULL;
-
+static hTab *pic14pCodePeepCommandsHash = NULL;
 
 
 static pFile *the_pFile = NULL;
-static int peepOptimizing = 1;
-static int GpCodeSequenceNumber = 1;
+static pBlock *pb_dead_pcodes = NULL;
+
+/* Hardcoded flags to change the behavior of the PIC port */
+static int peepOptimizing = 1;        /* run the peephole optimizer if nonzero */
+static int functionInlining = 1;      /* inline functions if nonzero */
+int debug_verbose = 0;                /* Set true to inundate .asm file */
+
+// static int GpCodeSequenceNumber = 1;
+int GpcFlowSeq = 1;
+
+unsigned maxIdx; /* This keeps track of the maximum register index for call tree register reuse */
+unsigned peakIdx; /* This keeps track of the peak register index for call tree register reuse */
+
+extern void RemoveUnusedRegisters(void);
+extern void RegsUnMapLiveRanges(void);
+extern void BuildFlowTree(pBlock *pb);
+extern void pCodeRegOptimizeRegUsage(int level);
+extern int picIsInitialized(void);
 
 /****************************************************************/
 /*                      Forward declarations                    */
 /****************************************************************/
 
-static void unlinkPC(pCode *pc);
+void unlinkpCode(pCode *pc);
+#if 0
 static void genericAnalyze(pCode *pc);
 static void AnalyzeGOTO(pCode *pc);
 static void AnalyzeSKIP(pCode *pc);
 static void AnalyzeRETURN(pCode *pc);
+#endif
 
 static void genericDestruct(pCode *pc);
 static void genericPrint(FILE *of,pCode *pc);
@@ -67,676 +109,1163 @@ static void genericPrint(FILE *of,pCode *pc);
 static void pCodePrintLabel(FILE *of, pCode *pc);
 static void pCodePrintFunction(FILE *of, pCode *pc);
 static void pCodeOpPrint(FILE *of, pCodeOp *pcop);
-static char *get_op( pCodeInstruction *pcc);
+static char *get_op_from_instruction( pCodeInstruction *pcc);
+char *get_op( pCodeOp *pcop,char *buff,size_t buf_size);
 int pCodePeepMatchLine(pCodePeep *peepBlock, pCode *pcs, pCode *pcd);
 int pCodePeepMatchRule(pCode *pc);
+void pBlockStats(FILE *of, pBlock *pb);
+pBlock *newpBlock(void);
+pCodeOp *popCopyGPR2Bit(pCodeOp *pc, int bitval);
+void pCodeRegMapLiveRanges(pBlock *pb);
 
 
+/****************************************************************/
+/*                    PIC Instructions                          */
+/****************************************************************/
+
 pCodeInstruction pciADDWF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_ADDWF,
   "ADDWF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_W | PCC_REGISTER),   // inCond
   (PCC_REGISTER | PCC_Z) // outCond
 };
 
 pCodeInstruction pciADDFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
-  POC_ADDWF,
+  POC_ADDFW,
   "ADDWF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_W | PCC_REGISTER),   // inCond
   (PCC_W | PCC_Z) // outCond
 };
 
 pCodeInstruction pciADDLW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_ADDLW,
   "ADDLW",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
-  PCC_W,   // inCond
+  0,0,  // branch, skip
+  1,    // literal operand
+  POC_NOP,
+  (PCC_W | PCC_LITERAL),   // inCond
   (PCC_W | PCC_Z | PCC_C | PCC_DC) // outCond
 };
 
 pCodeInstruction pciANDLW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_ANDLW,
   "ANDLW",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
-  PCC_W,   // inCond
+  0,0,  // branch, skip
+  1,    // literal operand
+  POC_NOP,
+  (PCC_W | PCC_LITERAL),   // inCond
   (PCC_W | PCC_Z) // outCond
 };
 
 pCodeInstruction pciANDWF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_ANDWF,
   "ANDWF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_W | PCC_REGISTER),   // inCond
   (PCC_REGISTER | PCC_Z) // outCond
 };
 
 pCodeInstruction pciANDFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
-  POC_ANDWF,
+  POC_ANDFW,
   "ANDWF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_W | PCC_REGISTER),   // inCond
   (PCC_W | PCC_Z) // outCond
 };
 
 pCodeInstruction pciBCF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_BCF,
   "BCF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
-  0,1,  // dest, bit instruction
-  PCC_NONE,   // inCond
-  PCC_EXAMINE_PCOP // outCond
+  1,1,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_BSF,
+  (PCC_REGISTER | PCC_EXAMINE_PCOP),   // inCond
+  PCC_REGISTER // outCond
 };
 
 pCodeInstruction pciBSF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_BSF,
   "BSF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
-  0,1,  // dest, bit instruction
-  PCC_NONE,   // inCond
-  PCC_EXAMINE_PCOP // outCond
+  1,1,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_BCF,
+  (PCC_REGISTER | PCC_EXAMINE_PCOP),   // inCond
+  (PCC_REGISTER | PCC_EXAMINE_PCOP) // outCond
 };
 
 pCodeInstruction pciBTFSC = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   AnalyzeSKIP,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   AnalyzeSKIP,
    genericDestruct,
    genericPrint},
   POC_BTFSC,
   "BTFSC",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,1,  // dest, bit instruction
-  PCC_EXAMINE_PCOP,   // inCond
-  PCC_NONE // outCond
+  1,1,  // branch, skip
+  0,    // literal operand
+  POC_BTFSS,
+  (PCC_REGISTER | PCC_EXAMINE_PCOP),   // inCond
+  PCC_EXAMINE_PCOP // outCond
 };
 
 pCodeInstruction pciBTFSS = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   AnalyzeSKIP,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   AnalyzeSKIP,
    genericDestruct,
    genericPrint},
   POC_BTFSS,
   "BTFSS",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,1,  // dest, bit instruction
-  PCC_EXAMINE_PCOP,   // inCond
-  PCC_NONE // outCond
+  1,1,  // branch, skip
+  0,    // literal operand
+  POC_BTFSC,
+  (PCC_REGISTER | PCC_EXAMINE_PCOP),   // inCond
+  PCC_EXAMINE_PCOP // outCond
 };
 
 pCodeInstruction pciCALL = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_CALL,
   "CALL",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
+  1,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_NONE, // inCond
   PCC_NONE  // outCond
 };
 
 pCodeInstruction pciCOMF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_COMF,
   "COMF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,  // inCond
   PCC_REGISTER   // outCond
 };
 
 pCodeInstruction pciCOMFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_COMFW,
   "COMF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,  // inCond
   PCC_W   // outCond
 };
 
 pCodeInstruction pciCLRF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_CLRF,
   "CLRF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
-  PCC_REGISTER, // inCond
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
+  PCC_NONE, // inCond
   PCC_REGISTER  // outCond
 };
 
 pCodeInstruction pciCLRW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_CLRW,
   "CLRW",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   0,    // num ops
   0,0,  // dest, bit instruction
-  PCC_W, // inCond
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
+  PCC_NONE, // inCond
   PCC_W  // outCond
 };
 
+pCodeInstruction pciCLRWDT = {
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
+   genericDestruct,
+   genericPrint},
+  POC_CLRWDT,
+  "CLRWDT",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
+  NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
+  0,    // num ops
+  0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
+  PCC_NONE, // inCond
+  PCC_NONE  // outCond
+};
+
 pCodeInstruction pciDECF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_DECF,
   "DECF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,   // inCond
   PCC_REGISTER    // outCond
 };
 
 pCodeInstruction pciDECFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_DECFW,
   "DECF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,   // inCond
   PCC_W    // outCond
 };
 
 pCodeInstruction pciDECFSZ = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   AnalyzeSKIP,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   AnalyzeSKIP,
    genericDestruct,
    genericPrint},
   POC_DECFSZ,
   "DECFSZ",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  1,1,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,   // inCond
   PCC_REGISTER    // outCond
 };
 
 pCodeInstruction pciDECFSZW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   AnalyzeSKIP,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   AnalyzeSKIP,
    genericDestruct,
    genericPrint},
   POC_DECFSZW,
   "DECFSZ",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  1,1,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,   // inCond
   PCC_W           // outCond
 };
 
 pCodeInstruction pciGOTO = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   AnalyzeGOTO,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   AnalyzeGOTO,
    genericDestruct,
    genericPrint},
   POC_GOTO,
   "GOTO",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
+  1,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_NONE,   // inCond
   PCC_NONE    // outCond
 };
 
-
 pCodeInstruction pciINCF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_INCF,
   "INCF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,   // inCond
   PCC_REGISTER    // outCond
 };
 
 pCodeInstruction pciINCFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_INCFW,
   "INCF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,   // inCond
   PCC_W    // outCond
 };
 
 pCodeInstruction pciINCFSZ = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   AnalyzeSKIP,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   AnalyzeSKIP,
    genericDestruct,
    genericPrint},
   POC_INCFSZ,
   "INCFSZ",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  1,1,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,   // inCond
   PCC_REGISTER    // outCond
 };
 
 pCodeInstruction pciINCFSZW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   AnalyzeSKIP,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   AnalyzeSKIP,
    genericDestruct,
    genericPrint},
   POC_INCFSZW,
   "INCFSZ",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  1,1,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,   // inCond
   PCC_W           // outCond
 };
 
 pCodeInstruction pciIORWF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_IORWF,
   "IORWF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_W | PCC_REGISTER),   // inCond
   (PCC_REGISTER | PCC_Z) // outCond
 };
 
 pCodeInstruction pciIORFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
-  POC_IORWF,
+  POC_IORFW,
   "IORWF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_W | PCC_REGISTER),   // inCond
   (PCC_W | PCC_Z) // outCond
 };
 
 pCodeInstruction pciIORLW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_IORLW,
   "IORLW",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
-  PCC_W,   // inCond
+  0,0,  // branch, skip
+  1,    // literal operand
+  POC_NOP,
+  (PCC_W | PCC_LITERAL),   // inCond
   (PCC_W | PCC_Z) // outCond
 };
 
 pCodeInstruction pciMOVF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_MOVF,
   "MOVF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,   // inCond
   PCC_Z // outCond
 };
 
 pCodeInstruction pciMOVFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_MOVFW,
   "MOVF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_REGISTER,   // inCond
   (PCC_W | PCC_Z) // outCond
 };
 
 pCodeInstruction pciMOVWF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_MOVWF,
   "MOVWF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_W,   // inCond
-  0 // outCond
+  PCC_REGISTER // outCond
 };
 
 pCodeInstruction pciMOVLW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
    genericDestruct,
    genericPrint},
   POC_MOVLW,
   "MOVLW",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
-  PCC_NONE,   // inCond
+  0,0,  // branch, skip
+  1,    // literal operand
+  POC_NOP,
+  (PCC_NONE | PCC_LITERAL),   // inCond
   PCC_W // outCond
 };
 
-pCodeInstruction pciNEGF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+pCodeInstruction pciNOP = {
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
    genericDestruct,
    genericPrint},
-  POC_NEGF,
-  "NEGF",
+  POC_NOP,
+  "NOP",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
-  1,    // num ops
+  NULL, // flow block
+  NULL, // C source 
+  0,    // num ops
   0,0,  // dest, bit instruction
-  PCC_REGISTER,   // inCond
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
+  PCC_NONE,   // inCond
   PCC_NONE // outCond
 };
 
+pCodeInstruction pciRETFIE = {
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   AnalyzeRETURN,
+   genericDestruct,
+   genericPrint},
+  POC_RETFIE,
+  "RETFIE",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
+  NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
+  0,    // num ops
+  0,0,  // dest, bit instruction
+  1,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
+  PCC_NONE,   // inCond
+  PCC_NONE // outCond (not true... affects the GIE bit too)
+};
 
 pCodeInstruction pciRETLW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   AnalyzeRETURN,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   AnalyzeRETURN,
    genericDestruct,
    genericPrint},
   POC_RETLW,
   "RETLW",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
-  PCC_NONE,   // inCond
+  1,0,  // branch, skip
+  1,    // literal operand
+  POC_NOP,
+  PCC_LITERAL,   // inCond
   PCC_W // outCond
 };
 
 pCodeInstruction pciRETURN = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   AnalyzeRETURN,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   AnalyzeRETURN,
    genericDestruct,
    genericPrint},
   POC_RETURN,
   "RETURN",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   0,    // num ops
   0,0,  // dest, bit instruction
+  1,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_NONE,   // inCond
-  PCC_W // outCond
+  PCC_NONE // outCond
 };
 
-
 pCodeInstruction pciRLF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_RLF,
   "RLF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_C | PCC_REGISTER),   // inCond
   (PCC_REGISTER | PCC_Z | PCC_C | PCC_DC) // outCond
 };
 
 pCodeInstruction pciRLFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_RLFW,
   "RLF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_C | PCC_REGISTER),   // inCond
   (PCC_W | PCC_Z | PCC_C | PCC_DC) // outCond
 };
 
 pCodeInstruction pciRRF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_RRF,
   "RRF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_C | PCC_REGISTER),   // inCond
   (PCC_REGISTER | PCC_Z | PCC_C | PCC_DC) // outCond
 };
 
 pCodeInstruction pciRRFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_RRFW,
   "RRF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_C | PCC_REGISTER),   // inCond
   (PCC_W | PCC_Z | PCC_C | PCC_DC) // outCond
 };
 
 pCodeInstruction pciSUBWF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_SUBWF,
   "SUBWF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_W | PCC_REGISTER),   // inCond
   (PCC_REGISTER | PCC_Z) // outCond
 };
 
 pCodeInstruction pciSUBFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
-  POC_SUBWF,
+  POC_SUBFW,
   "SUBWF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_W | PCC_REGISTER),   // inCond
   (PCC_W | PCC_Z) // outCond
 };
 
 pCodeInstruction pciSUBLW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_SUBLW,
   "SUBLW",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
-  PCC_W,   // inCond
+  0,0,  // branch, skip
+  1,    // literal operand
+  POC_NOP,
+  (PCC_W | PCC_LITERAL),   // inCond
   (PCC_W | PCC_Z | PCC_C | PCC_DC) // outCond
 };
 
 pCodeInstruction pciSWAPF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_SWAPF,
   "SWAPF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_REGISTER),   // inCond
   (PCC_REGISTER) // outCond
 };
 
 pCodeInstruction pciSWAPFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_SWAPFW,
   "SWAPF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_REGISTER),   // inCond
   (PCC_W) // outCond
 };
+
 pCodeInstruction pciTRIS = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_TRIS,
   "TRIS",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   PCC_NONE,   // inCond
-  PCC_NONE
+  PCC_REGISTER // outCond
 };
 
-
 pCodeInstruction pciXORWF = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_XORWF,
   "XORWF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   1,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_W | PCC_REGISTER),   // inCond
   (PCC_REGISTER | PCC_Z) // outCond
 };
 
 pCodeInstruction pciXORFW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
-  POC_XORWF,
+  POC_XORFW,
   "XORWF",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   2,    // num ops
   0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
   (PCC_W | PCC_REGISTER),   // inCond
   (PCC_W | PCC_Z) // outCond
 };
 
 pCodeInstruction pciXORLW = {
-  {PC_OPCODE, NULL, NULL, 0, NULL, NULL, NULL, NULL, 
-   genericAnalyze,
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
    genericDestruct,
    genericPrint},
   POC_XORLW,
   "XORLW",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
   NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
   1,    // num ops
   0,0,  // dest, bit instruction
-  PCC_W,   // inCond
+  0,0,  // branch, skip
+  1,    // literal operand
+  POC_NOP,
+  (PCC_W | PCC_LITERAL),   // inCond
   (PCC_W | PCC_Z | PCC_C | PCC_DC) // outCond
 };
 
 
-#define MAX_PIC14MNEMONICS 100
+pCodeInstruction pciBANKSEL = {
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
+   genericDestruct,
+   genericPrint},
+  POC_BANKSEL,
+  "BANKSEL",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
+  NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
+  1,    // num ops
+  0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
+  PCC_NONE, // inCond
+  PCC_REGISTER  // outCond
+};
+
+pCodeInstruction pciPAGESEL = {
+  {PC_OPCODE, NULL, NULL, 0, 0, NULL, 
+   //   genericAnalyze,
+   genericDestruct,
+   genericPrint},
+  POC_PAGESEL,
+  "PAGESEL",
+  NULL, // from branch
+  NULL, // to branch
+  NULL, // label
+  NULL, // operand
+  NULL, // flow block
+  NULL, // C source 
+  1,    // num ops
+  0,0,  // dest, bit instruction
+  0,0,  // branch, skip
+  0,    // literal operand
+  POC_NOP,
+  PCC_NONE, // inCond
+  PCC_REGISTER  // outCond
+};
+
 pCodeInstruction *pic14Mnemonics[MAX_PIC14MNEMONICS];
 
+
+/*-----------------------------------------------------------------*/
+/* return a unique ID number to assist pCodes debuging             */
+/*-----------------------------------------------------------------*/
+unsigned PCodeID(void) {
+  static unsigned int pcodeId = 1; // unique ID number to be assigned to all pCodes
+/**/
+  static unsigned int stop;
+  if (pcodeId == 5801)
+         stop++;
+  if ((pcodeId >= 855)&&(pcodeId <= 856))
+         stop++;
+/**/
+  return pcodeId++;
+}
+
+#ifdef HAVE_VSNPRINTF
+  // Alas, vsnprintf is not ANSI standard, and does not exist
+  // on Solaris (and probably other non-Gnu flavored Unixes).
+
 /*-----------------------------------------------------------------*/
 /* SAFE_snprintf - like snprintf except the string pointer is      */
 /*                 after the string has been printed to. This is   */
@@ -752,28 +1281,105 @@ void SAFE_snprintf(char **str, size_t *size, const  char  *format, ...)
     return;
 
   va_start(val, format);
-#if 0
-  // Alas, vsnprintf is not ANSI standard, and does not exist
-  // on Solaris (and probably other non-Gnu flavored Unixes).
+
   vsnprintf(*str, *size, format, val);
-#else
-  // This, of course, is *not* safe, despite the name.
-  vsprintf(*str, format, val);
-#endif
-    
+
   va_end (val);
 
   len = strlen(*str);
+  if((size_t)len > *size) {
+    fprintf(stderr,"WARNING, it looks like %s has overflowed\n",__FUNCTION__);
+    fprintf(stderr,"len = %d is > str size %d\n",len,(int)*size);
+  }
+
+  *str += len;
+  *size -= len;
+
+}
+
+#else  //  HAVE_VSNPRINTF
+
+// This version is *not* safe, despite the name.
+
+void SAFE_snprintf(char **str, size_t *size, const  char  *format, ...)
+{
+  va_list val;
+  int len;
+  static char buffer[1024]; /* grossly conservative, but still not inherently safe */
+
+  if(!str || !*str)
+    return;
+
+  va_start(val, format);
+
+  vsprintf(buffer, format, val);
+  va_end (val);
+
+  len = strlen(buffer);
+  if(len > *size) {
+    fprintf(stderr,"WARNING, it looks like %s has overflowed\n",__FUNCTION__);
+    fprintf(stderr,"len = %d is > str size %d\n",len,*size);
+  }
+
+  strcpy(*str, buffer);
   *str += len;
   *size -= len;
 
 }
 
+#endif    //  HAVE_VSNPRINTF
+    
+
+extern  void initStack(int base_address, int size);
+extern regs *allocProcessorRegister(int rIdx, char * name, short po_type, int alias);
+extern regs *allocInternalRegister(int rIdx, char * name, short po_type, int alias);
+extern void init_pic(char *);
+
 void  pCodeInitRegisters(void)
 {
+  static int initialized=0;
+  int shareBankAddress,stkSize;
 
-  pc_fsr.rIdx = 4;
-  pc_fsr.r = pic14_regWithIdx(4);
+  if(initialized)
+    return;
+  initialized = 1;
+
+  shareBankAddress = 0x7f; /* FIXME - some PIC ICs like 16C7X which do not have a shared bank need a different approach. */
+  stkSize = 8; // Set pseudo stack size to 8
+  initStack(shareBankAddress, stkSize); // Putting the pseudo stack in shared memory so all modules use the same register when passing fn parameters
+  init_pic(port->processor);
+
+  pc_status.r = allocProcessorRegister(IDX_STATUS,"STATUS", PO_STATUS, 0x180);
+  pc_pcl.r = allocProcessorRegister(IDX_PCL,"PCL", PO_PCL, 0x80);
+  pc_pclath.r = allocProcessorRegister(IDX_PCLATH,"PCLATH", PO_PCLATH, 0x180);
+  pc_fsr.r = allocProcessorRegister(IDX_FSR,"FSR", PO_FSR, 0x180);
+  pc_indf.r = allocProcessorRegister(IDX_INDF,"INDF", PO_INDF, 0x80);
+  pc_intcon.r = allocProcessorRegister(IDX_INTCON,"INTCON", PO_INTCON, 0x180);
+
+  pc_status.rIdx = IDX_STATUS;
+  pc_fsr.rIdx = IDX_FSR;
+  pc_indf.rIdx = IDX_INDF;
+  pc_intcon.rIdx = IDX_INTCON;
+  pc_pcl.rIdx = IDX_PCL;
+  pc_pclath.rIdx = IDX_PCLATH;
+
+  pc_wsave.r = allocInternalRegister(IDX_WSAVE,"WSAVE", PO_GPR_REGISTER, 0x180); /* Interrupt storage for working register - must be same address in all banks ie section SHAREBANK. */
+  pc_ssave.r = allocInternalRegister(IDX_SSAVE,"SSAVE", PO_GPR_REGISTER, 0); /* Interrupt storage for status register. */
+  pc_psave.r = allocInternalRegister(IDX_PSAVE,"PSAVE", PO_GPR_REGISTER, 0); /* Interrupt storage for pclath register. */
+
+  pc_wsave.rIdx = pc_wsave.r->rIdx;
+  pc_ssave.rIdx = pc_ssave.r->rIdx;
+  pc_psave.rIdx = pc_psave.r->rIdx;
+
+  pc_wsave.r->isFixed = 1; /* Some PIC ICs do not have a sharebank - this register needs to be reserved across all banks. */
+  pc_wsave.r->address = shareBankAddress-stkSize;
+  pc_ssave.r->isFixed = 1; /* This register must be in the first bank. */
+  pc_ssave.r->address = shareBankAddress-stkSize-1;
+  pc_psave.r->isFixed = 1; /* This register must be in the first bank. */
+  pc_psave.r->address = shareBankAddress-stkSize-2;
+
+  /* probably should put this in a separate initialization routine */
+  pb_dead_pcodes = newpBlock();
 
 }
 
@@ -810,6 +1416,9 @@ void pic14initMnemonics(void)
   if(mnemonics_initialized)
     return;
 
+//FIXME - probably should NULL out the array before making the assignments
+//since we check the array contents below this initialization.
+
   pic14Mnemonics[POC_ADDLW] = &pciADDLW;
   pic14Mnemonics[POC_ADDWF] = &pciADDWF;
   pic14Mnemonics[POC_ADDFW] = &pciADDFW;
@@ -825,6 +1434,7 @@ void pic14initMnemonics(void)
   pic14Mnemonics[POC_COMFW] = &pciCOMFW;
   pic14Mnemonics[POC_CLRF] = &pciCLRF;
   pic14Mnemonics[POC_CLRW] = &pciCLRW;
+  pic14Mnemonics[POC_CLRWDT] = &pciCLRWDT;
   pic14Mnemonics[POC_DECF] = &pciDECF;
   pic14Mnemonics[POC_DECFW] = &pciDECFW;
   pic14Mnemonics[POC_DECFSZ] = &pciDECFSZ;
@@ -841,7 +1451,8 @@ void pic14initMnemonics(void)
   pic14Mnemonics[POC_MOVFW] = &pciMOVFW;
   pic14Mnemonics[POC_MOVLW] = &pciMOVLW;
   pic14Mnemonics[POC_MOVWF] = &pciMOVWF;
-  pic14Mnemonics[POC_NEGF] = &pciNEGF;
+  pic14Mnemonics[POC_NOP] = &pciNOP;
+  pic14Mnemonics[POC_RETFIE] = &pciRETFIE;
   pic14Mnemonics[POC_RETLW] = &pciRETLW;
   pic14Mnemonics[POC_RETURN] = &pciRETURN;
   pic14Mnemonics[POC_RLF] = &pciRLF;
@@ -857,6 +1468,8 @@ void pic14initMnemonics(void)
   pic14Mnemonics[POC_XORLW] = &pciXORLW;
   pic14Mnemonics[POC_XORWF] = &pciXORWF;
   pic14Mnemonics[POC_XORFW] = &pciXORFW;
+  pic14Mnemonics[POC_BANKSEL] = &pciBANKSEL;
+  pic14Mnemonics[POC_PAGESEL] = &pciPAGESEL;
 
   for(i=0; i<MAX_PIC14MNEMONICS; i++)
     if(pic14Mnemonics[i])
@@ -864,13 +1477,15 @@ void pic14initMnemonics(void)
   pci = hTabFirstItem(pic14MnemonicsHash, &key);
 
   while(pci) {
-    fprintf( stderr, "element %d key %d, mnem %s\n",i++,key,pci->mnemonic);
+    DFPRINTF((stderr, "element %d key %d, mnem %s\n",i++,key,pci->mnemonic));
     pci = hTabNextItem(pic14MnemonicsHash, &key);
   }
 
   mnemonics_initialized = 1;
 }
 
+int getpCodePeepCommand(char *cmd);
+
 int getpCode(char *mnem,unsigned dest)
 {
 
@@ -885,7 +1500,7 @@ int getpCode(char *mnem,unsigned dest)
   while(pci) {
 
     if(STRCASECMP(pci->mnemonic, mnem) == 0) {
-      if((pci->num_ops <= 1) || (pci->dest == dest))
+      if((pci->num_ops <= 1) || (pci->isModReg == dest) || (pci->isBitInst))
        return(pci->op);
     }
 
@@ -896,6 +1511,59 @@ int getpCode(char *mnem,unsigned dest)
   return -1;
 }
 
+/*-----------------------------------------------------------------*
+ * pic14initpCodePeepCommands
+ *
+ *-----------------------------------------------------------------*/
+void pic14initpCodePeepCommands(void)
+{
+
+  int key, i;
+  peepCommand *pcmd;
+
+  i = 0;
+  do {
+    hTabAddItem(&pic14pCodePeepCommandsHash, 
+               mnem2key(peepCommands[i].cmd), &peepCommands[i]);
+    i++;
+  } while (peepCommands[i].cmd);
+
+  pcmd = hTabFirstItem(pic14pCodePeepCommandsHash, &key);
+
+  while(pcmd) {
+    //fprintf(stderr, "peep command %s  key %d\n",pcmd->cmd,pcmd->id);
+    pcmd = hTabNextItem(pic14pCodePeepCommandsHash, &key);
+  }
+
+}
+
+/*-----------------------------------------------------------------
+ *
+ *
+ *-----------------------------------------------------------------*/
+
+int getpCodePeepCommand(char *cmd)
+{
+
+  peepCommand *pcmd;
+  int key = mnem2key(cmd);
+
+
+  pcmd = hTabFirstItemWK(pic14pCodePeepCommandsHash, key);
+
+  while(pcmd) {
+    // fprintf(stderr," comparing %s to %s\n",pcmd->cmd,cmd);
+    if(STRCASECMP(pcmd->cmd, cmd) == 0) {
+      return pcmd->id;
+    }
+
+    pcmd = hTabNextItemWK (pic14pCodePeepCommandsHash);
+  
+  }
+
+  return -1;
+}
+
 char getpBlock_dbName(pBlock *pb)
 {
   if(!pb)
@@ -906,6 +1574,17 @@ char getpBlock_dbName(pBlock *pb)
 
   return pb->dbName;
 }
+void pBlockConvert2ISR(pBlock *pb)
+{
+  if(!pb)
+    return;
+
+  if(pb->cmemmap)
+    pb->cmemmap = NULL;
+
+  pb->dbName = 'I';
+}
+
 /*-----------------------------------------------------------------*/
 /* movepBlock2Head - given the dbname of a pBlock, move all        */
 /*                   instances to the front of the doubly linked   */
@@ -958,15 +1637,18 @@ void copypCode(FILE *of, char dbName)
     return;
 
   for(pb = the_pFile->pbHead; pb; pb = pb->next) {
-    if(getpBlock_dbName(pb) == dbName)
+    if(getpBlock_dbName(pb) == dbName) {
+      pBlockStats(of,pb);
       printpBlock(of,pb);
+      fprintf (of, "\n");
+    }
   }
 
 }
 void pcode_test(void)
 {
 
-  printf("pcode is alive!\n");
+  DFPRINTF((stderr,"pcode is alive!\n"));
 
   //initMnemonics();
 
@@ -977,7 +1659,7 @@ void pcode_test(void)
     char buffer[100];
 
     /* create the file name */
-    strcpy(buffer,srcFileName);
+    strcpy(buffer,dstFileName);
     strcat(buffer,".p");
 
     if( !(pFile = fopen(buffer, "w" ))) {
@@ -999,22 +1681,33 @@ void pcode_test(void)
     }
   }
 }
+/*-----------------------------------------------------------------*/
+/* int RegCond(pCodeOp *pcop) - if pcop points to the STATUS reg-  */
+/*      ister, RegCond will return the bit being referenced.       */
+/*                                                                 */
+/* fixme - why not just OR in the pcop bit field                   */
+/*-----------------------------------------------------------------*/
+
 static int RegCond(pCodeOp *pcop)
 {
 
   if(!pcop)
     return 0;
 
-  if(pcop->type == PO_BIT  && !strcmp(pcop->name, pc_status.pcop.name)) {
-    switch(PCOB(pcop)->bit) {
-    case PIC_C_BIT:
-      return PCC_C;
-    case PIC_DC_BIT:
-       return PCC_DC;
-    case PIC_Z_BIT:
-      return PCC_Z;
-    }
-
+  if (pcop->type == PO_GPR_BIT) {
+    char *name = pcop->name;
+      if (!name) 
+        name = PCOR(pcop)->r->name;
+//      if (strcmp(name, pc_status.pcop.name) != 0) { <<< This breaks the peep 2 optimisation
+      switch(PCORB(pcop)->bit) {
+      case PIC_C_BIT:
+        return PCC_C;
+      case PIC_DC_BIT:
+        return PCC_DC;
+      case PIC_Z_BIT:
+        return PCC_Z;
+         }
+//    }
   }
 
   return 0;
@@ -1052,14 +1745,16 @@ pCode *newpCode (PIC_OPCODE op, pCodeOp *pcop)
 
   if((op>=0) && (op < MAX_PIC14MNEMONICS) && pic14Mnemonics[op]) {
     memcpy(pci, pic14Mnemonics[op], sizeof(pCodeInstruction));
+    pci->pc.id = PCodeID();
     pci->pcop = pcop;
 
-    if(pci->inCond == PCC_EXAMINE_PCOP)
-      pci->inCond   = RegCond(pcop);
+    if(pci->inCond & PCC_EXAMINE_PCOP)
+      pci->inCond  |= RegCond(pcop);
 
-    if(pci->outCond == PCC_EXAMINE_PCOP)
-      pci->outCond   = RegCond(pcop);
+    if(pci->outCond & PCC_EXAMINE_PCOP)
+      pci->outCond  |= RegCond(pcop);
 
+    pci->pc.prev = pci->pc.next = NULL;
     return (pCode *)pci;
   }
 
@@ -1093,21 +1788,57 @@ pCode *newpCodeWild(int pCodeID, pCodeOp *optional_operand, pCodeOp *optional_la
     
   pcw = Safe_calloc(1,sizeof(pCodeWild));
 
-  pcw->pc.type = PC_WILD;
-  pcw->pc.prev = pcw->pc.next = NULL;
-  pcw->pc.from = pcw->pc.to = pcw->pc.label = NULL;
-  pcw->pc.pb = NULL;
+  pcw->pci.pc.type = PC_WILD;
+  pcw->pci.pc.prev = pcw->pci.pc.next = NULL;
+  pcw->id = PCodeID();
+  pcw->pci.from = pcw->pci.to = pcw->pci.label = NULL;
+  pcw->pci.pc.pb = NULL;
 
-  pcw->pc.analyze = genericAnalyze;
-  pcw->pc.destruct = genericDestruct;
-  pcw->pc.print = genericPrint;
+  //  pcw->pci.pc.analyze = genericAnalyze;
+  pcw->pci.pc.destruct = genericDestruct;
+  pcw->pci.pc.print = genericPrint;
 
   pcw->id = pCodeID;              // this is the 'n' in %n
   pcw->operand = optional_operand;
   pcw->label   = optional_label;
 
+  pcw->mustBeBitSkipInst = 0;
+  pcw->mustNotBeBitSkipInst = 0;
+  pcw->invertBitSkipInst = 0;
+
   return ( (pCode *)pcw);
   
+}
+
+ /*-----------------------------------------------------------------*/
+/* newPcodeInlineP - create a new pCode from a char string           */
+/*-----------------------------------------------------------------*/
+
+
+pCode *newpCodeInlineP(char *cP)
+{
+
+  pCodeComment *pcc ;
+    
+  pcc = Safe_calloc(1,sizeof(pCodeComment));
+
+  pcc->pc.type = PC_INLINE;
+  pcc->pc.prev = pcc->pc.next = NULL;
+  pcc->pc.id = PCodeID();
+  //pcc->pc.from = pcc->pc.to = pcc->pc.label = NULL;
+  pcc->pc.pb = NULL;
+
+  //  pcc->pc.analyze = genericAnalyze;
+  pcc->pc.destruct = genericDestruct;
+  pcc->pc.print = genericPrint;
+
+  if(cP)
+    pcc->comment = Safe_strdup(cP);
+  else
+    pcc->comment = NULL;
+
+  return ( (pCode *)pcc);
+
 }
 
 /*-----------------------------------------------------------------*/
@@ -1123,10 +1854,11 @@ pCode *newpCodeCharP(char *cP)
 
   pcc->pc.type = PC_COMMENT;
   pcc->pc.prev = pcc->pc.next = NULL;
-  pcc->pc.from = pcc->pc.to = pcc->pc.label = NULL;
+  pcc->pc.id = PCodeID();
+  //pcc->pc.from = pcc->pc.to = pcc->pc.label = NULL;
   pcc->pc.pb = NULL;
 
-  pcc->pc.analyze = genericAnalyze;
+  //  pcc->pc.analyze = genericAnalyze;
   pcc->pc.destruct = genericDestruct;
   pcc->pc.print = genericPrint;
 
@@ -1140,122 +1872,229 @@ pCode *newpCodeCharP(char *cP)
 }
 
 /*-----------------------------------------------------------------*/
-/* newpCodeGLabel - create a new global label                      */
+/* newpCodeFunction -                                              */
 /*-----------------------------------------------------------------*/
 
 
-pCode *newpCodeFunction(char *mod,char *f)
+pCode *newpCodeFunction(char *mod,char *f,int isPublic)
 {
   pCodeFunction *pcf;
 
-  _ALLOC(pcf,sizeof(pCodeFunction));
+  pcf = Safe_calloc(1,sizeof(pCodeFunction));
+  //_ALLOC(pcf,sizeof(pCodeFunction));
 
   pcf->pc.type = PC_FUNCTION;
   pcf->pc.prev = pcf->pc.next = NULL;
-  pcf->pc.from = pcf->pc.to = pcf->pc.label = NULL;
+  pcf->pc.id = PCodeID();
+  //pcf->pc.from = pcf->pc.to = pcf->pc.label = NULL;
   pcf->pc.pb = NULL;
 
-  pcf->pc.analyze = genericAnalyze;
+  //  pcf->pc.analyze = genericAnalyze;
   pcf->pc.destruct = genericDestruct;
   pcf->pc.print = pCodePrintFunction;
 
+  pcf->ncalled = 0;
+
   if(mod) {
-    _ALLOC_ATOMIC(pcf->modname,strlen(mod)+1);
+    //_ALLOC_ATOMIC(pcf->modname,strlen(mod)+1);
+    pcf->modname = Safe_calloc(1,strlen(mod)+1);
     strcpy(pcf->modname,mod);
   } else
     pcf->modname = NULL;
 
   if(f) {
-    _ALLOC_ATOMIC(pcf->fname,strlen(f)+1);
+    //_ALLOC_ATOMIC(pcf->fname,strlen(f)+1);
+    pcf->fname = Safe_calloc(1,strlen(f)+1);
     strcpy(pcf->fname,f);
   } else
     pcf->fname = NULL;
 
+  pcf->isPublic = (unsigned)isPublic;
+
   return ( (pCode *)pcf);
 
 }
 
-static void pCodeLabelDestruct(pCode *pc)
+/*-----------------------------------------------------------------*/
+/* newpCodeFlow                                                    */
+/*-----------------------------------------------------------------*/
+void destructpCodeFlow(pCode *pc)
 {
-
-  if(!pc)
+  if(!pc || !isPCFL(pc))
     return;
 
-  unlinkPC(pc);
-
-  if((pc->type == PC_LABEL) && PCL(pc)->label)
-    free(PCL(pc)->label);
+/*
+  if(PCFL(pc)->from)
+  if(PCFL(pc)->to)
+*/
+  unlinkpCode(pc);
 
+  deleteSet(&PCFL(pc)->registers);
+  deleteSet(&PCFL(pc)->from);
+  deleteSet(&PCFL(pc)->to);
   free(pc);
 
 }
 
-pCode *newpCodeLabel(int key)
+pCode *newpCodeFlow(void )
 {
+  pCodeFlow *pcflow;
 
-  char *s = buffer;
-  pCodeLabel *pcl;
-    
-  pcl = Safe_calloc(1,sizeof(pCodeLabel) );
+  //_ALLOC(pcflow,sizeof(pCodeFlow));
+  pcflow = Safe_calloc(1,sizeof(pCodeFlow));
 
-  pcl->pc.type = PC_LABEL;
-  pcl->pc.prev = pcl->pc.next = NULL;
-  pcl->pc.from = pcl->pc.to = pcl->pc.label = NULL;
-  pcl->pc.pb = NULL;
+  pcflow->pc.type = PC_FLOW;
+  pcflow->pc.prev = pcflow->pc.next = NULL;
+  pcflow->pc.pb = NULL;
 
-  pcl->pc.analyze = genericAnalyze;
-  pcl->pc.destruct = pCodeLabelDestruct;
-  pcl->pc.print = pCodePrintLabel;
+  //  pcflow->pc.analyze = genericAnalyze;
+  pcflow->pc.destruct = destructpCodeFlow;
+  pcflow->pc.print = genericPrint;
 
-  pcl->key = key;
+  pcflow->pc.seq = GpcFlowSeq++;
 
-  pcl->label = NULL;
-  if(key>0) {
-    sprintf(s,"_%05d_DS_",key);
-    if(s)
-      pcl->label = Safe_strdup(s);
-  }
+  pcflow->from = pcflow->to = NULL;
 
+  pcflow->inCond = PCC_NONE;
+  pcflow->outCond = PCC_NONE;
 
-  return ( (pCode *)pcl);
+  pcflow->firstBank = 'U'; /* Undetermined */
+  pcflow->lastBank = 'U'; /* Undetermined */
 
-}
-pCode *newpCodeLabelStr(char *str)
-{
-  pCode *pc = newpCodeLabel(-1);
+  pcflow->FromConflicts = 0;
+  pcflow->ToConflicts = 0;
 
-  if(str)
-    PCL(pc)->label = Safe_strdup(str);
-  else
-    PCL(pc)->label = NULL;
+  pcflow->end = NULL;
+
+  pcflow->registers = newSet();
+
+  return ( (pCode *)pcflow);
 
-  return pc;
 }
 
 /*-----------------------------------------------------------------*/
-/* newpBlock - create and return a pointer to a new pBlock         */
 /*-----------------------------------------------------------------*/
-pBlock *newpBlock(void)
+pCodeFlowLink *newpCodeFlowLink(pCodeFlow *pcflow)
 {
+  pCodeFlowLink *pcflowLink;
 
-  pBlock *PpB;
-
-  PpB = Safe_calloc(1,sizeof(pBlock) );
-  PpB->next = PpB->prev = NULL;
-
-  PpB->function_entries = PpB->function_exits = PpB->function_calls = NULL;
-  PpB->registers = NULL;
-  PpB->visited = 0;
+  pcflowLink = Safe_calloc(1,sizeof(pCodeFlowLink));
 
-  return PpB;
+  pcflowLink->pcflow = pcflow;
+  pcflowLink->bank_conflict = 0;
 
+  return pcflowLink;
 }
 
 /*-----------------------------------------------------------------*/
-/* newpCodeChai0n - create a new chain of pCodes                    */
-/*-----------------------------------------------------------------*
- *
- *  This function will create a new pBlock and the pointer to the
+/* newpCodeCSource - create a new pCode Source Symbol              */
+/*-----------------------------------------------------------------*/
+
+pCode *newpCodeCSource(int ln, char *f, char *l)
+{
+
+  pCodeCSource *pccs;
+    
+  pccs = Safe_calloc(1,sizeof(pCodeCSource));
+
+  pccs->pc.type = PC_CSOURCE;
+  pccs->pc.prev = pccs->pc.next = NULL;
+  pccs->pc.id = PCodeID();
+  pccs->pc.pb = NULL;
+
+  pccs->pc.destruct = genericDestruct;
+  pccs->pc.print = genericPrint;
+
+  pccs->line_number = ln;
+  if(l)
+    pccs->line = Safe_strdup(l);
+  else
+    pccs->line = NULL;
+
+  if(f)
+    pccs->file_name = Safe_strdup(f);
+  else
+    pccs->file_name = NULL;
+
+  return ( (pCode *)pccs);
+
+}
+/*-----------------------------------------------------------------*/
+/* pCodeLabelDestruct - free memory used by a label.               */
+/*-----------------------------------------------------------------*/
+static void pCodeLabelDestruct(pCode *pc)
+{
+
+  if(!pc)
+    return;
+
+  if((pc->type == PC_LABEL) && PCL(pc)->label)
+    free(PCL(pc)->label);
+
+  free(pc);
+
+}
+
+pCode *newpCodeLabel(char *name, int key)
+{
+
+  char *s = buffer;
+  pCodeLabel *pcl;
+    
+  pcl = Safe_calloc(1,sizeof(pCodeLabel) );
+
+  pcl->pc.type = PC_LABEL;
+  pcl->pc.prev = pcl->pc.next = NULL;
+  pcl->pc.id = PCodeID();
+  //pcl->pc.from = pcl->pc.to = pcl->pc.label = NULL;
+  pcl->pc.pb = NULL;
+
+  //  pcl->pc.analyze = genericAnalyze;
+  pcl->pc.destruct = pCodeLabelDestruct;
+  pcl->pc.print = pCodePrintLabel;
+
+  pcl->key = key;
+
+  pcl->label = NULL;
+  if(key>0) {
+    sprintf(s,"_%05d_DS_",key);
+  } else
+    s = name;
+
+  if(s)
+    pcl->label = Safe_strdup(s);
+
+  //fprintf(stderr,"newpCodeLabel: key=%d, name=%s\n",key, ((s)?s:""));
+  return ( (pCode *)pcl);
+
+}
+
+
+/*-----------------------------------------------------------------*/
+/* newpBlock - create and return a pointer to a new pBlock         */
+/*-----------------------------------------------------------------*/
+pBlock *newpBlock(void)
+{
+
+  pBlock *PpB;
+
+  PpB = Safe_calloc(1,sizeof(pBlock) );
+  PpB->next = PpB->prev = NULL;
+
+  PpB->function_entries = PpB->function_exits = PpB->function_calls = NULL;
+  PpB->tregisters = NULL;
+  PpB->visited = 0;
+  PpB->FlowTree = NULL;
+
+  return PpB;
+
+}
+
+/*-----------------------------------------------------------------*/
+/* newpCodeChain - create a new chain of pCodes                    */
+/*-----------------------------------------------------------------*
+ *
+ *  This function will create a new pBlock and the pointer to the
  *  pCode that is passed in will be the first pCode in the block.
  *-----------------------------------------------------------------*/
 
@@ -1279,27 +2118,35 @@ pBlock *newpCodeChain(memmap *cm,char c, pCode *pc)
 /*   optimizations).                                               */
 /*-----------------------------------------------------------------*/
 
-pCodeOp *newpCodeOpLabel(int key)
+pCodeOp *newpCodeOpLabel(char *name, int key)
 {
-  char *s = buffer;
+  char *s=NULL;
+  static int label_key=-1;
+
   pCodeOp *pcop;
 
   pcop = Safe_calloc(1,sizeof(pCodeOpLabel) );
   pcop->type = PO_LABEL;
 
   pcop->name = NULL;
-  if(key>0) {
-    sprintf(s,"_%05d_DS_",key);
-    if(s)
-      pcop->name = Safe_strdup(s);
-  } 
 
+  if(key>0)
+    sprintf(s=buffer,"_%05d_DS_",key);
+  else 
+    s = name, key = label_key--;
+
+  PCOLAB(pcop)->offset = 0;
+  if(s)
+    pcop->name = Safe_strdup(s);
 
   ((pCodeOpLabel *)pcop)->key = key;
 
+  //fprintf(stderr,"newpCodeOpLabel: key=%d, name=%s\n",key,((s)?s:""));
   return pcop;
 }
 
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
 pCodeOp *newpCodeOpLit(int lit)
 {
   char *s = buffer;
@@ -1308,26 +2155,64 @@ pCodeOp *newpCodeOpLit(int lit)
 
   pcop = Safe_calloc(1,sizeof(pCodeOpLit) );
   pcop->type = PO_LITERAL;
+
   pcop->name = NULL;
   if(lit>=0) {
     sprintf(s,"0x%02x",lit);
     if(s)
       pcop->name = Safe_strdup(s);
-  } 
-
+  }
 
   ((pCodeOpLit *)pcop)->lit = lit;
 
   return pcop;
 }
 
-pCodeOp *newpCodeOpWild(int id, pCodePeep *pcp, pCodeOp *subtype)
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+pCodeOp *newpCodeOpImmd(char *name, int offset, int index, int code_space, int is_func)
+{
+  pCodeOp *pcop;
+
+  pcop = Safe_calloc(1,sizeof(pCodeOpImmd) );
+  pcop->type = PO_IMMEDIATE;
+  if(name) {
+    regs *r = NULL;
+    pcop->name = Safe_strdup(name);
+
+    if(!is_func) 
+     r = dirregWithName(name);
+
+    PCOI(pcop)->r = r;
+    if(r) {
+      //fprintf(stderr, " newpCodeOpImmd reg %s exists\n",name);
+      PCOI(pcop)->rIdx = r->rIdx;
+    } else {
+      //fprintf(stderr, " newpCodeOpImmd reg %s doesn't exist\n",name);
+      PCOI(pcop)->rIdx = -1;
+    }
+    //fprintf(stderr,"%s %s %d\n",__FUNCTION__,name,offset);
+  } else {
+    pcop->name = NULL;
+  }
+
+  PCOI(pcop)->index = index;
+  PCOI(pcop)->offset = offset;
+  PCOI(pcop)->_const = code_space;
+  PCOI(pcop)->_function = is_func;
+
+  return pcop;
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+pCodeOp *newpCodeOpWild(int id, pCodeWildBlock *pcwb, pCodeOp *subtype)
 {
   char *s = buffer;
   pCodeOp *pcop;
 
 
-  if(!pcp || !subtype) {
+  if(!pcwb || !subtype) {
     fprintf(stderr, "Wild opcode declaration error: %s-%d\n",__FILE__,__LINE__);
     exit(1);
   }
@@ -1338,43 +2223,121 @@ pCodeOp *newpCodeOpWild(int id, pCodePeep *pcp, pCodeOp *subtype)
   pcop->name = Safe_strdup(s);
 
   PCOW(pcop)->id = id;
-  PCOW(pcop)->pcp = pcp;
+  PCOW(pcop)->pcwb = pcwb;
   PCOW(pcop)->subtype = subtype;
   PCOW(pcop)->matched = NULL;
 
   return pcop;
 }
+/*-----------------------------------------------------------------*/
+/* Find a symbol with matching name                                */
+/*-----------------------------------------------------------------*/
+static symbol *symFindWithName(memmap * map, const char *name)
+{
+  symbol *sym;
+
+  for (sym = setFirstItem(map->syms); sym; sym = setNextItem (map->syms)) {
+    if (sym->rname && (strcmp(sym->rname,name)==0))
+               return sym;
+  }
+  return 0;
+}
 
-pCodeOp *newpCodeOpBit(char *s, int bit, int inBitSpace)
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+pCodeOp *newpCodeOpBit(char *name, int ibit, int inBitSpace)
 {
   pCodeOp *pcop;
-
-  pcop = Safe_calloc(1,sizeof(pCodeOpBit) );
-  pcop->type = PO_BIT;
-  if(s)
-    pcop->name = Safe_strdup(s);   
-  else
+  struct regs *r = 0;
+
+  pcop = Safe_calloc(1,sizeof(pCodeOpRegBit) );
+  pcop->type = PO_GPR_BIT;
+
+  PCORB(pcop)->bit = ibit;
+  PCORB(pcop)->inBitSpace = inBitSpace;
+
+  if (name) r = regFindWithName(name);
+  if (!r) {
+    // Register has not been allocated - check for symbol information
+    symbol *sym;
+    sym = symFindWithName(bit, name);
+    if (!sym) sym = symFindWithName(sfrbit, name);
+    if (!sym) sym = symFindWithName(sfr, name);
+    if (sym) {
+               r = allocNewDirReg(sym->etype,name);
+    }
+  }
+  if (r) {
     pcop->name = NULL;
-
-  PCOB(pcop)->bit = bit;
-  PCOB(pcop)->inBitSpace = inBitSpace;
-
+    PCOR(pcop)->r = r;
+    PCOR(pcop)->rIdx = r->rIdx;
+  } else {
+    pcop->name = Safe_strdup(name);   
+    PCOR(pcop)->r = NULL;
+    PCOR(pcop)->rIdx = 0;
+  }
   return pcop;
 }
 
+/*-----------------------------------------------------------------*
+ * pCodeOp *newpCodeOpReg(int rIdx) - allocate a new register
+ *
+ * If rIdx >=0 then a specific register from the set of registers
+ * will be selected. If rIdx <0, then a new register will be searched
+ * for.
+ *-----------------------------------------------------------------*/
+
 pCodeOp *newpCodeOpReg(int rIdx)
 {
   pCodeOp *pcop;
 
   pcop = Safe_calloc(1,sizeof(pCodeOpReg) );
 
-  PCOR(pcop)->rIdx = rIdx;
-  PCOR(pcop)->r = pic14_regWithIdx(rIdx);
+  pcop->name = NULL;
+
+  if(rIdx >= 0) {
+    PCOR(pcop)->rIdx = rIdx;
+    PCOR(pcop)->r = pic14_regWithIdx(rIdx);
+  } else {
+    PCOR(pcop)->r = pic14_findFreeReg(REG_GPR);
+
+    if(PCOR(pcop)->r)
+      PCOR(pcop)->rIdx = PCOR(pcop)->r->rIdx;
+  }
+
+  if(PCOR(pcop)->r)
+    pcop->type = PCOR(pcop)->r->pc_type;
+
+  return pcop;
+}
+
+pCodeOp *newpCodeOpRegFromStr(char *name)
+{
+  pCodeOp *pcop;
+
+  pcop = Safe_calloc(1,sizeof(pCodeOpReg) );
+  PCOR(pcop)->r = allocRegByName(name, 1);
+  PCOR(pcop)->rIdx = PCOR(pcop)->r->rIdx;
   pcop->type = PCOR(pcop)->r->pc_type;
+  pcop->name = PCOR(pcop)->r->name;
+
+  return pcop;
+}
+
+pCodeOp *newpCodeOpStr(char *name)
+{
+  pCodeOp *pcop;
+
+  pcop = Safe_calloc(1,sizeof(pCodeOpStr));
+  pcop->type = PO_STR;
+  pcop->name = Safe_strdup(name);   
+
+  PCOS(pcop)->isPublic = 0;
 
   return pcop;
 }
 
+
 /*-----------------------------------------------------------------*/
 /*-----------------------------------------------------------------*/
 
@@ -1384,6 +2347,7 @@ pCodeOp *newpCodeOp(char *name, PIC_OPTYPE type)
 
   switch(type) {
   case PO_BIT:
+  case PO_GPR_BIT:
     pcop = newpCodeOpBit(name, -1,0);
     break;
 
@@ -1392,7 +2356,23 @@ pCodeOp *newpCodeOp(char *name, PIC_OPTYPE type)
     break;
 
   case PO_LABEL:
-    pcop = newpCodeOpLabel(-1);
+    pcop = newpCodeOpLabel(NULL,-1);
+    break;
+
+  case PO_GPR_TEMP:
+    pcop = newpCodeOpReg(-1);
+    break;
+
+  case PO_GPR_POINTER:
+  case PO_GPR_REGISTER:
+    if(name)
+      pcop = newpCodeOpRegFromStr(name);
+    else
+      pcop = newpCodeOpReg(-1);
+    break;
+
+  case PO_STR:
+    pcop = newpCodeOpStr(name);
     break;
 
   default:
@@ -1407,21 +2387,79 @@ pCodeOp *newpCodeOp(char *name, PIC_OPTYPE type)
   return pcop;
 }
 
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+void pCodeConstString(char *name, char *value)
+{
+  pBlock *pb;
+
+  //  fprintf(stderr, " %s  %s  %s\n",__FUNCTION__,name,value);
+
+  if(!name || !value)
+    return;
+
+  pb = newpCodeChain(NULL, 'P',newpCodeCharP("; Starting pCode block"));
+
+  addpBlock(pb);
+
+  sprintf(buffer,"; %s = %s",name,value);
+  
+  addpCode2pBlock(pb,newpCodeCharP(buffer));
+  addpCode2pBlock(pb,newpCodeLabel(name,-1));
+
+  do {
+    addpCode2pBlock(pb,newpCode(POC_RETLW,newpCodeOpLit(*value)));
+  }while (*value++);
+
+
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+void pCodeReadCodeTable(void)
+{
+  pBlock *pb;
+
+  fprintf(stderr, " %s\n",__FUNCTION__);
+
+  pb = newpCodeChain(NULL, 'P',newpCodeCharP("; Starting pCode block"));
+
+  addpBlock(pb);
+
+  addpCode2pBlock(pb,newpCodeCharP("; ReadCodeTable - built in function"));
+  addpCode2pBlock(pb,newpCodeCharP("; Inputs: temp1,temp2 = code pointer"));
+  addpCode2pBlock(pb,newpCodeCharP("; Outpus: W (from RETLW at temp2:temp1)"));
+  addpCode2pBlock(pb,newpCodeLabel("ReadCodeTable:",-1));
+
+  addpCode2pBlock(pb,newpCode(POC_MOVFW,newpCodeOpRegFromStr("temp2")));
+  addpCode2pBlock(pb,newpCode(POC_MOVWF,newpCodeOpRegFromStr("PCLATH")));
+  addpCode2pBlock(pb,newpCode(POC_MOVFW,newpCodeOpRegFromStr("temp1")));
+  addpCode2pBlock(pb,newpCode(POC_MOVWF,newpCodeOpRegFromStr("PCL")));
+
+
+}
+
 /*-----------------------------------------------------------------*/
 /* addpCode2pBlock - place the pCode into the pBlock linked list   */
 /*-----------------------------------------------------------------*/
 void addpCode2pBlock(pBlock *pb, pCode *pc)
 {
+
+  if(!pc)
+    return;
+
   if(!pb->pcHead) {
     /* If this is the first pcode to be added to a block that
      * was initialized with a NULL pcode, then go ahead and
      * make this pcode the head and tail */
     pb->pcHead  = pb->pcTail = pc;
   } else {
+    //    if(pb->pcTail)
     pb->pcTail->next = pc;
+
     pc->prev = pb->pcTail;
-    pc->next = NULL;
     pc->pb = pb;
+
     pb->pcTail = pc;
   }
 }
@@ -1431,10 +2469,12 @@ void addpCode2pBlock(pBlock *pb, pCode *pc)
 /*-----------------------------------------------------------------*/
 void addpBlock(pBlock *pb)
 {
+  // fprintf(stderr," Adding pBlock: dbName =%c\n",getpBlock_dbName(pb));
 
   if(!the_pFile) {
     /* First time called, we'll pass through here. */
-    _ALLOC(the_pFile,sizeof(the_pFile));
+    //_ALLOC(the_pFile,sizeof(pFile));
+    the_pFile = Safe_calloc(1,sizeof(pFile));
     the_pFile->pbHead = the_pFile->pbTail = pb;
     the_pFile->functions = NULL;
     return;
@@ -1446,6 +2486,43 @@ void addpBlock(pBlock *pb)
   the_pFile->pbTail = pb;
 }
 
+/*-----------------------------------------------------------------*/
+/* removepBlock - remove a pBlock from the pFile                   */
+/*-----------------------------------------------------------------*/
+void removepBlock(pBlock *pb)
+{
+  pBlock *pbs;
+
+  if(!the_pFile)
+    return;
+
+
+  //fprintf(stderr," Removing pBlock: dbName =%c\n",getpBlock_dbName(pb));
+
+  for(pbs = the_pFile->pbHead; pbs; pbs = pbs->next) {
+    if(pbs == pb) {
+
+      if(pbs == the_pFile->pbHead)
+       the_pFile->pbHead = pbs->next;
+
+      if (pbs == the_pFile->pbTail) 
+       the_pFile->pbTail = pbs->prev;
+
+      if(pbs->next)
+       pbs->next->prev = pbs->prev;
+
+      if(pbs->prev)
+       pbs->prev->next = pbs->next;
+
+      return;
+
+    }
+  }
+
+  fprintf(stderr, "Warning: call to %s:%s didn't find pBlock\n",__FILE__,__FUNCTION__);
+
+}
+
 /*-----------------------------------------------------------------*/
 /* printpCode - write the contents of a pCode to a file            */
 /*-----------------------------------------------------------------*/
@@ -1489,12 +2566,15 @@ void printpBlock(FILE *of, pBlock *pb)
 /*                                                                 */
 /*-----------------------------------------------------------------*/
 
-static void unlinkPC(pCode *pc)
+void unlinkpCode(pCode *pc)
 {
 
 
   if(pc) {
-
+#ifdef PCODE_DEBUG
+    fprintf(stderr,"Unlinking: ");
+    printpCode(stderr, pc);
+#endif
     if(pc->prev) 
       pc->prev->next = pc->next;
     if(pc->next)
@@ -1503,67 +2583,435 @@ static void unlinkPC(pCode *pc)
     pc->prev = pc->next = NULL;
   }
 }
-static void genericDestruct(pCode *pc)
-{
-  fprintf(stderr,"warning, calling default pCode destructor\n");
-
-  unlinkPC(pc);
-
-  free(pc);
-
-}
 
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
 
-void pBlockRegs(FILE *of, pBlock *pb)
+static void genericDestruct(pCode *pc)
 {
 
-  regs  *r;
+  unlinkpCode(pc);
 
-  r = setFirstItem(pb->registers);
-  while (r) {
-    r = setNextItem(pb->registers);
+  if(isPCI(pc)) {
+    /* For instructions, tell the register (if there's one used)
+     * that it's no longer needed */
+    regs *reg = getRegFromInstruction(pc);
+    if(reg)
+      deleteSetItem (&(reg->reglives.usedpCodes),pc);
   }
-}
 
+  /* Instead of deleting the memory used by this pCode, mark
+   * the object as bad so that if there's a pointer to this pCode
+   * dangling around somewhere then (hopefully) when the type is
+   * checked we'll catch it.
+   */
 
-static char *get_op( pCodeInstruction *pcc)
-{
-  regs *r;
-
-  if(pcc && pcc->pcop) {
+  pc->type = PC_BAD;
 
+  addpCode2pBlock(pb_dead_pcodes, pc);
 
-    switch(pcc->pcop->type) {
+  //free(pc);
 
-    case PO_FSR:
-    case PO_GPR_TEMP:
-    case PO_GPR_BIT:
-      r = pic14_regWithIdx(PCOR(pcc->pcop)->r->rIdx);
-      //fprintf(stderr,"getop: getting %s\nfrom:\n",r->name); //pcc->pcop->name);
-      pBlockRegs(stderr,pcc->pc.pb);
-      return r->name;
+}
 
-    default:
-      if  (pcc->pcop->name)
-       return pcc->pcop->name;
 
+/*-----------------------------------------------------------------*/
+/*  Copies the pCodeInstruction flow pointer from source pCode     */
+/*-----------------------------------------------------------------*/
+static void CopyFlow(pCodeInstruction *pcd, pCode *pcs) {
+  pCode *p;
+  pCodeFlow *pcflow = 0;
+  for (p=pcs; p; p=p->prev) {
+    if (isPCI(p)) {
+      pcflow = PCI(p)->pcflow;
+      break;
+    }
+    if (isPCF(p)) {
+      pcflow = (pCodeFlow*)p;
+      break;
     }
   }
-
-  return "NO operand";
+  PCI(pcd)->pcflow = pcflow;
 }
 
 /*-----------------------------------------------------------------*/
+/*  pCodeInsertAfter - splice in the pCode chain starting with pc2 */
+/*                     into the pCode chain containing pc1         */
 /*-----------------------------------------------------------------*/
-static void pCodeOpPrint(FILE *of, pCodeOp *pcop)
+void pCodeInsertAfter(pCode *pc1, pCode *pc2)
 {
 
-  fprintf(of,"pcodeopprint\n");
+  if(!pc1 || !pc2)
+    return;
+
+  pc2->next = pc1->next;
+  if(pc1->next)
+    pc1->next->prev = pc2;
+
+  pc2->pb = pc1->pb;
+  pc2->prev = pc1;
+  pc1->next = pc2;
+
+  /* If this is an instrution type propogate the flow */
+  if (isPCI(pc2))
+    CopyFlow(PCI(pc2),pc1);
 }
 
-char *pCode2str(char *str, int size, pCode *pc)
+/*------------------------------------------------------------------*/
+/*  pCodeInsertBefore - splice in the pCode chain starting with pc2 */
+/*                      into the pCode chain containing pc1         */
+/*------------------------------------------------------------------*/
+void pCodeInsertBefore(pCode *pc1, pCode *pc2)
 {
-  char *s = str;
+
+  if(!pc1 || !pc2)
+    return;
+
+  pc2->prev = pc1->prev;
+  if(pc1->prev)
+    pc1->prev->next = pc2;
+
+  pc2->pb = pc1->pb;
+  pc2->next = pc1;
+  pc1->prev = pc2;
+
+  /* If this is an instrution type propogate the flow */
+  if (isPCI(pc2))
+    CopyFlow(PCI(pc2),pc1);
+}
+
+/*-----------------------------------------------------------------*/
+/* pCodeOpCopy - copy a pcode operator                             */
+/*-----------------------------------------------------------------*/
+pCodeOp *pCodeOpCopy(pCodeOp *pcop)
+{
+  pCodeOp *pcopnew=NULL;
+
+  if(!pcop)
+    return NULL;
+
+  switch(pcop->type) { 
+  case PO_CRY:
+  case PO_BIT:
+    //DFPRINTF((stderr,"pCodeOpCopy bit\n"));
+    pcopnew = Safe_calloc(1,sizeof(pCodeOpRegBit) );
+    PCORB(pcopnew)->bit = PCORB(pcop)->bit;
+    PCORB(pcopnew)->inBitSpace = PCORB(pcop)->inBitSpace;
+
+    break;
+
+  case PO_WILD:
+    /* Here we expand the wild card into the appropriate type: */
+    /* By recursively calling pCodeOpCopy */
+    //DFPRINTF((stderr,"pCodeOpCopy wild\n"));
+    if(PCOW(pcop)->matched)
+      pcopnew = pCodeOpCopy(PCOW(pcop)->matched);
+    else {
+      // Probably a label
+      pcopnew = pCodeOpCopy(PCOW(pcop)->subtype);
+      pcopnew->name = Safe_strdup(PCOW(pcop)->pcwb->vars[PCOW(pcop)->id]);
+      //DFPRINTF((stderr,"copied a wild op named %s\n",pcopnew->name));
+    }
+
+    return pcopnew;
+    break;
+
+  case PO_LABEL:
+    //DFPRINTF((stderr,"pCodeOpCopy label\n"));
+    pcopnew = Safe_calloc(1,sizeof(pCodeOpLabel) );
+    PCOLAB(pcopnew)->key =  PCOLAB(pcop)->key;
+    break;
+
+  case PO_IMMEDIATE:
+    pcopnew = Safe_calloc(1,sizeof(pCodeOpImmd) );
+    PCOI(pcopnew)->index = PCOI(pcop)->index;
+    PCOI(pcopnew)->offset = PCOI(pcop)->offset;
+    PCOI(pcopnew)->_const = PCOI(pcop)->_const;
+    PCOI(pcopnew)->_function = PCOI(pcop)->_function;
+    break;
+
+  case PO_LITERAL:
+    //DFPRINTF((stderr,"pCodeOpCopy lit\n"));
+    pcopnew = Safe_calloc(1,sizeof(pCodeOpLit) );
+    PCOL(pcopnew)->lit = PCOL(pcop)->lit;
+    break;
+
+  case PO_GPR_BIT:
+
+    pcopnew = newpCodeOpBit(pcop->name, PCORB(pcop)->bit,PCORB(pcop)->inBitSpace);
+    PCOR(pcopnew)->r = PCOR(pcop)->r;
+    PCOR(pcopnew)->rIdx = PCOR(pcop)->rIdx;
+    DFPRINTF((stderr," pCodeOpCopy Bit -register index\n"));
+    return pcopnew;
+    break;
+
+  case PO_GPR_POINTER:
+  case PO_GPR_REGISTER:
+  case PO_GPR_TEMP:
+  case PO_FSR:
+  case PO_INDF:
+    //DFPRINTF((stderr,"pCodeOpCopy GPR register\n"));
+    pcopnew = Safe_calloc(1,sizeof(pCodeOpReg) );
+    PCOR(pcopnew)->r = PCOR(pcop)->r;
+    PCOR(pcopnew)->rIdx = PCOR(pcop)->rIdx;
+    PCOR(pcopnew)->instance = PCOR(pcop)->instance;
+    DFPRINTF((stderr," register index %d\n", PCOR(pcop)->r->rIdx));
+    break;
+
+  case PO_DIR:
+    //fprintf(stderr,"pCodeOpCopy PO_DIR\n");
+    pcopnew = Safe_calloc(1,sizeof(pCodeOpReg) );
+    PCOR(pcopnew)->r = PCOR(pcop)->r;
+    PCOR(pcopnew)->rIdx = PCOR(pcop)->rIdx;
+    PCOR(pcopnew)->instance = PCOR(pcop)->instance;
+    break;
+  case PO_STATUS:
+    DFPRINTF((stderr,"pCodeOpCopy PO_STATUS\n"));
+  case PO_SFR_REGISTER:
+  case PO_STR:
+  case PO_NONE:
+  case PO_W:
+  case PO_INTCON:
+  case PO_PCL:
+  case PO_PCLATH:
+
+    //DFPRINTF((stderr,"pCodeOpCopy register type %d\n", pcop->type));
+    pcopnew = Safe_calloc(1,sizeof(pCodeOp) );
+
+  }
+
+  pcopnew->type = pcop->type;
+  if(pcop->name)
+    pcopnew->name = Safe_strdup(pcop->name);
+  else
+    pcopnew->name = NULL;
+
+  return pcopnew;
+}
+
+/*-----------------------------------------------------------------*/
+/* popCopyReg - copy a pcode operator                              */
+/*-----------------------------------------------------------------*/
+pCodeOp *popCopyReg(pCodeOpReg *pc)
+{
+  pCodeOpReg *pcor;
+
+  pcor = Safe_calloc(1,sizeof(pCodeOpReg) );
+  pcor->pcop.type = pc->pcop.type;
+  if(pc->pcop.name) {
+    if(!(pcor->pcop.name = Safe_strdup(pc->pcop.name)))
+      fprintf(stderr,"oops %s %d",__FILE__,__LINE__);
+  } else
+    pcor->pcop.name = NULL;
+
+  pcor->r = pc->r;
+  pcor->rIdx = pc->rIdx;
+  pcor->r->wasUsed=1;
+
+  //DEBUGpic14_emitcode ("; ***","%s  , copying %s, rIdx=%d",__FUNCTION__,pc->pcop.name,pc->rIdx);
+
+  return PCOP(pcor);
+}
+
+/*-----------------------------------------------------------------*/
+/* pCodeInstructionCopy - copy a pCodeInstructionCopy              */
+/*-----------------------------------------------------------------*/
+pCode *pCodeInstructionCopy(pCodeInstruction *pci,int invert)
+{
+  pCodeInstruction *new_pci;
+
+  if(invert)
+    new_pci = PCI(newpCode(pci->inverted_op,pci->pcop));
+  else
+    new_pci = PCI(newpCode(pci->op,pci->pcop));
+
+  new_pci->pc.pb = pci->pc.pb;
+  new_pci->from = pci->from;
+  new_pci->to   = pci->to;
+  new_pci->label = pci->label;
+  new_pci->pcflow = pci->pcflow;
+
+  return PCODE(new_pci);
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+void pCodeDeleteChain(pCode *f,pCode *t)
+{
+  pCode *pc;
+
+  while(f && f!=t) {
+    DFPRINTF((stderr,"delete pCode:\n"));
+    pc = f->next;
+    //f->print(stderr,f);
+    //f->delete(f);  this dumps core...
+    f = pc;
+  }
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+void pBlockRegs(FILE *of, pBlock *pb)
+{
+
+  regs  *r;
+
+  r = setFirstItem(pb->tregisters);
+  while (r) {
+    r = setNextItem(pb->tregisters);
+  }
+}
+
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+char *get_op(pCodeOp *pcop,char *buffer, size_t size)
+{
+  regs *r;
+  static char b[50];
+  char *s;
+  int use_buffer = 1;    // copy the string to the passed buffer pointer
+
+  if(!buffer) {
+    buffer = b;
+    size = sizeof(b);
+    use_buffer = 0;     // Don't bother copying the string to the buffer.
+  } 
+
+  if(pcop) {
+    switch(pcop->type) {
+    case PO_INDF:
+    case PO_FSR:
+      if(use_buffer) {
+       SAFE_snprintf(&buffer,&size,"%s",PCOR(pcop)->r->name);
+       return buffer;
+      }
+      //return PCOR(pcop)->r->name;
+      return pcop->name;
+      break;
+    case PO_GPR_TEMP:
+      if (PCOR(pcop)->r->type == REG_STK)
+        r = typeRegWithIdx(PCOR(pcop)->r->rIdx,REG_STK,1);
+      else
+        r = pic14_regWithIdx(PCOR(pcop)->r->rIdx);
+
+      if(use_buffer) {
+       SAFE_snprintf(&buffer,&size,"%s",r->name);
+       return buffer;
+      }
+
+      return r->name;
+
+
+    case PO_IMMEDIATE:
+      s = buffer;
+
+      if(PCOI(pcop)->_const) {
+
+       if( PCOI(pcop)->offset && PCOI(pcop)->offset<4) {
+         switch(PCOI(pcop)->offset) {
+         case 0:
+           SAFE_snprintf(&s,&size,"low %s",pcop->name);
+           break;
+         case 1:
+           SAFE_snprintf(&s,&size,"high %s",pcop->name);
+           break;
+         default:
+           SAFE_snprintf(&s,&size,"(((%s+%d) >> %d)&0xff)",
+                         pcop->name,
+                         PCOI(pcop)->index,
+                         8 * PCOI(pcop)->offset );
+         }
+       } else
+         SAFE_snprintf(&s,&size,"LOW(%s+%d)",pcop->name,PCOI(pcop)->index);
+      } else {
+      
+       if( PCOI(pcop)->index) { // && PCOI(pcc->pcop)->offset<4) {
+         SAFE_snprintf(&s,&size,"(%s + %d)",
+                       pcop->name,
+                       PCOI(pcop)->index );
+       } else {
+         switch(PCOI(pcop)->offset) {
+         case 0:
+           SAFE_snprintf(&s,&size,"%s",pcop->name);
+           break;
+         case 1:
+           SAFE_snprintf(&s,&size,"high %s",pcop->name);
+           break;
+         default:
+           SAFE_snprintf(&s,&size,"(%s >> %d)&0xff",pcop->name, 8*PCOI(pcop)->offset);
+         }
+       }
+      }
+
+      return buffer;
+
+    case PO_DIR:
+      s = buffer;
+      //size = sizeof(buffer);
+      if( PCOR(pcop)->instance) {
+       SAFE_snprintf(&s,&size,"(%s + %d)",
+                     pcop->name,
+                     PCOR(pcop)->instance );
+       //fprintf(stderr,"PO_DIR %s\n",buffer);
+      } else
+       SAFE_snprintf(&s,&size,"%s",pcop->name);
+      return buffer;
+
+    case PO_LABEL:
+      s = buffer;
+      if  (pcop->name) {
+        if(PCOLAB(pcop)->offset == 1)
+          SAFE_snprintf(&s,&size,"HIGH(%s)",pcop->name);
+           else
+          SAFE_snprintf(&s,&size,"%s",pcop->name);
+      }
+      return buffer;
+
+    default:
+      if  (pcop->name) {
+       if(use_buffer) {
+         SAFE_snprintf(&buffer,&size,"%s",pcop->name);
+         return buffer;
+       }
+       return pcop->name;
+      }
+
+    }
+  }
+
+  return "NO operand";
+
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+static char *get_op_from_instruction( pCodeInstruction *pcc)
+{
+
+  if(pcc )
+    return get_op(pcc->pcop,NULL,0);
+
+  /* gcc 3.2:  warning: concatenation of string literals with __FUNCTION__ is deprecated 
+  return ("ERROR Null: "__FUNCTION__);
+  */
+  return ("ERROR Null: get_op_from_instruction");
+
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+static void pCodeOpPrint(FILE *of, pCodeOp *pcop)
+{
+
+  fprintf(of,"pcodeopprint- not implemented\n");
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+char *pCode2str(char *str, size_t size, pCode *pc)
+{
+  char *s = str;
 
   switch(pc->type) {
 
@@ -1573,33 +3021,34 @@ char *pCode2str(char *str, int size, pCode *pc)
 
     if( (PCI(pc)->num_ops >= 1) && (PCI(pc)->pcop)) {
 
-      if(PCI(pc)->bit_inst) {
-       if(PCI(pc)->pcop->type == PO_BIT) {
-         if( (((pCodeOpBit *)(PCI(pc)->pcop))->inBitSpace) )
-           SAFE_snprintf(&s,&size,"(%s >> 3), (%s & 7)", 
-                         PCI(pc)->pcop->name ,
-                         PCI(pc)->pcop->name );
-         else
-           SAFE_snprintf(&s,&size,"%s,%d", get_op(PCI(pc)), 
-                         (((pCodeOpBit *)(PCI(pc)->pcop))->bit ));
+      if(PCI(pc)->isBitInst) {
+       if(PCI(pc)->pcop->type == PO_GPR_BIT) {
+      char *name = PCI(pc)->pcop->name;
+      if (!name) 
+        name = PCOR(PCI(pc)->pcop)->r->name;
+      if( (((pCodeOpRegBit *)(PCI(pc)->pcop))->inBitSpace) )
+           SAFE_snprintf(&s,&size,"(%s >> 3), (%s & 7)", name, name);
+      else
+           SAFE_snprintf(&s,&size,"%s,%d", name, 
+                         (((pCodeOpRegBit *)(PCI(pc)->pcop))->bit)&7);
        } else if(PCI(pc)->pcop->type == PO_GPR_BIT) {
-         SAFE_snprintf(&s,&size,"%s,%d", get_op(PCI(pc)),PCORB(PCI(pc)->pcop)->bit);
+         SAFE_snprintf(&s,&size,"%s,%d", get_op_from_instruction(PCI(pc)),PCORB(PCI(pc)->pcop)->bit);
        }else
-         SAFE_snprintf(&s,&size,"%s,0 ; ?bug", get_op(PCI(pc)));
+         SAFE_snprintf(&s,&size,"%s,0 ; ?bug", get_op_from_instruction(PCI(pc)));
        //PCI(pc)->pcop->t.bit );
       } else {
 
-       if(PCI(pc)->pcop->type == PO_BIT) {
+       if(PCI(pc)->pcop->type == PO_GPR_BIT) {
          if( PCI(pc)->num_ops == 2)
-           SAFE_snprintf(&s,&size,"(%s >> 3),%c",get_op(PCI(pc)),((PCI(pc)->dest) ? 'F':'W'));
+           SAFE_snprintf(&s,&size,"(%s >> 3),%c",get_op_from_instruction(PCI(pc)),((PCI(pc)->isModReg) ? 'F':'W'));
          else
-           SAFE_snprintf(&s,&size,"(1 << (%s & 7))",get_op(PCI(pc)));
+           SAFE_snprintf(&s,&size,"(1 << (%s & 7))",get_op_from_instruction(PCI(pc)));
 
        }else {
-         SAFE_snprintf(&s,&size,"%s",get_op(PCI(pc)));
+         SAFE_snprintf(&s,&size,"%s",get_op_from_instruction(PCI(pc)));
 
          if( PCI(pc)->num_ops == 2)
-           SAFE_snprintf(&s,&size,",%c", ( (PCI(pc)->dest) ? 'F':'W'));
+           SAFE_snprintf(&s,&size,",%c", ( (PCI(pc)->isModReg) ? 'F':'W'));
        }
       }
 
@@ -1611,6 +3060,11 @@ char *pCode2str(char *str, int size, pCode *pc)
     SAFE_snprintf(&s,&size,";%s", ((pCodeComment *)pc)->comment);
     break;
 
+  case PC_INLINE:
+    /* assuming that inline code ends with a \n */
+    SAFE_snprintf(&s,&size,"%s", ((pCodeComment *)pc)->comment);
+    break;
+
   case PC_LABEL:
     SAFE_snprintf(&s,&size,";label=%s, key=%d\n",PCL(pc)->label,PCL(pc)->key);
     break;
@@ -1620,7 +3074,15 @@ char *pCode2str(char *str, int size, pCode *pc)
   case PC_WILD:
     SAFE_snprintf(&s,&size,";\tWild opcode: id=%d\n",PCW(pc)->id);
     break;
+  case PC_FLOW:
+    SAFE_snprintf(&s,&size,";\t--FLOW change\n");
+    break;
+  case PC_CSOURCE:
+    SAFE_snprintf(&s,&size,";#CSRC\t%s %d\n; %s\n", PCCS(pc)->file_name, PCCS(pc)->line_number, PCCS(pc)->line);
+    break;
 
+  case PC_BAD:
+    SAFE_snprintf(&s,&size,";A bad pCode is being used\n");
   }
 
   return str;
@@ -1641,17 +3103,23 @@ static void genericPrint(FILE *of, pCode *pc)
     fprintf(of,";%s\n", ((pCodeComment *)pc)->comment);
     break;
 
+  case PC_INLINE:
+    fprintf(of,"%s\n", ((pCodeComment *)pc)->comment);
+     break;
+
   case PC_OPCODE:
     // If the opcode has a label, print that first
     {
-      pBranch *pbl = pc->label;
-      while(pbl) {
+      pBranch *pbl = PCI(pc)->label;
+      while(pbl && pbl->pc) {
        if(pbl->pc->type == PC_LABEL)
          pCodePrintLabel(of, pbl->pc);
        pbl = pbl->next;
       }
     }
 
+    if(PCI(pc)->cline) 
+      genericPrint(of,PCODE(PCI(pc)->cline));
 
     {
       char str[256];
@@ -1659,8 +3127,15 @@ static void genericPrint(FILE *of, pCode *pc)
       pCode2str(str, 256, pc);
 
       fprintf(of,"%s",str);
-    }
 
+      /* Debug */
+      if(debug_verbose) {
+       fprintf(of, "\t;id=%u,key=%03x",pc->id,pc->seq);
+       if(PCI(pc)->pcflow)
+         fprintf(of,",flow seq=%03x",PCI(pc)->pcflow->pc.seq);
+      }
+    }
+#if 0
     {
       pBranch *dpb = pc->to;   // debug
       while(dpb) {
@@ -1674,21 +3149,24 @@ static void genericPrint(FILE *of, pCode *pc)
        case PC_FUNCTION:
          fprintf(of, "\t;function %s", ( (PCF(dpb->pc)->fname) ? (PCF(dpb->pc)->fname) : "[END]"));
          break;
+       case PC_FLOW:
+         fprintf(of, "\t;flow");
+         break;
        case PC_COMMENT:
        case PC_WILD:
          break;
        }
        dpb = dpb->next;
       }
-      fprintf(of,"\n");
     }
-
+#endif
+    fprintf(of,"\n");
     break;
 
   case PC_WILD:
     fprintf(of,";\tWild opcode: id=%d\n",PCW(pc)->id);
-    if(pc->label)
-      pCodePrintLabel(of, pc->label->pc);
+    if(PCW(pc)->pci.label)
+      pCodePrintLabel(of, PCW(pc)->pci.label->pc);
 
     if(PCW(pc)->operand) {
       fprintf(of,";\toperand  ");
@@ -1696,6 +3174,19 @@ static void genericPrint(FILE *of, pCode *pc)
     }
     break;
 
+  case PC_FLOW:
+    if(debug_verbose) {
+      fprintf(of,";<>Start of new flow, seq=0x%x",pc->seq);
+      if(PCFL(pc)->ancestor)
+       fprintf(of," ancestor = 0x%x", PCODE(PCFL(pc)->ancestor)->seq);
+      fprintf(of,"\n");
+
+    }
+    break;
+
+  case PC_CSOURCE:
+    fprintf(of,";#CSRC\t%s %d\n;  %s\n", PCCS(pc)->file_name, PCCS(pc)->line_number, PCCS(pc)->line);
+    break;
   case PC_LABEL:
   default:
     fprintf(of,"unknown pCode type %d\n",pc->type);
@@ -1717,7 +3208,7 @@ static void pCodePrintFunction(FILE *of, pCode *pc)
     fprintf(of,"F_%s",((pCodeFunction *)pc)->modname);
 
   if(PCF(pc)->fname) {
-    pBranch *exits = pc->to;
+    pBranch *exits = PCF(pc)->to;
     int i=0;
     fprintf(of,"%s\t;Function start\n",PCF(pc)->fname);
     while(exits) {
@@ -1728,10 +3219,10 @@ static void pCodePrintFunction(FILE *of, pCode *pc)
     fprintf(of,"; %d exit point%c\n",i, ((i==1) ? ' ':'s'));
     
   }else {
-    if(pc->from && 
-       pc->from->pc->type == PC_FUNCTION &&
-       PCF(pc->from->pc)->fname) 
-      fprintf(of,"; exit point of %s\n",PCF(pc->from->pc)->fname);
+    if((PCF(pc)->from && 
+       PCF(pc)->from->pc->type == PC_FUNCTION &&
+       PCF(PCF(pc)->from->pc)->fname) )
+      fprintf(of,"; exit point of %s\n",PCF(PCF(pc)->from->pc)->fname);
     else
       fprintf(of,"; exit point [can't find entry point]\n");
   }
@@ -1755,16 +3246,41 @@ static void pCodePrintLabel(FILE *of, pCode *pc)
 
 }
 /*-----------------------------------------------------------------*/
-static void  unlinkpCodeFromBranch(pBranch *pb , pCode *pc)
+/* unlinkpCodeFromBranch - Search for a label in a pBranch and     */
+/*                         remove it if it is found.               */
+/*-----------------------------------------------------------------*/
+static void unlinkpCodeFromBranch(pCode *pcl , pCode *pc)
 {
   pBranch *b, *bprev;
 
+
   bprev = NULL;
-  b = pb;
+
+  if(pcl->type == PC_OPCODE)
+    b = PCI(pcl)->label;
+  else {
+    fprintf(stderr, "LINE %d. can't unlink from non opcode\n",__LINE__);
+    exit(1);
+
+  }
+
+  //fprintf (stderr, "%s \n",__FUNCTION__);
+  //pcl->print(stderr,pcl);
+  //pc->print(stderr,pc);
   while(b) {
     if(b->pc == pc) {
-      if(bprev)
-       bprev->next = b->next;
+      //fprintf (stderr, "found label\n");
+
+      /* Found a label */
+      if(bprev) {
+       bprev->next = b->next;  /* Not first pCode in chain */
+       free(b);
+      } else {
+       pc->destruct(pc);
+       PCI(pcl)->label = b->next;   /* First pCode in chain */
+       free(b);
+      }
+      return;  /* A label can't occur more than once */
     }
     bprev = b;
     b = b->next;
@@ -1772,13 +3288,18 @@ static void  unlinkpCodeFromBranch(pBranch *pb , pCode *pc)
 
 }
 
-static pBranch * pBranchAppend(pBranch *h, pBranch *n)
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+pBranch * pBranchAppend(pBranch *h, pBranch *n)
 {
   pBranch *b;
 
   if(!h)
     return n;
 
+  if(h == n)
+    return n;
+
   b = h;
   while(b->next)
     b = b->next;
@@ -1792,22 +3313,24 @@ static pBranch * pBranchAppend(pBranch *h, pBranch *n)
 /* pBranchLink - given two pcodes, this function will link them    */
 /*               together through their pBranches                  */
 /*-----------------------------------------------------------------*/
-static void pBranchLink(pCode *f, pCode *t)
+static void pBranchLink(pCodeFunction *f, pCodeFunction *t)
 {
   pBranch *b;
 
   // Declare a new branch object for the 'from' pCode.
 
-  _ALLOC(b,sizeof(pBranch));
-  b->pc = t;                    // The link to the 'to' pCode.
+  //_ALLOC(b,sizeof(pBranch));
+  b = Safe_calloc(1,sizeof(pBranch));
+  b->pc = PCODE(t);             // The link to the 'to' pCode.
   b->next = NULL;
 
   f->to = pBranchAppend(f->to,b);
 
   // Now do the same for the 'to' pCode.
 
-  _ALLOC(b,sizeof(pBranch));
-  b->pc = f;
+  //_ALLOC(b,sizeof(pBranch));
+  b = Safe_calloc(1,sizeof(pBranch));
+  b->pc = PCODE(f);
   b->next = NULL;
 
   t->from = pBranchAppend(t->from,b);
@@ -1878,6 +3401,7 @@ static void pCodeUnlink(pCode *pc)
 #endif
 /*-----------------------------------------------------------------*/
 /*-----------------------------------------------------------------*/
+#if 0
 static void genericAnalyze(pCode *pc)
 {
   switch(pc->type) {
@@ -1902,10 +3426,22 @@ static void genericAnalyze(pCode *pc)
        } else
          npc = npc->next;
       }
+      /* reached the end of the pcode chain without finding
+       * an instruction we could link to. */
     }
+    break;
+  case PC_FLOW:
+    fprintf(stderr,"analyze PC_FLOW\n");
+
+    return;
+  case PC_BAD:
+    fprintf(stderr,";A bad pCode is being used\n");
+
   }
 }
+#endif
 
+/*-----------------------------------------------------------------*/
 /*-----------------------------------------------------------------*/
 int compareLabel(pCode *pc, pCodeOpLabel *pcop_label)
 {
@@ -1916,7 +3452,7 @@ int compareLabel(pCode *pc, pCodeOpLabel *pcop_label)
       return TRUE;
   }
   if(pc->type == PC_OPCODE) {
-    pbr = pc->label;
+    pbr = PCI(pc)->label;
     while(pbr) {
       if(pbr->pc->type == PC_LABEL) {
        if( ((pCodeLabel *)(pbr->pc))->key ==  pcop_label->key)
@@ -1929,6 +3465,42 @@ int compareLabel(pCode *pc, pCodeOpLabel *pcop_label)
   return FALSE;
 }
 
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+int checkLabel(pCode *pc)
+{
+  pBranch *pbr;
+
+  if(pc && isPCI(pc)) {
+    pbr = PCI(pc)->label;
+    while(pbr) {
+      if(isPCL(pbr->pc) && (PCL(pbr->pc)->key >= 0))
+       return TRUE;
+
+      pbr = pbr->next;
+    }
+  }
+
+  return FALSE;
+}
+
+/*-----------------------------------------------------------------*/
+/* findLabelinpBlock - Search the pCode for a particular label     */
+/*-----------------------------------------------------------------*/
+pCode * findLabelinpBlock(pBlock *pb,pCodeOpLabel *pcop_label)
+{
+  pCode  *pc;
+
+  if(!pb)
+    return NULL;
+
+  for(pc = pb->pcHead; pc; pc = pc->next) 
+    if(compareLabel(pc,pcop_label))
+      return pc;
+    
+  return NULL;
+}
+
 /*-----------------------------------------------------------------*/
 /* findLabel - Search the pCode for a particular label             */
 /*-----------------------------------------------------------------*/
@@ -1941,37 +3513,82 @@ pCode * findLabel(pCodeOpLabel *pcop_label)
     return NULL;
 
   for(pb = the_pFile->pbHead; pb; pb = pb->next) {
-    for(pc = pb->pcHead; pc; pc = pc->next) 
-      if(compareLabel(pc,pcop_label))
-       return pc;
-    
+    if( (pc = findLabelinpBlock(pb,pcop_label)) != NULL)
+      return pc;
   }
 
   fprintf(stderr,"Couldn't find label %s", pcop_label->pcop.name);
   return NULL;
 }
 
+/*-----------------------------------------------------------------*/
+/* findNextpCode - given a pCode, find the next of type 'pct'      */
+/*                 in the linked list                              */
+/*-----------------------------------------------------------------*/
+pCode * findNextpCode(pCode *pc, PC_TYPE pct)
+{
+
+  while(pc) {
+    if(pc->type == pct)
+      return pc;
+
+    pc = pc->next;
+  }
+
+  return NULL;
+}
+
+/*-----------------------------------------------------------------*/
+/* findPrevpCode - given a pCode, find the previous of type 'pct'  */
+/*                 in the linked list                              */
+/*-----------------------------------------------------------------*/
+pCode * findPrevpCode(pCode *pc, PC_TYPE pct)
+{
+
+  while(pc) {
+    if(pc->type == pct)
+      return pc;
+
+    pc = pc->prev;
+  }
+
+  return NULL;
+}
 /*-----------------------------------------------------------------*/
 /* findNextInstruction - given a pCode, find the next instruction  */
 /*                       in the linked list                        */
 /*-----------------------------------------------------------------*/
-pCode * findNextInstruction(pCode *pc)
+pCode * findNextInstruction(pCode *pci)
 {
+  pCode *pc = pci;
 
   while(pc) {
     if((pc->type == PC_OPCODE) || (pc->type == PC_WILD))
       return pc;
 
+#ifdef PCODE_DEBUG
+    fprintf(stderr,"findNextInstruction:  ");
+    printpCode(stderr, pc);
+#endif
     pc = pc->next;
   }
 
-  fprintf(stderr,"Couldn't find instruction\n");
+  //fprintf(stderr,"Couldn't find instruction\n");
   return NULL;
 }
 
+/*-----------------------------------------------------------------*/
+/* findNextInstruction - given a pCode, find the next instruction  */
+/*                       in the linked list                        */
+/*-----------------------------------------------------------------*/
+pCode * findPrevInstruction(pCode *pci)
+{
+  return findPrevpCode(pci, PC_OPCODE);
+}
+
 /*-----------------------------------------------------------------*/
 /* findFunctionEnd - given a pCode find the end of the function    */
-/*                   that contains it     t                        */
+/*                   that contains it                              */
 /*-----------------------------------------------------------------*/
 pCode * findFunctionEnd(pCode *pc)
 {
@@ -2000,6 +3617,7 @@ static void AnalyzeLabel(pCode *pc)
 }
 #endif
 
+#if 0
 static void AnalyzeGOTO(pCode *pc)
 {
 
@@ -2022,58 +3640,1221 @@ static void AnalyzeRETURN(pCode *pc)
 
 }
 
+#endif
 
-void AnalyzepBlock(pBlock *pb)
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+regs * getRegFromInstruction(pCode *pc)
 {
-  pCode *pc;
 
-  if(!pb)
-    return;
+  if(!pc                   || 
+     !isPCI(pc)            ||
+     !PCI(pc)->pcop        ||
+     PCI(pc)->num_ops == 0 )
+    return NULL;
+
+  switch(PCI(pc)->pcop->type) {
+  case PO_INDF:
+  case PO_FSR:
+    return PCOR(PCI(pc)->pcop)->r;
+
+    //    return typeRegWithIdx (PCOR(PCI(pc)->pcop)->rIdx, REG_SFR, 0);
+
+  case PO_BIT:
+  case PO_GPR_TEMP:
+    //fprintf(stderr, "getRegFromInstruction - bit or temp\n");
+    return PCOR(PCI(pc)->pcop)->r;
+
+  case PO_IMMEDIATE:
+    if(PCOI(PCI(pc)->pcop)->r)
+      return (PCOI(PCI(pc)->pcop)->r);
+
+    //fprintf(stderr, "getRegFromInstruction - immediate\n");
+    return dirregWithName(PCI(pc)->pcop->name);
+    //return NULL; // PCOR(PCI(pc)->pcop)->r;
+
+  case PO_GPR_BIT:
+    return PCOR(PCI(pc)->pcop)->r;
+
+  case PO_GPR_REGISTER:
+  case PO_DIR:
+    //fprintf(stderr, "getRegFromInstruction - dir\n");
+    return PCOR(PCI(pc)->pcop)->r;
+  case PO_LITERAL:
+    //fprintf(stderr, "getRegFromInstruction - literal\n");
+    break;
+
+  default:
+    //fprintf(stderr, "getRegFromInstruction - unknown reg type %d\n",PCI(pc)->pcop->type);
+    //genericPrint(stderr, pc);
+    break;
+  }
+
+  return NULL;
+
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+
+void AnalyzepBlock(pBlock *pb)
+{
+  pCode *pc;
+
+  if(!pb)
+    return;
 
-  /* Find all of the registers used in this pBlock */
+  /* Find all of the registers used in this pBlock 
+   * by looking at each instruction and examining it's
+   * operands
+   */
   for(pc = pb->pcHead; pc; pc = pc->next) {
-    if(pc->type == PC_OPCODE) {
-      if(PCI(pc)->pcop && PCI(pc)->pcop->type == PO_GPR_TEMP) {
+
+    /* Is this an instruction with operands? */
+    if(pc->type == PC_OPCODE && PCI(pc)->pcop) {
+
+      if((PCI(pc)->pcop->type == PO_GPR_TEMP) 
+        || ((PCI(pc)->pcop->type == PO_GPR_BIT) && PCOR(PCI(pc)->pcop)->r && (PCOR(PCI(pc)->pcop)->r->pc_type == PO_GPR_TEMP))) {
 
        /* Loop through all of the registers declared so far in
-          this block and see if we find this new there */
+          this block and see if we find this one there */
 
-       regs *r = setFirstItem(pb->registers);
+       regs *r = setFirstItem(pb->tregisters);
 
        while(r) {
-         if(r->rIdx == PCOR(PCI(pc)->pcop)->r->rIdx) {
+         if((r->rIdx == PCOR(PCI(pc)->pcop)->r->rIdx) && (r->type == PCOR(PCI(pc)->pcop)->r->type)) {
            PCOR(PCI(pc)->pcop)->r = r;
            break;
          }
-         r = setNextItem(pb->registers);
+         r = setNextItem(pb->tregisters);
+       }
+
+       if(!r) {
+         /* register wasn't found */
+         //r = Safe_calloc(1, sizeof(regs));
+         //memcpy(r,PCOR(PCI(pc)->pcop)->r, sizeof(regs));
+         //addSet(&pb->tregisters, r);
+         addSet(&pb->tregisters, PCOR(PCI(pc)->pcop)->r);
+         //PCOR(PCI(pc)->pcop)->r = r;
+         //fprintf(stderr,"added register to pblock: reg %d\n",r->rIdx);
+       }/* else 
+         fprintf(stderr,"found register in pblock: reg %d\n",r->rIdx);
+        */
+      }
+      if(PCI(pc)->pcop->type == PO_GPR_REGISTER) {
+       if(PCOR(PCI(pc)->pcop)->r) {
+         pic14_allocWithIdx (PCOR(PCI(pc)->pcop)->r->rIdx);
+         DFPRINTF((stderr,"found register in pblock: reg 0x%x\n",PCOR(PCI(pc)->pcop)->r->rIdx));
+       } else {
+         if(PCI(pc)->pcop->name)
+           fprintf(stderr,"ERROR: %s is a NULL register\n",PCI(pc)->pcop->name );
+         else
+           fprintf(stderr,"ERROR: NULL register\n");
        }
+      }
+    }
+
+
+  }
+}
+
+/*-----------------------------------------------------------------*/
+/* */
+/*-----------------------------------------------------------------*/
+void InsertpFlow(pCode *pc, pCode **pflow)
+{
+  if(*pflow)
+    PCFL(*pflow)->end = pc;
+
+  if(!pc || !pc->next)
+    return;
+
+  *pflow = newpCodeFlow();
+  pCodeInsertAfter(pc, *pflow);
+}
+
+/*-----------------------------------------------------------------*/
+/* BuildFlow(pBlock *pb) - examine the code in a pBlock and build  */
+/*                         the flow blocks.                        */
+/*
+ * BuildFlow inserts pCodeFlow objects into the pCode chain at each
+ * point the instruction flow changes. 
+ */
+/*-----------------------------------------------------------------*/
+void BuildFlow(pBlock *pb)
+{
+  pCode *pc;
+  pCode *last_pci=NULL;
+  pCode *pflow=NULL;
+  int seq = 0;
+
+  if(!pb)
+    return;
+
+  //fprintf (stderr,"build flow start seq %d  ",GpcFlowSeq);
+  /* Insert a pCodeFlow object at the beginning of a pBlock */
+
+  InsertpFlow(pb->pcHead, &pflow);
+
+  //pflow = newpCodeFlow();    /* Create a new Flow object */
+  //pflow->next = pb->pcHead;  /* Make the current head the next object */
+  //pb->pcHead->prev = pflow;  /* let the current head point back to the flow object */
+  //pb->pcHead = pflow;        /* Make the Flow object the head */
+  //pflow->pb = pb;
+
+  for( pc = findNextInstruction(pb->pcHead);
+       pc != NULL;
+       pc=findNextInstruction(pc)) { 
+
+    pc->seq = seq++;
+    PCI(pc)->pcflow = PCFL(pflow);
+
+    //fprintf(stderr," build: ");
+    //pflow->print(stderr,pflow);
+
+    if( PCI(pc)->isSkip) {
+
+      /* The two instructions immediately following this one 
+       * mark the beginning of a new flow segment */
+
+      while(pc && PCI(pc)->isSkip) {
+
+       PCI(pc)->pcflow = PCFL(pflow);
+       pc->seq = seq-1;
+       seq = 1;
+
+       InsertpFlow(pc, &pflow);
+       pc=findNextInstruction(pc->next);
+      }
+
+      seq = 0;
+
+      if(!pc)
+       break;
+
+      PCI(pc)->pcflow = PCFL(pflow);
+      pc->seq = 0;
+      InsertpFlow(pc, &pflow);
+
+    } else if ( PCI(pc)->isBranch && !checkLabel(findNextInstruction(pc->next)))  {
+
+      InsertpFlow(pc, &pflow);
+      seq = 0;
+
+    } else if (checkLabel(pc)) { 
+
+      /* This instruction marks the beginning of a
+       * new flow segment */
+
+      pc->seq = 0;
+      seq = 1;
+
+      /* If the previous pCode is not a flow object, then 
+       * insert a new flow object. (This check prevents 
+       * two consecutive flow objects from being insert in
+       * the case where a skip instruction preceeds an
+       * instruction containing a label.) */
+
+      if(last_pci && (PCI(last_pci)->pcflow == PCFL(pflow)))
+       InsertpFlow(findPrevInstruction(pc->prev), &pflow);
+
+      PCI(pc)->pcflow = PCFL(pflow);
+      
+    }
+    last_pci = pc;
+    pc = pc->next;
+  }
+
+  //fprintf (stderr,",end seq %d",GpcFlowSeq);
+  if(pflow)
+    PCFL(pflow)->end = pb->pcTail;
+}
+
+/*-------------------------------------------------------------------*/
+/* unBuildFlow(pBlock *pb) - examine the code in a pBlock and build  */
+/*                           the flow blocks.                        */
+/*
+ * unBuildFlow removes pCodeFlow objects from a pCode chain
+ */
+/*-----------------------------------------------------------------*/
+void unBuildFlow(pBlock *pb)
+{
+  pCode *pc,*pcnext;
+
+  if(!pb)
+    return;
+
+  pc = pb->pcHead;
+
+  while(pc) {
+    pcnext = pc->next;
+
+    if(isPCI(pc)) {
+
+      pc->seq = 0;
+      if(PCI(pc)->pcflow) {
+       //free(PCI(pc)->pcflow);
+       PCI(pc)->pcflow = NULL;
+      }
+
+    } else if(isPCFL(pc) )
+      pc->destruct(pc);
+
+    pc = pcnext;
+  }
+
+
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+void dumpCond(int cond)
+{
+
+  static char *pcc_str[] = {
+    //"PCC_NONE",
+    "PCC_REGISTER",
+    "PCC_C",
+    "PCC_Z",
+    "PCC_DC",
+    "PCC_W",
+    "PCC_EXAMINE_PCOP",
+    "PCC_REG_BANK0",
+    "PCC_REG_BANK1",
+    "PCC_REG_BANK2",
+    "PCC_REG_BANK3"
+  };
+
+  int ncond = sizeof(pcc_str) / sizeof(char *);
+  int i,j;
+
+  fprintf(stderr, "0x%04X\n",cond);
+
+  for(i=0,j=1; i<ncond; i++, j<<=1)
+    if(cond & j)
+      fprintf(stderr, "  %s\n",pcc_str[i]);
+
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+void FlowStats(pCodeFlow *pcflow)
+{
+
+  pCode *pc;
+
+  if(!isPCFL(pcflow))
+    return;
+
+  fprintf(stderr, " FlowStats - flow block (seq=%d)\n", pcflow->pc.seq);
+
+  pc = findNextpCode(PCODE(pcflow), PC_OPCODE); 
+
+  if(!pc) {
+    fprintf(stderr, " FlowStats - empty flow (seq=%d)\n", pcflow->pc.seq);
+    return;
+  }
+
+
+  fprintf(stderr, "  FlowStats inCond: ");
+  dumpCond(pcflow->inCond);
+  fprintf(stderr, "  FlowStats outCond: ");
+  dumpCond(pcflow->outCond);
+
+}
+
+/*-----------------------------------------------------------------*
+ * int isBankInstruction(pCode *pc) - examine the pCode *pc to determine
+ *    if it affects the banking bits. 
+ * 
+ * return: -1 == Banking bits are unaffected by this pCode.
+ *
+ * return: > 0 == Banking bits are affected.
+ *
+ *  If the banking bits are affected, then the returned value describes
+ * which bits are affected and how they're affected. The lower half
+ * of the integer maps to the bits that are affected, the upper half
+ * to whether they're set or cleared.
+ *
+ *-----------------------------------------------------------------*/
+/*
+#define SET_BANK_BIT (1 << 16)
+#define CLR_BANK_BIT 0
+
+static int isBankInstruction(pCode *pc)
+{
+  regs *reg;
+  int bank = -1;
+
+  if(!isPCI(pc))
+    return -1;
+
+  if( ( (reg = getRegFromInstruction(pc)) != NULL) && isSTATUS_REG(reg)) {
+
+    // Check to see if the register banks are changing
+    if(PCI(pc)->isModReg) {
+
+      pCodeOp *pcop = PCI(pc)->pcop;
+      switch(PCI(pc)->op) {
+
+      case POC_BSF:
+       if(PCORB(pcop)->bit == PIC_RP0_BIT) {
+         //fprintf(stderr, "  isBankInstruction - Set RP0\n");
+         return  SET_BANK_BIT | PIC_RP0_BIT;
+       }
+
+       if(PCORB(pcop)->bit == PIC_RP1_BIT) {
+         //fprintf(stderr, "  isBankInstruction - Set RP1\n");
+         return  CLR_BANK_BIT | PIC_RP0_BIT;
+       }
+       break;
+
+      case POC_BCF:
+       if(PCORB(pcop)->bit == PIC_RP0_BIT) {
+         //fprintf(stderr, "  isBankInstruction - Clr RP0\n");
+         return  CLR_BANK_BIT | PIC_RP1_BIT;
+       }
+       if(PCORB(pcop)->bit == PIC_RP1_BIT) {
+         //fprintf(stderr, "  isBankInstruction - Clr RP1\n");
+         return  CLR_BANK_BIT | PIC_RP1_BIT;
+       }
+       break;
+      default:
+       //fprintf(stderr, "  isBankInstruction - Status register is getting Modified by:\n");
+       //genericPrint(stderr, pc);
+       ;
+      }
+    }
+
+  }
+
+  return bank;
+}
+*/
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+/*
+static void FillFlow(pCodeFlow *pcflow)
+{
+  pCode *pc;
+  int cur_bank;
+
+  if(!isPCFL(pcflow))
+    return;
+
+  //  fprintf(stderr, " FillFlow - flow block (seq=%d)\n", pcflow->pc.seq);
+
+  pc = findNextpCode(PCODE(pcflow), PC_OPCODE); 
+
+  if(!pc) {
+    //fprintf(stderr, " FillFlow - empty flow (seq=%d)\n", pcflow->pc.seq);
+    return;
+  }
+
+  cur_bank = -1;
+
+  do {
+    isBankInstruction(pc);
+    pc = pc->next;
+  } while (pc && (pc != pcflow->end) && !isPCFL(pc));
+/ *
+  if(!pc ) {
+    fprintf(stderr, "  FillFlow - Bad end of flow\n");
+  } else {
+    fprintf(stderr, "  FillFlow - Ending flow with\n  ");
+    pc->print(stderr,pc);
+  }
+
+  fprintf(stderr, "  FillFlow inCond: ");
+  dumpCond(pcflow->inCond);
+  fprintf(stderr, "  FillFlow outCond: ");
+  dumpCond(pcflow->outCond);
+* /
+}
+*/
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+void LinkFlow_pCode(pCodeInstruction *from, pCodeInstruction *to)
+{
+  pCodeFlowLink *fromLink, *toLink;
+
+  if(!from || !to || !to->pcflow || !from->pcflow)
+    return;
+
+  fromLink = newpCodeFlowLink(from->pcflow);
+  toLink   = newpCodeFlowLink(to->pcflow);
+
+  addSetIfnotP(&(from->pcflow->to), toLink);   //to->pcflow);
+  addSetIfnotP(&(to->pcflow->from), fromLink); //from->pcflow);
+
+}
+
+/*-----------------------------------------------------------------*
+ * void LinkFlow(pBlock *pb)
+ *
+ * In BuildFlow, the PIC code has been partitioned into contiguous
+ * non-branching segments. In LinkFlow, we determine the execution
+ * order of these segments. For example, if one of the segments ends
+ * with a skip, then we know that there are two possible flow segments
+ * to which control may be passed.
+ *-----------------------------------------------------------------*/
+void LinkFlow(pBlock *pb)
+{
+  pCode *pc=NULL;
+  pCode *pcflow;
+  pCode *pct;
+
+  //fprintf(stderr,"linkflow \n");
+
+  for( pcflow = findNextpCode(pb->pcHead, PC_FLOW); 
+       pcflow != NULL;
+       pcflow = findNextpCode(pcflow->next, PC_FLOW) ) {
+
+    if(!isPCFL(pcflow))
+      fprintf(stderr, "LinkFlow - pcflow is not a flow object ");
+
+    //fprintf(stderr," link: ");
+    //pcflow->print(stderr,pcflow);
+
+    //FillFlow(PCFL(pcflow));
+
+    pc = PCFL(pcflow)->end;
+
+    //fprintf(stderr, "LinkFlow - flow block (seq=%d) ", pcflow->seq);
+    if(isPCI_SKIP(pc)) {
+      //fprintf(stderr, "ends with skip\n");
+      //pc->print(stderr,pc);
+      pct=findNextInstruction(pc->next);
+      LinkFlow_pCode(PCI(pc),PCI(pct));
+      pct=findNextInstruction(pct->next);
+      LinkFlow_pCode(PCI(pc),PCI(pct));
+      continue;
+    }
+
+    if(isPCI_BRANCH(pc)) {
+      pCodeOpLabel *pcol = PCOLAB(PCI(pc)->pcop);
+
+      //fprintf(stderr, "ends with branch\n  ");
+      //pc->print(stderr,pc);
+
+      if(!(pcol && isPCOLAB(pcol))) {
+       if((PCI(pc)->op != POC_RETLW) && (PCI(pc)->op != POC_RETURN) && (PCI(pc)->op != POC_CALL) && (PCI(pc)->op != POC_RETFIE) ) {
+         pc->print(stderr,pc);
+         fprintf(stderr, "ERROR: %s, branch instruction doesn't have label\n",__FUNCTION__);
+       }
+       continue;
+      }
+
+      if( (pct = findLabelinpBlock(pb,pcol)) != NULL)
+       LinkFlow_pCode(PCI(pc),PCI(pct));
+      else
+       fprintf(stderr, "ERROR: %s, couldn't find label. key=%d,lab=%s\n",
+               __FUNCTION__,pcol->key,((PCOP(pcol)->name)?PCOP(pcol)->name:"-"));
+  //fprintf(stderr,"newpCodeOpLabel: key=%d, name=%s\n",key,((s)?s:""));
+
+      continue;
+    }
+
+    if(isPCI(pc)) {
+      //fprintf(stderr, "ends with non-branching instruction:\n");
+      //pc->print(stderr,pc);
+
+      LinkFlow_pCode(PCI(pc),PCI(findNextInstruction(pc->next)));
+
+      continue;
+    }
+
+    if(pc) {
+      //fprintf(stderr, "ends with unknown\n");
+      //pc->print(stderr,pc);
+      continue;
+    }
+
+    //fprintf(stderr, "ends with nothing: ERROR\n");
+    
+  }
+}
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+int isPCinFlow(pCode *pc, pCode *pcflow)
+{
+
+  if(!pc || !pcflow)
+    return 0;
+
+  if(!isPCI(pc) || !PCI(pc)->pcflow || !isPCFL(pcflow) )
+    return 0;
+
+  if( PCI(pc)->pcflow->pc.seq == pcflow->seq)
+    return 1;
+
+  return 0;
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+/*
+static void BanksUsedFlow2(pCode *pcflow)
+{
+  pCode *pc=NULL;
+
+  int bank = -1;
+  bool RegUsed = 0;
+
+  regs *reg;
+
+  if(!isPCFL(pcflow)) {
+    fprintf(stderr, "BanksUsed - pcflow is not a flow object ");
+    return;
+  }
+
+  pc = findNextInstruction(pcflow->next);
+
+  PCFL(pcflow)->lastBank = -1;
+
+  while(isPCinFlow(pc,pcflow)) {
+
+    int bank_selected = isBankInstruction(pc);
+
+    //if(PCI(pc)->pcflow) 
+    //fprintf(stderr,"BanksUsedFlow2, looking at seq %d\n",PCI(pc)->pcflow->pc.seq);
+
+    if(bank_selected > 0) {
+      //fprintf(stderr,"BanksUsed - mucking with bank %d\n",bank_selected);
+
+      // This instruction is modifying banking bits before accessing registers
+      if(!RegUsed)
+       PCFL(pcflow)->firstBank = -1;
+
+      if(PCFL(pcflow)->lastBank == -1)
+       PCFL(pcflow)->lastBank = 0;
+
+      bank = (1 << (bank_selected & (PIC_RP0_BIT | PIC_RP1_BIT)));
+      if(bank_selected & SET_BANK_BIT)
+       PCFL(pcflow)->lastBank |= bank;
+                                
+
+    } else { 
+      reg = getRegFromInstruction(pc);
+
+      if(reg && !isREGinBank(reg, bank)) {
+       int allbanks = REGallBanks(reg);
+       if(bank == -1)
+         PCFL(pcflow)->firstBank = allbanks;
+
+       PCFL(pcflow)->lastBank = allbanks;
+
+       bank = allbanks;
+      }
+      RegUsed = 1;
+    }
+
+    pc = findNextInstruction(pc->next);
+  }
+
+//  fprintf(stderr,"BanksUsedFlow2 flow seq=%3d, first bank = 0x%03x, Last bank 0x%03x\n",
+//       pcflow->seq,PCFL(pcflow)->firstBank,PCFL(pcflow)->lastBank);
+}
+*/
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+/*
+static void BanksUsedFlow(pBlock *pb)
+{
+  pCode *pcflow;
+
+
+  //pb->pcHead->print(stderr, pb->pcHead);
+
+  pcflow = findNextpCode(pb->pcHead, PC_FLOW);
+  //pcflow->print(stderr,pcflow);
+
+  for( pcflow = findNextpCode(pb->pcHead, PC_FLOW); 
+       pcflow != NULL;
+       pcflow = findNextpCode(pcflow->next, PC_FLOW) ) {
+
+    BanksUsedFlow2(pcflow);
+  }
+
+}
+*/
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+static void pCodeInstructionInsertAfter(pCodeInstruction *pci, pCodeInstruction *new_pci)
+{
+
+  pCodeInsertAfter(pci->pc.prev, &new_pci->pc);
+
+  /* Move the label, if there is one */
+
+  if(pci->label) {
+    new_pci->label = pci->label;
+    pci->label = NULL;
+  }
+
+  /* Move the C code comment, if there is one */
+
+  if(pci->cline) {
+    new_pci->cline = pci->cline;
+    pci->cline = NULL;
+  }
+
+  /* The new instruction has the same pcflow block */
+  new_pci->pcflow = pci->pcflow;
+
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+static void insertBankSwitch(pCodeInstruction *pci, int Set_Clear, int RP_BankBit)
+{
+  pCode *new_pc;
+
+  new_pc = newpCode((Set_Clear?POC_BSF:POC_BCF),popCopyGPR2Bit(PCOP(&pc_status),RP_BankBit));
+
+  pCodeInstructionInsertAfter(pci, PCI(new_pc));
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+static void insertBankSel(pCodeInstruction  *pci, const char *name)
+{
+  pCode *new_pc;
+
+  pCodeOp *pcop = popCopyReg(PCOR(pci->pcop));
+  pcop->type = PO_GPR_REGISTER; // Sometimes the type is set to legacy 8051 - so override it
+  if (pcop->name == 0)
+    pcop->name = strdup(name);
+  new_pc = newpCode(POC_BANKSEL, pcop);
+
+  pCodeInstructionInsertAfter(pci, PCI(new_pc));
+}
+
+/*-----------------------------------------------------------------*/
+/* If the register is a fixed known addess then we can assign the  */
+/* bank selection bits. Otherwise the linker is going to assign    */
+/* the register location and thus has to set bank selection bits   */
+/* through the banksel directive.                                  */
+/* One critical assumption here is that within this C module all   */ 
+/* the locally allocated registers are in the same udata sector.   */
+/* Therefore banksel is only called for external registers or the  */
+/* first time a local register is encountered.                     */
+/*-----------------------------------------------------------------*/
+static int LastRegIdx; /* If the previous register is the same one again then no need to change bank. */
+static int BankSelect(pCodeInstruction *pci, int cur_bank, regs *reg)
+{
+  int bank;
+  int a = reg->alias>>7;
+  if ((a&3) == 3) {
+    return cur_bank; // This register is available in all banks
+  } else if ((a&1)&&((cur_bank==0)||(cur_bank==1))) {
+    return cur_bank; // This register is available in banks 0 & 1
+  } else if (a&2) {
+    if (reg->address&0x80) {
+      if ((cur_bank==1)||(cur_bank==3)) {
+        return cur_bank; // This register is available in banks 1 & 3
+      }
+    } else {
+      if ((cur_bank==0)||(cur_bank==1)) {
+        return cur_bank; // This register is available in banks 0 & 2
+      }
+    }
+  }
+
+  if (LastRegIdx == reg->rIdx) // If this is the same register as last time then it is in same bank
+    return cur_bank;
+  LastRegIdx = reg->rIdx;
+
+  if (reg->isFixed) {
+    bank = REG_BANK(reg);
+  } else if (reg->isExtern) {
+    bank = 'E'; // Unfixed extern registers are allocated by the linker therefore its bank is unknown
+  } else {
+    bank = 'L'; // Unfixed local registers are allocated by the linker therefore its bank is unknown
+  }
+  if ((cur_bank == 'L')&&(bank == 'L')) { // If current bank and new bank are both allocated locally by the linker, then assume it is in same bank.
+    return 'L'; // Local registers are presumed to be in same linker assigned bank
+  } else if ((bank == 'L')&&(cur_bank != 'L')) { // Reg is now local and linker to assign bank
+    insertBankSel(pci, reg->name); // Let linker choose the bank selection
+  } else if (bank == 'E') { // Reg is now extern and linker to assign bank
+    insertBankSel(pci, reg->name); // Let linker choose the bank selection
+  } else if ((cur_bank == -1)||(cur_bank == 'L')||(cur_bank == 'E')) { // Current bank unknown and new register bank is known then can set bank bits
+    insertBankSwitch(pci, bank&1, PIC_RP0_BIT);
+    insertBankSwitch(pci, bank&2, PIC_RP1_BIT);
+  } else { // Current bank and new register banks known - can set bank bits
+    switch((cur_bank^bank) & 3) {
+    case 0:
+      break;
+    case 1:
+      insertBankSwitch(pci, bank&1, PIC_RP0_BIT);
+      break;
+    case 2:
+      insertBankSwitch(pci, bank&2, PIC_RP1_BIT);
+      break;
+    case 3:
+      insertBankSwitch(pci, bank&1, PIC_RP0_BIT);
+      insertBankSwitch(pci, bank&2, PIC_RP1_BIT);
+      break;
+    }
+  }
+
+  return bank;
+}
+
+/*-----------------------------------------------------------------*/
+/* Check for bank selection pcodes instructions and modify         */
+/* cur_bank to match.                                              */
+/*-----------------------------------------------------------------*/
+static int IsBankChange(pCode *pc, regs *reg, int *cur_bank) {
+
+  if (isSTATUS_REG(reg)) {
+
+    if (PCI(pc)->op == POC_BCF) {
+      int old_bank = *cur_bank;
+      if (PCORB(PCI(pc)->pcop)->bit == PIC_RP0_BIT) {
+        /* If current bank is unknown or linker assigned then set to 0 else just change the bit */
+        if (*cur_bank & ~(0x3))
+          *cur_bank = 0;
+        else
+          *cur_bank = *cur_bank&0x2;
+        LastRegIdx = reg->rIdx;
+      } else if (PCORB(PCI(pc)->pcop)->bit == PIC_RP1_BIT) {
+        /* If current bank is unknown or linker assigned then set to 0 else just change the bit */
+       if (*cur_bank & ~(0x3))
+          *cur_bank = 0;
+        else
+          *cur_bank = *cur_bank&0x1;
+        LastRegIdx = reg->rIdx;
+      }
+      return old_bank != *cur_bank;
+    }
+
+    if (PCI(pc)->op == POC_BSF) {
+      int old_bank = *cur_bank;
+      if (PCORB(PCI(pc)->pcop)->bit == PIC_RP0_BIT) {
+        /* If current bank is unknown or linker assigned then set to bit else just change the bit */
+        if (*cur_bank & ~(0x3))
+          *cur_bank = 0x1;
+        else
+          *cur_bank = (*cur_bank&0x2) | 0x1;
+        LastRegIdx = reg->rIdx;
+      } else if (PCORB(PCI(pc)->pcop)->bit == PIC_RP1_BIT) {
+        /* If current bank is unknown or linker assigned then set to bit else just change the bit */
+        if (*cur_bank & ~(0x3))
+          *cur_bank = 0x2;
+        else
+          *cur_bank = (*cur_bank&0x1) | 0x2;
+        LastRegIdx = reg->rIdx;
+      }
+      return old_bank != *cur_bank;
+    }
+
+  } else if (PCI(pc)->op == POC_BANKSEL) {
+    int old_bank = *cur_bank;
+    *cur_bank = (PCOR(PCI(pc)->pcop)->r->isExtern) ? 'E' : 'L';
+    LastRegIdx = reg->rIdx;
+    return old_bank != *cur_bank;
+  }
+
+  return 0;
+}
+
+/*-----------------------------------------------------------------*/
+/* Set bank selection if necessary                                 */
+/*-----------------------------------------------------------------*/
+static int DoBankSelect(pCode *pc, int cur_bank) {
+  pCode *pcprev;
+  regs *reg;
+
+  if(!isPCI(pc))
+    return cur_bank;
+
+  if (isCALL(pc)) {
+    pCode *pcf = findFunction(get_op_from_instruction(PCI(pc)));
+    if (pcf && isPCF(pcf)) {
+      pCode *pcfr;
+      int rbank = 'U'; // Undetermined
+      FixRegisterBanking(pcf->pb,cur_bank); // Ensure this block has had its banks selection done
+      // Check all the returns to work out what bank is selected
+      for (pcfr=pcf->pb->pcHead; pcfr; pcfr=pcfr->next) {
+        if (isPCI(pcfr)) {
+          if ((PCI(pcfr)->op==POC_RETURN) || (PCI(pcfr)->op==POC_RETLW)) {
+            if (rbank == 'U')
+              rbank = PCFL(pcfr)->lastBank;
+            else
+              if (rbank != PCFL(pcfr)->lastBank)
+                return -1; // Unknown bank - multiple returns with different banks
+          }
+        }
+      }
+      if (rbank == 'U')
+        return -1; // Unknown bank
+      return rbank;
+    } else if (isPCOS(PCI(pc)->pcop) && PCOS(PCI(pc)->pcop)->isPublic) {
+      /* Extern functions may use registers in different bank - must call banksel */
+      return -1; /* Unknown bank */
+    }
+  }
+
+  if ((isPCI(pc)) && (PCI(pc)->op == POC_BANKSEL)) {
+    return -1; /* New bank unknown - linkers choice. */
+  }
+  
+  reg = getRegFromInstruction(pc);
+  if (reg) {
+
+    if (IsBankChange(pc,reg,&cur_bank))
+      return cur_bank;
+
+    if (!isPCI_LIT(pc)) {
+
+      /* Examine the instruction before this one to make sure it is
+       * not a skip type instruction */
+      pcprev = findPrevpCode(pc->prev, PC_OPCODE);
+
+      if(!pcprev || (pcprev && !isPCI_SKIP(pcprev))) {
+        cur_bank = BankSelect(PCI(pc),cur_bank,reg);
+      } else {
+        cur_bank = BankSelect(PCI(pcprev),cur_bank,reg);
+      }
+      if (!PCI(pc)->pcflow)
+        fprintf(stderr,"PCI ID=%d missing flow pointer ???\n",pc->id);
+      else
+        PCI(pc)->pcflow->lastBank = cur_bank; /* Maintain pCodeFlow lastBank state */
+    }
+  }
+  return cur_bank;
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+/*
+static void FixRegisterBankingInFlow(pCodeFlow *pcfl, int cur_bank)
+{
+  pCode *pc=NULL;
+  pCode *pcprev=NULL;
+
+  if(!pcfl)
+    return;
+
+  pc = findNextInstruction(pcfl->pc.next);
+
+  while(isPCinFlow(pc,PCODE(pcfl))) {
+
+    cur_bank = DoBankSelect(pc,cur_bank);
+    pcprev = pc;
+    pc = findNextInstruction(pc->next);
+
+  }
+
+  if(pcprev && cur_bank) {
+    // Set bank state to unknown at the end of each flow block
+      cur_bank = -1;
+  }
+
+}
+*/
+/*-----------------------------------------------------------------*/
+/*int compareBankFlow - compare the banking requirements between   */
+/*  flow objects. */
+/*-----------------------------------------------------------------*/
+/*
+int compareBankFlow(pCodeFlow *pcflow, pCodeFlowLink *pcflowLink, int toORfrom)
+{
+
+  if(!pcflow || !pcflowLink || !pcflowLink->pcflow)
+    return 0;
+
+  if(!isPCFL(pcflow) || !isPCFL(pcflowLink->pcflow))
+    return 0;
+
+  if(pcflow->firstBank == -1)
+    return 0;
+
+
+  if(pcflowLink->pcflow->firstBank == -1) {
+    pCodeFlowLink *pctl = setFirstItem( toORfrom ? 
+                                       pcflowLink->pcflow->to : 
+                                       pcflowLink->pcflow->from);
+    return compareBankFlow(pcflow, pctl, toORfrom);
+  }
+
+  if(toORfrom) {
+    if(pcflow->lastBank == pcflowLink->pcflow->firstBank)
+      return 0;
+
+    pcflowLink->bank_conflict++;
+    pcflowLink->pcflow->FromConflicts++;
+    pcflow->ToConflicts++;
+  } else {
+    
+    if(pcflow->firstBank == pcflowLink->pcflow->lastBank)
+      return 0;
+
+    pcflowLink->bank_conflict++;
+    pcflowLink->pcflow->ToConflicts++;
+    pcflow->FromConflicts++;
+
+  }
+  / *
+  fprintf(stderr,"compare flow found conflict: seq %d from conflicts %d, to conflicts %d\n",
+         pcflowLink->pcflow->pc.seq,
+         pcflowLink->pcflow->FromConflicts,
+         pcflowLink->pcflow->ToConflicts);
+  * /
+  return 1;
+
+}
+*/
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+/*
+void FixBankFlow(pBlock *pb)
+{
+  pCode *pc=NULL;
+  pCode *pcflow;
+  pCodeFlowLink *pcfl;
+
+  pCode *pcflow_max_To=NULL;
+  pCode *pcflow_max_From=NULL;
+  int max_ToConflicts=0;
+  int max_FromConflicts=0;
+
+  //fprintf(stderr,"Fix Bank flow \n");
+  pcflow = findNextpCode(pb->pcHead, PC_FLOW);
+
+
+  / *
+    First loop through all of the flow objects in this pcode block
+    and fix the ones that have banking conflicts between the 
+    entry and exit.
+  * /
+
+  //fprintf(stderr, "FixBankFlow - Phase 1\n");
+
+  for( pcflow = findNextpCode(pb->pcHead, PC_FLOW); 
+       pcflow != NULL;
+       pcflow = findNextpCode(pcflow->next, PC_FLOW) ) {
+
+    if(!isPCFL(pcflow)) {
+      fprintf(stderr, "FixBankFlow - pcflow is not a flow object ");
+      continue;
+    }
+
+    if(PCFL(pcflow)->firstBank != PCFL(pcflow)->lastBank  &&
+       PCFL(pcflow)->firstBank >= 0 &&
+       PCFL(pcflow)->lastBank >= 0 ) {
+
+      int cur_bank = (PCFL(pcflow)->firstBank < PCFL(pcflow)->lastBank) ?
+       PCFL(pcflow)->firstBank : PCFL(pcflow)->lastBank;
+
+      FixRegisterBankingInFlow(PCFL(pcflow),cur_bank);
+      BanksUsedFlow2(pcflow);
+
+    }
+  }
+
+  //fprintf(stderr, "FixBankFlow - Phase 2\n");
+
+  for( pcflow = findNextpCode(pb->pcHead, PC_FLOW); 
+       pcflow != NULL;
+       pcflow = findNextpCode(pcflow->next, PC_FLOW) ) {
+
+    int nFlows;
+    int nConflicts;
+
+    if(!isPCFL(pcflow)) {
+      fprintf(stderr, "FixBankFlow - pcflow is not a flow object ");
+      continue;
+    }
+
+    PCFL(pcflow)->FromConflicts = 0;
+    PCFL(pcflow)->ToConflicts = 0;
+
+    nFlows = 0;
+    nConflicts = 0;
+
+    //fprintf(stderr, " FixBankFlow flow seq %d\n",pcflow->seq);
+    pcfl = setFirstItem(PCFL(pcflow)->from);
+    while (pcfl) {
+
+      pc = PCODE(pcfl->pcflow);
+
+      if(!isPCFL(pc)) {
+       fprintf(stderr,"oops dumpflow - to is not a pcflow\n");
+       pc->print(stderr,pc);
+      }
+
+      nConflicts += compareBankFlow(PCFL(pcflow), pcfl, 0);
+      nFlows++;
+
+      pcfl=setNextItem(PCFL(pcflow)->from);
+    }
+
+    if((nFlows >= 2) && nConflicts && (PCFL(pcflow)->firstBank>0)) {
+      //fprintf(stderr, " From conflicts flow seq %d, nflows %d ,nconflicts %d\n",pcflow->seq,nFlows, nConflicts);
+
+      FixRegisterBankingInFlow(PCFL(pcflow),-1);
+      BanksUsedFlow2(pcflow);
+
+      continue;  / * Don't need to check the flow from here - it's already been fixed * /
+
+    }
+
+    nFlows = 0;
+    nConflicts = 0;
+
+    pcfl = setFirstItem(PCFL(pcflow)->to);
+    while (pcfl) {
+
+      pc = PCODE(pcfl->pcflow);
+      if(!isPCFL(pc)) {
+       fprintf(stderr,"oops dumpflow - to is not a pcflow\n");
+       pc->print(stderr,pc);
+      }
+
+      nConflicts += compareBankFlow(PCFL(pcflow), pcfl, 1);
+      nFlows++;
+
+      pcfl=setNextItem(PCFL(pcflow)->to);
+    }
+
+    if((nFlows >= 2) && nConflicts &&(nConflicts != nFlows) && (PCFL(pcflow)->lastBank>0)) {
+      //fprintf(stderr, " To conflicts flow seq %d, nflows %d ,nconflicts %d\n",pcflow->seq,nFlows, nConflicts);
+
+      FixRegisterBankingInFlow(PCFL(pcflow),-1);
+      BanksUsedFlow2(pcflow);
+    }
+  }
+
+  / *
+    Loop through the flow objects again and find the ones with the 
+    maximum conflicts
+  * /
+
+  for( pcflow = findNextpCode(pb->pcHead, PC_FLOW); 
+       pcflow != NULL;
+       pcflow = findNextpCode(pcflow->next, PC_FLOW) ) {
+
+    if(PCFL(pcflow)->ToConflicts > max_ToConflicts)
+      pcflow_max_To = pcflow;
+
+    if(PCFL(pcflow)->FromConflicts > max_FromConflicts)
+      pcflow_max_From = pcflow;
+  }
+/ *
+  if(pcflow_max_To)
+    fprintf(stderr,"compare flow Max To conflicts: seq %d conflicts %d\n",
+           PCFL(pcflow_max_To)->pc.seq,
+           PCFL(pcflow_max_To)->ToConflicts);
+
+  if(pcflow_max_From)
+    fprintf(stderr,"compare flow Max From conflicts: seq %d conflicts %d\n",
+           PCFL(pcflow_max_From)->pc.seq,
+           PCFL(pcflow_max_From)->FromConflicts);
+* /
+}
+*/
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+void DumpFlow(pBlock *pb)
+{
+  pCode *pc=NULL;
+  pCode *pcflow;
+  pCodeFlowLink *pcfl;
+
+
+  fprintf(stderr,"Dump flow \n");
+  pb->pcHead->print(stderr, pb->pcHead);
+
+  pcflow = findNextpCode(pb->pcHead, PC_FLOW);
+  pcflow->print(stderr,pcflow);
+
+  for( pcflow = findNextpCode(pb->pcHead, PC_FLOW); 
+       pcflow != NULL;
+       pcflow = findNextpCode(pcflow->next, PC_FLOW) ) {
+
+    if(!isPCFL(pcflow)) {
+      fprintf(stderr, "DumpFlow - pcflow is not a flow object ");
+      continue;
+    }
+    fprintf(stderr,"dumping: ");
+    pcflow->print(stderr,pcflow);
+    FlowStats(PCFL(pcflow));
+
+    for(pcfl = setFirstItem(PCFL(pcflow)->to); pcfl; pcfl=setNextItem(PCFL(pcflow)->to)) {
+
+      pc = PCODE(pcfl->pcflow);
+
+      fprintf(stderr, "    from seq %d:\n",pc->seq);
+      if(!isPCFL(pc)) {
+       fprintf(stderr,"oops dumpflow - from is not a pcflow\n");
+       pc->print(stderr,pc);
+      }
+
+    }
 
-       if(!r) {
-         /* register wasn't found */
-         r = Safe_calloc(1, sizeof(regs));
-         memcpy(r,PCOR(PCI(pc)->pcop)->r, sizeof(regs));
-         addSet(&pb->registers, r);
-         PCOR(PCI(pc)->pcop)->r = r;
-         fprintf(stderr,"added register to pblock: reg %d\n",r->rIdx);
-       } else 
-         fprintf(stderr,"found register in pblock: reg %d\n",r->rIdx);
+    for(pcfl = setFirstItem(PCFL(pcflow)->to); pcfl; pcfl=setNextItem(PCFL(pcflow)->to)) {
+
+      pc = PCODE(pcfl->pcflow);
+
+      fprintf(stderr, "    to seq %d:\n",pc->seq);
+      if(!isPCFL(pc)) {
+       fprintf(stderr,"oops dumpflow - to is not a pcflow\n");
+       pc->print(stderr,pc);
       }
+
     }
+
   }
+
 }
 
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
 int OptimizepBlock(pBlock *pb)
 {
-  pCode *pc;
+  pCode *pc, *pcprev;
   int matches =0;
 
   if(!pb || !peepOptimizing)
     return 0;
 
-  fprintf(stderr," Optimizing pBlock: %c\n",getpBlock_dbName(pb));
+  DFPRINTF((stderr," Optimizing pBlock: %c\n",getpBlock_dbName(pb)));
+/*
   for(pc = pb->pcHead; pc; pc = pc->next)
     matches += pCodePeepMatchRule(pc);
+*/
+
+  pc = findNextInstruction(pb->pcHead);
+  if(!pc)
+    return 0;
+
+  pcprev = pc->prev;
+  do {
+
+
+    if(pCodePeepMatchRule(pc)) {
+
+      matches++;
 
+      if(pcprev)
+       pc = findNextInstruction(pcprev->next);
+      else 
+       pc = findNextInstruction(pb->pcHead);
+    } else
+      pc = findNextInstruction(pc->next);
+  } while(pc);
+
+  if(matches)
+    DFPRINTF((stderr," Optimizing pBlock: %c - matches=%d\n",getpBlock_dbName(pb),matches));
   return matches;
 
 }
@@ -2098,6 +4879,44 @@ pCode * findInstructionUsingLabel(pCodeLabel *pcl, pCode *pcs)
   return NULL;
 }
 
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+void exchangeLabels(pCodeLabel *pcl, pCode *pc)
+{
+
+  char *s=NULL;
+
+  if(isPCI(pc) && 
+     (PCI(pc)->pcop) && 
+     (PCI(pc)->pcop->type == PO_LABEL)) {
+
+    pCodeOpLabel *pcol = PCOLAB(PCI(pc)->pcop);
+
+    //fprintf(stderr,"changing label key from %d to %d\n",pcol->key, pcl->key);
+    if(pcol->pcop.name)
+      free(pcol->pcop.name);
+
+    /* If the key is negative, then we (probably) have a label to
+     * a function and the name is already defined */
+       
+    if(pcl->key>0)
+      sprintf(s=buffer,"_%05d_DS_",pcl->key);
+    else 
+      s = pcl->label;
+
+    //sprintf(buffer,"_%05d_DS_",pcl->key);
+    if(!s) {
+      fprintf(stderr, "ERROR %s:%d function label is null\n",__FUNCTION__,__LINE__);
+    }
+    pcol->pcop.name = Safe_strdup(s);
+    pcol->key = pcl->key;
+    //pc->print(stderr,pc);
+
+  }
+
+
+}
+
 /*-----------------------------------------------------------------*/
 /* pBlockRemoveUnusedLabels - remove the pCode labels from the     */
 /*                            pCode chain if they're not used.     */
@@ -2109,151 +4928,604 @@ void pBlockRemoveUnusedLabels(pBlock *pb)
   if(!pb)
     return;
 
+  for(pc = pb->pcHead; (pc=findNextInstruction(pc->next)) != NULL; ) {
+
+    pBranch *pbr = PCI(pc)->label;
+    if(pbr && pbr->next) {
+      pCode *pcd = pb->pcHead;
+
+      //fprintf(stderr, "multiple labels\n");
+      //pc->print(stderr,pc);
+
+      pbr = pbr->next;
+      while(pbr) {
+
+       while ( (pcd = findInstructionUsingLabel(PCL(PCI(pc)->label->pc), pcd)) != NULL) {
+         //fprintf(stderr,"Used by:\n");
+         //pcd->print(stderr,pcd);
+
+         exchangeLabels(PCL(pbr->pc),pcd);
+
+         pcd = pcd->next;
+       }
+       pbr = pbr->next;
+      }
+    }
+  }
+
   for(pc = pb->pcHead; pc; pc = pc->next) {
 
-    if(pc->type == PC_LABEL)
+    if(isPCL(pc)) // Label pcode
       pcl = PCL(pc);
-    else if (pc->label)
-      pcl = PCL(pc->label->pc);
+    else if (isPCI(pc) && PCI(pc)->label) // pcode instruction with a label
+      pcl = PCL(PCI(pc)->label->pc);
     else continue;
 
-      /* This pCode is a label, so search the pBlock to see if anyone
-       * refers to it */
+    //fprintf(stderr," found  A LABEL !!! key = %d, %s\n", pcl->key,pcl->label);
+
+    /* This pCode is a label, so search the pBlock to see if anyone
+     * refers to it */
 
     if( (pcl->key>0) && (!findInstructionUsingLabel(pcl, pb->pcHead))) {
+    //if( !findInstructionUsingLabel(pcl, pb->pcHead)) {
       /* Couldn't find an instruction that refers to this label
        * So, unlink the pCode label from it's pCode chain
        * and destroy the label */
+      //fprintf(stderr," removed  A LABEL !!! key = %d, %s\n", pcl->key,pcl->label);
 
-      fprintf(stderr," !!! REMOVED A LABEL !!! key = %d\n", pcl->key);
-
+      DFPRINTF((stderr," !!! REMOVED A LABEL !!! key = %d, %s\n", pcl->key,pcl->label));
       if(pc->type == PC_LABEL) {
-       //unlinkPC(pc);
+       unlinkpCode(pc);
        pCodeLabelDestruct(pc);
       } else {
-       unlinkpCodeFromBranch(pc->label, pc);
-       if(pc->label->next == NULL && pc->label->pc == NULL) {
+       unlinkpCodeFromBranch(pc, PCODE(pcl));
+       /*if(pc->label->next == NULL && pc->label->pc == NULL) {
          free(pc->label);
-       }
+       }*/
+      }
+
+    }
+  }
+
+}
+
+
+/*-----------------------------------------------------------------*/
+/* pBlockMergeLabels - remove the pCode labels from the pCode      */
+/*                     chain and put them into pBranches that are  */
+/*                     associated with the appropriate pCode       */
+/*                     instructions.                               */
+/*-----------------------------------------------------------------*/
+void pBlockMergeLabels(pBlock *pb)
+{
+  pBranch *pbr;
+  pCode *pc, *pcnext=NULL;
+
+  if(!pb)
+    return;
+
+  /* First, Try to remove any unused labels */
+  //pBlockRemoveUnusedLabels(pb);
+
+  /* Now loop through the pBlock and merge the labels with the opcodes */
+
+  pc = pb->pcHead;
+  //  for(pc = pb->pcHead; pc; pc = pc->next) {
+
+  while(pc) {
+    pCode *pcn = pc->next;
+
+    if(pc->type == PC_LABEL) {
+
+      //fprintf(stderr," checking merging label %s\n",PCL(pc)->label);
+      //fprintf(stderr,"Checking label key = %d\n",PCL(pc)->key);
+      if((pcnext = findNextInstruction(pc) )) {
+
+       // Unlink the pCode label from it's pCode chain
+       unlinkpCode(pc);
+       
+       //fprintf(stderr,"Merged label key = %d\n",PCL(pc)->key);
+       // And link it into the instruction's pBranch labels. (Note, since
+       // it's possible to have multiple labels associated with one instruction
+       // we must provide a means to accomodate the additional labels. Thus
+       // the labels are placed into the singly-linked list "label" as 
+       // opposed to being a single member of the pCodeInstruction.)
+
+       //_ALLOC(pbr,sizeof(pBranch));
+       pbr = Safe_calloc(1,sizeof(pBranch));
+       pbr->pc = pc;
+       pbr->next = NULL;
+
+       PCI(pcnext)->label = pBranchAppend(PCI(pcnext)->label,pbr);
+
+      } else {
+       fprintf(stderr, "WARNING: couldn't associate label %s with an instruction\n",PCL(pc)->label);
+      }
+    } else if(pc->type == PC_CSOURCE) {
+
+      /* merge the source line symbolic info into the next instruction */
+      if((pcnext = findNextInstruction(pc) )) {
+
+       // Unlink the pCode label from it's pCode chain
+       unlinkpCode(pc);
+       PCI(pcnext)->cline = PCCS(pc);
+       //fprintf(stderr, "merging CSRC\n");
+       //genericPrint(stderr,pcnext);
+      }
+
+    }
+    pc = pcn;
+  }
+  pBlockRemoveUnusedLabels(pb);
+
+}
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+int OptimizepCode(char dbName)
+{
+#define MAX_PASSES 4
+
+  int matches = 0;
+  int passes = 0;
+  pBlock *pb;
+
+  if(!the_pFile)
+    return 0;
+
+  DFPRINTF((stderr," Optimizing pCode\n"));
+
+  do {
+    matches = 0;
+    for(pb = the_pFile->pbHead; pb; pb = pb->next) {
+      if('*' == dbName || getpBlock_dbName(pb) == dbName)
+       matches += OptimizepBlock(pb);
+    }
+  }
+  while(matches && ++passes < MAX_PASSES);
+
+  return matches;
+}
+
+/*-----------------------------------------------------------------*/
+/* popCopyGPR2Bit - copy a pcode operator                          */
+/*-----------------------------------------------------------------*/
+
+pCodeOp *popCopyGPR2Bit(pCodeOp *pc, int bitval)
+{
+  pCodeOp *pcop;
+
+  pcop = newpCodeOpBit(pc->name, bitval, 0);
+
+  if( !( (pcop->type == PO_LABEL) ||
+        (pcop->type == PO_LITERAL) ||
+        (pcop->type == PO_STR) ))
+    PCOR(pcop)->r = PCOR(pc)->r;  /* This is dangerous... */
+
+  return pcop;
+}
+
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+static void FixRegisterBanking(pBlock *pb,int cur_bank)
+{
+  pCode *pc;
+  int firstBank = 'U';
+
+  if(!pb)
+    return;
+
+  for (pc=pb->pcHead; pc; pc=pc->next) {
+    if (isPCFL(pc)) {
+      firstBank = PCFL(pc)->firstBank;
+      break;
+    }
+  }
+  if (firstBank != 'U') {
+    /* This block has already been done */
+    if (firstBank != cur_bank) {
+      /* This block has started with a different bank - must adjust it */ 
+      if ((firstBank != -1)&&(firstBank != 'E')) { /* The first bank start off unknown or extern then need not worry as banksel will be called */
+        while (pc) {
+          if (isPCI(pc)) {
+            regs *reg = getRegFromInstruction(pc);
+            if (reg) {
+              DoBankSelect(pc,cur_bank);
+            }
+          }
+          pc = pc->next;
+        }
+      }
+    }
+    return;
+  }
+
+  /* loop through all of the pCodes within this pblock setting the bank selection, ignoring any branching */
+  LastRegIdx = -1;
+  cur_bank = -1;
+  for (pc=pb->pcHead; pc; pc=pc->next) {
+    if (isPCFL(pc)) {
+               PCFL(pc)->firstBank = cur_bank;
+               continue;
+    }
+    cur_bank = DoBankSelect(pc,cur_bank);
+  }
+
+  /* Trace through branches and set the bank selection as required. */
+  LastRegIdx = -1;
+  cur_bank = -1;
+  for (pc=pb->pcHead; pc; pc=pc->next) {
+    if (isPCFL(pc)) {
+               PCFL(pc)->firstBank = cur_bank;
+               continue;
+    }
+    if (isPCI(pc)) {
+      if (PCI(pc)->op == POC_GOTO) {
+               int lastRegIdx = LastRegIdx;
+        pCode *pcb = pc;
+        /* Trace through branch */
+        pCode *pcl = findLabel(PCOLAB(PCI(pcb)->pcop));
+        while (pcl) {
+          if (isPCI(pcl)) {
+            regs *reg = getRegFromInstruction(pcl);
+            if (reg) {
+              int bankUnknown = -1;
+              if (IsBankChange(pcl,reg,&bankUnknown)) /* Look for any bank change */
+                break;
+                         if (cur_bank != DoBankSelect(pcl,cur_bank)) /* Set bank selection if necessary */
+                break;
+            }
+          }
+          pcl = pcl->next;
+        }
+               LastRegIdx = lastRegIdx;
+      } else {
+        /* Keep track out current bank */
+        regs *reg = getRegFromInstruction(pc);
+        if (reg)
+          IsBankChange(pc,reg,&cur_bank);
+      }
+    }
+  }
+}
+
+
+/*-----------------------------------------------------------------*/
+/*-----------------------------------------------------------------*/
+void pBlockDestruct(pBlock *pb)
+{
+
+  if(!pb)
+    return;
+
+
+  free(pb);
+
+}
+
+/*-----------------------------------------------------------------*/
+/* void mergepBlocks(char dbName) - Search for all pBlocks with the*/
+/*                                  name dbName and combine them   */
+/*                                  into one block                 */
+/*-----------------------------------------------------------------*/
+void mergepBlocks(char dbName)
+{
+
+  pBlock *pb, *pbmerged = NULL,*pbn;
+
+  pb = the_pFile->pbHead;
+
+  //fprintf(stderr," merging blocks named %c\n",dbName);
+  while(pb) {
+
+    pbn = pb->next;
+    //fprintf(stderr,"looking at %c\n",getpBlock_dbName(pb));
+    if( getpBlock_dbName(pb) == dbName) {
+
+      //fprintf(stderr," merged block %c\n",dbName);
+
+      if(!pbmerged) {
+       pbmerged = pb;
+      } else {
+       addpCode2pBlock(pbmerged, pb->pcHead);
+       /* addpCode2pBlock doesn't handle the tail: */
+       pbmerged->pcTail = pb->pcTail;
+
+       pb->prev->next = pbn;
+       if(pbn) 
+         pbn->prev = pb->prev;
+
+
+       pBlockDestruct(pb);
       }
+      //printpBlock(stderr, pbmerged);
+    } 
+    pb = pbn;
+  }
+
+}
+
+/*-----------------------------------------------------------------*/
+/* AnalyzeFlow - Examine the flow of the code and optimize         */
+/*                                                                 */
+/* level 0 == minimal optimization                                 */
+/*   optimize registers that are used only by two instructions     */
+/* level 1 == maximal optimization                                 */
+/*   optimize by looking at pairs of instructions that use the     */
+/*   register.                                                     */
+/*-----------------------------------------------------------------*/
+
+void AnalyzeFlow(int level)
+{
+  static int times_called=0;
+
+  pBlock *pb;
+
+  if(!the_pFile)
+    return;
+
+
+  /* if this is not the first time this function has been called,
+     then clean up old flow information */
+  if(times_called++) {
+    for(pb = the_pFile->pbHead; pb; pb = pb->next)
+      unBuildFlow(pb);
+
+    RegsUnMapLiveRanges();
+
+  }
+
+  GpcFlowSeq = 1;
+
+  /* Phase 2 - Flow Analysis - Register Banking
+   *
+   * In this phase, the individual flow blocks are examined
+   * and register banking is fixed.
+   */
+
+  //for(pb = the_pFile->pbHead; pb; pb = pb->next)
+  //FixRegisterBanking(pb);
+
+  /* Phase 2 - Flow Analysis
+   *
+   * In this phase, the pCode is partition into pCodeFlow 
+   * blocks. The flow blocks mark the points where a continuous
+   * stream of instructions changes flow (e.g. because of
+   * a call or goto or whatever).
+   */
+
+  for(pb = the_pFile->pbHead; pb; pb = pb->next)
+    BuildFlow(pb);
+
+
+  /* Phase 2 - Flow Analysis - linking flow blocks
+   *
+   * In this phase, the individual flow blocks are examined
+   * to determine their order of excution.
+   */
+
+  for(pb = the_pFile->pbHead; pb; pb = pb->next)
+    LinkFlow(pb);
+
+  /* Phase 3 - Flow Analysis - Flow Tree
+   *
+   * In this phase, the individual flow blocks are examined
+   * to determine their order of excution.
+   */
+
+  for(pb = the_pFile->pbHead; pb; pb = pb->next)
+    BuildFlowTree(pb);
+
+
+  /* Phase x - Flow Analysis - Used Banks
+   *
+   * In this phase, the individual flow blocks are examined
+   * to determine the Register Banks they use
+   */
+
+//  for(pb = the_pFile->pbHead; pb; pb = pb->next)
+//    FixBankFlow(pb);
+
+
+  for(pb = the_pFile->pbHead; pb; pb = pb->next)
+    pCodeRegMapLiveRanges(pb);
+
+  RemoveUnusedRegisters();
+
+  //  for(pb = the_pFile->pbHead; pb; pb = pb->next)
+  pCodeRegOptimizeRegUsage(level);
+
+  OptimizepCode('*');
+
+
+/*
+  for(pb = the_pFile->pbHead; pb; pb = pb->next)
+    DumpFlow(pb);
+*/
+  /* debug stuff */
+/*
+  for(pb = the_pFile->pbHead; pb; pb = pb->next) {
+    pCode *pcflow;
+    for( pcflow = findNextpCode(pb->pcHead, PC_FLOW); 
+        (pcflow = findNextpCode(pcflow, PC_FLOW)) != NULL;
+        pcflow = pcflow->next) {
+
+      FillFlow(PCFL(pcflow));
+    }
+  }
+*/
+/*
+  for(pb = the_pFile->pbHead; pb; pb = pb->next) {
+    pCode *pcflow;
+    for( pcflow = findNextpCode(pb->pcHead, PC_FLOW); 
+        (pcflow = findNextpCode(pcflow, PC_FLOW)) != NULL;
+        pcflow = pcflow->next) {
+
+      FlowStats(PCFL(pcflow));
+    }
+  }
+*/
+}
+
+/*-----------------------------------------------------------------*/
+/* AnalyzeBanking - Called after the memory addresses have been    */
+/*                  assigned to the registers.                     */
+/*                                                                 */
+/*-----------------------------------------------------------------*/
+
+void AnalyzeBanking(void)
+{
+  pBlock  *pb;
+
+  if(!picIsInitialized()) {
+    fprintf(stderr,"Temporary ERROR: at the moment you have to use\n");
+    fprintf(stderr,"an include file create by inc2h.pl. See SDCC source:\n");
+    fprintf(stderr,"support/scripts/inc2h.pl\n");
+    fprintf(stderr,"this is a nuisance bug that will be fixed shortly\n");
+
+    exit(1);
+  }
+
+  /* Phase x - Flow Analysis - Used Banks
+   *
+   * In this phase, the individual flow blocks are examined
+   * to determine the Register Banks they use
+   */
 
-    }
-  }
+  AnalyzeFlow(0);
+  AnalyzeFlow(1);
 
-}
+//  for(pb = the_pFile->pbHead; pb; pb = pb->next)
+//    BanksUsedFlow(pb);
+  for(pb = the_pFile->pbHead; pb; pb = pb->next)
+    FixRegisterBanking(pb,-1); // cur_bank is unknown
 
+}
 
 /*-----------------------------------------------------------------*/
-/* pBlockMergeLabels - remove the pCode labels from the pCode      */
-/*                     chain and put them into pBranches that are  */
-/*                     associated with the appropriate pCode       */
-/*                     instructions.                               */
 /*-----------------------------------------------------------------*/
-void pBlockMergeLabels(pBlock *pb)
+DEFSETFUNC (resetrIdx)
 {
-  pBranch *pbr;
-  pCode *pc, *pcnext=NULL;
-
-  if(!pb)
-    return;
-
-  /* First, Try to remove any unused labels */
-  //pBlockRemoveUnusedLabels(pb);
+  if (!((regs *)item)->isFixed)
+    ((regs *)item)->rIdx = 0;
 
-  /* Now loop through the pBlock and merge the labels with the opcodes */
+  return 0;
+}
 
-  for(pc = pb->pcHead; pc; pc = pc->next) {
+/*-----------------------------------------------------------------*/
+/* InitRegReuse - Initialises variables for code analyzer          */
+/*-----------------------------------------------------------------*/
 
-    if(pc->type == PC_LABEL) {
-      fprintf(stderr,"Checking label key = %d\n",PCL(pc)->key);
-      if( !(pcnext = findNextInstruction(pc)) ) 
-       return;  // Couldn't find an instruction associated with this label
-
-      // Unlink the pCode label from it's pCode chain
-      unlinkPC(pc);
-
-      fprintf(stderr,"Merged label key = %d\n",PCL(pc)->key);
-      // And link it into the instruction's pBranch labels. (Note, since
-      // it's possible to have multiple labels associated with one instruction
-      // we must provide a means to accomodate the additional labels. Thus
-      // the labels are placed into the singly-linked list "label" as 
-      // opposed to being a single member of the pCodeInstruction.)
-
-      _ALLOC(pbr,sizeof(pBranch));
-      pbr->pc = pc;
-      pbr->next = NULL;
-
-      pcnext->label = pBranchAppend(pcnext->label,pbr);
-      if(pcnext->prev) 
-       pc = pcnext->prev;
-      else
-       pc = pcnext;
+void InitReuseReg(void)
+{
+    /* Find end of statically allocated variables for start idx */
+    unsigned maxIdx = 0x20; /* Start from begining of GPR. Note may not be 0x20 on some PICs */
+    regs *r;
+    for (r = setFirstItem(dynDirectRegs); r; r = setNextItem(dynDirectRegs)) {
+      if (r->type != REG_SFR) {
+        maxIdx += r->size; /* Increment for all statically allocated variables */
+      }
     }
-
-  }
-  pBlockRemoveUnusedLabels(pb);
-
+    peakIdx = maxIdx;
+    applyToSet(dynAllocRegs,resetrIdx); /* Reset all rIdx to zero. */
 }
 
 /*-----------------------------------------------------------------*/
 /*-----------------------------------------------------------------*/
-void OptimizepCode(char dbName)
+static unsigned register_reassign(pBlock *pb, unsigned idx)
 {
-#define MAX_PASSES 4
+  pCode *pc;
 
-  int matches = 0;
-  int passes = 0;
-  pBlock *pb;
+  /* check recursion */
+  pc = setFirstItem(pb->function_entries);
+  if(!pc)
+    return idx;
 
-  if(!the_pFile)
-    return;
+  pb->visited = 1;
 
-  fprintf(stderr," Optimizing pCode\n");
+  DFPRINTF((stderr," reassigning registers for function \"%s\"\n",PCF(pc)->fname));
+
+  if (pb->tregisters) {
+    regs *r;
+    for (r = setFirstItem(pb->tregisters); r; r = setNextItem(pb->tregisters)) {
+      if (r->type == REG_GPR) {
+        if (!r->isFixed) {
+          if (r->rIdx < (int)idx) {
+            char s[20];
+            r->rIdx = idx++;
+            if (peakIdx < idx) peakIdx = idx;
+            sprintf(s,"r0x%02X", r->rIdx);
+            DFPRINTF((stderr," reassigning register \"%s\" to \"%s\"\n",r->name,s));
+            free(r->name);
+            r->name = Safe_strdup(s);
+          }
+        }
+      }
+    }
+  }
+  for(pc = setFirstItem(pb->function_calls); pc; pc = setNextItem(pb->function_calls)) {
 
-  do {
-    for(pb = the_pFile->pbHead; pb; pb = pb->next) {
-      if('*' == dbName || getpBlock_dbName(pb) == dbName)
-       matches += OptimizepBlock(pb);
+    if(pc->type == PC_OPCODE && PCI(pc)->op == POC_CALL) {
+      char *dest = get_op_from_instruction(PCI(pc));
+
+      pCode *pcn = findFunction(dest);
+      if(pcn) {
+         register_reassign(pcn->pb,idx);
+      }
     }
+
   }
-  while(matches && ++passes < MAX_PASSES);
 
+  return idx;
+}
+
+/*------------------------------------------------------------------*/
+/* ReuseReg were call tree permits                                  */
+/*                                                                  */
+/*     Re-allocate the GPR for optimum reuse for a given pblock        */ 
+/*     eg  if a function m() calls function f1() and f2(), where f1    */
+/*     allocates a local variable vf1 and f2 allocates a local         */
+/*     variable vf2. Then providing f1 and f2 do not call each other   */
+/*     they may share the same general purpose registers for vf1 and   */
+/*     vf2.                                                            */
+/*     This is done by first setting the the regs rIdx to start after  */
+/*     all the global variables, then walking through the call tree    */
+/*     renaming the registers to match their new idx and incrementng   */
+/*     it as it goes. If a function has already been called it will    */
+/*     only rename the registers if it has already used up those       */
+/*     registers ie rIdx of the function's registers is lower than the */
+/*     current rIdx. That way the register will not be reused while    */
+/*     still being used by an eariler function call.                   */
+/*                                                                  */
+/*     Note for this to work the fucntions need to be declared static. */
+/*                                                                  */
+/*------------------------------------------------------------------*/
+void ReuseReg(void)
+{
+  pBlock  *pb;
+  InitReuseReg();
+  for(pb = the_pFile->pbHead; pb; pb = pb->next) {
+         /* Non static functions can be called from other modules so their registers must reassign */
+    if (pb->function_entries&&(PCF(setFirstItem(pb->function_entries))->isPublic||!pb->visited))
+      register_reassign(pb,peakIdx);
+  }
 }
 
 /*-----------------------------------------------------------------*/
-/* AnalyzepCode - parse the pCode that has been generated and form */
-/*                all of the logical connections.                  */
+/* buildCallTree - look at the flow and extract all of the calls   */
 /*                                                                 */
-/* Essentially what's done here is that the pCode flow is          */
-/* determined.                                                     */
 /*-----------------------------------------------------------------*/
 
-void AnalyzepCode(char dbName)
+void buildCallTree(void    )
 {
-  pBlock *pb;
-  pCode *pc;
   pBranch *pbr;
+  pBlock  *pb;
+  pCode   *pc;
 
   if(!the_pFile)
     return;
 
-  fprintf(stderr," Analyzing pCode");
-
-  /* First, merge the labels with the instructions */
-  for(pb = the_pFile->pbHead; pb; pb = pb->next) {
-    if('*' == dbName || getpBlock_dbName(pb) == dbName) {
-
-      fprintf(stderr," analyze and merging block %c\n",dbName);
-      pBlockMergeLabels(pb);
-      AnalyzepBlock(pb);
-    }
-  }
-
-  for(pb = the_pFile->pbHead; pb; pb = pb->next) {
-    if('*' == dbName || getpBlock_dbName(pb) == dbName)
-      OptimizepBlock(pb);
-  }
-
   /* Now build the call tree.
      First we examine all of the pCodes for functions.
      Keep in mind that the function boundaries coincide
@@ -2281,38 +5553,96 @@ void AnalyzepCode(char dbName)
 
    */
   for(pb = the_pFile->pbHead; pb; pb = pb->next) {
-    if('*' == dbName || getpBlock_dbName(pb) == dbName) {
-      pCode *pc_fstart=NULL;
-      for(pc = pb->pcHead; pc; pc = pc->next) {
-       if(pc->type == PC_FUNCTION) {
-         if (PCF(pc)->fname) {
-           // I'm not liking this....
-           // Found the beginning of a function.
-           _ALLOC(pbr,sizeof(pBranch));
-           pbr->pc = pc_fstart = pc;
-           pbr->next = NULL;
-
-           the_pFile->functions = pBranchAppend(the_pFile->functions,pbr);
-
-           // Here's a better way of doing the same:
-           addSet(&pb->function_entries, pc);
-
-         } else {
-           // Found an exit point in a function, e.g. return
-           // (Note, there may be more than one return per function)
-           if(pc_fstart)
-             pBranchLink(pc_fstart, pc);
-
-           addSet(&pb->function_exits, pc);
-         }
-       } else  if(pc->type == PC_OPCODE && PCI(pc)->op == POC_CALL) {
-         addSet(&pb->function_calls,pc);
-       }
+    pCode *pc_fstart=NULL;
+    for(pc = pb->pcHead; pc; pc = pc->next) {
+      if(isPCF(pc)) {
+        pCodeFunction *pcf = PCF(pc);
+        if (pcf->fname) {
+
+          if(STRCASECMP(pcf->fname, "_main") == 0) {
+            //fprintf(stderr," found main \n");
+            pb->cmemmap = NULL;  /* FIXME do we need to free ? */
+            pb->dbName = 'M';
+          }
+
+          pbr = Safe_calloc(1,sizeof(pBranch));
+          pbr->pc = pc_fstart = pc;
+          pbr->next = NULL;
+
+          the_pFile->functions = pBranchAppend(the_pFile->functions,pbr);
+
+          // Here's a better way of doing the same:
+          addSet(&pb->function_entries, pc);
+
+        } else {
+          // Found an exit point in a function, e.g. return
+          // (Note, there may be more than one return per function)
+          if(pc_fstart)
+            pBranchLink(PCF(pc_fstart), pcf);
+
+          addSet(&pb->function_exits, pc);
+        }
+      } else if(isCALL(pc)) {
+        addSet(&pb->function_calls,pc);
       }
     }
   }
 }
 
+/*-----------------------------------------------------------------*/
+/* AnalyzepCode - parse the pCode that has been generated and form */
+/*                all of the logical connections.                  */
+/*                                                                 */
+/* Essentially what's done here is that the pCode flow is          */
+/* determined.                                                     */
+/*-----------------------------------------------------------------*/
+
+void AnalyzepCode(char dbName)
+{
+  pBlock *pb;
+  int i,changes;
+
+  if(!the_pFile)
+    return;
+
+  mergepBlocks('D');
+
+
+  /* Phase 1 - Register allocation and peep hole optimization
+   *
+   * The first part of the analysis is to determine the registers
+   * that are used in the pCode. Once that is done, the peep rules
+   * are applied to the code. We continue to loop until no more
+   * peep rule optimizations are found (or until we exceed the
+   * MAX_PASSES threshold). 
+   *
+   * When done, the required registers will be determined.
+   *
+   */
+  i = 0;
+  do {
+
+    DFPRINTF((stderr," Analyzing pCode: PASS #%d\n",i+1));
+
+    /* First, merge the labels with the instructions */
+    for(pb = the_pFile->pbHead; pb; pb = pb->next) {
+      if('*' == dbName || getpBlock_dbName(pb) == dbName) {
+
+       DFPRINTF((stderr," analyze and merging block %c\n",dbName));
+       pBlockMergeLabels(pb);
+       AnalyzepBlock(pb);
+      } else {
+       DFPRINTF((stderr," skipping block analysis dbName=%c blockname=%c\n",dbName,getpBlock_dbName));
+      }
+    }
+
+    changes = OptimizepCode(dbName);
+
+  } while(changes && (i++ < MAX_PASSES));
+
+  buildCallTree();
+}
+
 /*-----------------------------------------------------------------*/
 /* ispCodeFunction - returns true if *pc is the pCode of a         */
 /*                   function                                      */
@@ -2364,8 +5694,10 @@ void MarkUsedRegisters(set *regset)
 
   for(r1=setFirstItem(regset); r1; r1=setNextItem(regset)) {
     r2 = pic14_regWithIdx(r1->rIdx);
-    r2->isFree = 0;
-    r2->wasUsed = 1;
+    if (r2) {
+      r2->isFree = 0;
+      r2->wasUsed = 1;
+    }
   }
 }
 
@@ -2375,46 +5707,49 @@ void pBlockStats(FILE *of, pBlock *pb)
   pCode *pc;
   regs  *r;
 
-  fprintf(of,"***\n  pBlock Stats\n***\n");
+  fprintf(of,";***\n;  pBlock Stats: dbName = %c\n;***\n",getpBlock_dbName(pb));
 
   // for now just print the first element of each set
   pc = setFirstItem(pb->function_entries);
   if(pc) {
-    fprintf(of,"entry\n");
+    fprintf(of,";entry:  ");
     pc->print(of,pc);
   }
   pc = setFirstItem(pb->function_exits);
   if(pc) {
-    fprintf(of,"has an exit\n");
-    pc->print(of,pc);
+    fprintf(of,";has an exit\n");
+    //pc->print(of,pc);
   }
 
   pc = setFirstItem(pb->function_calls);
   if(pc) {
-    fprintf(of,"functions called\n");
+    fprintf(of,";functions called:\n");
 
     while(pc) {
-      pc->print(of,pc);
+      if(pc->type == PC_OPCODE && PCI(pc)->op == POC_CALL) {
+       fprintf(of,";   %s\n",get_op_from_instruction(PCI(pc)));
+      }
       pc = setNextItem(pb->function_calls);
     }
   }
 
-  r = setFirstItem(pb->registers);
+  r = setFirstItem(pb->tregisters);
   if(r) {
-    int n = elementsInSet(pb->registers);
+    int n = elementsInSet(pb->tregisters);
 
-    fprintf(of,"%d compiler assigned register%c:\n",n, ( (n!=1) ? 's' : ' '));
+    fprintf(of,";%d compiler assigned register%c:\n",n, ( (n!=1) ? 's' : ' '));
 
     while (r) {
-      fprintf(of,"   %s\n",r->name);
-      r = setNextItem(pb->registers);
+      fprintf(of,";   %s\n",r->name);
+      r = setNextItem(pb->tregisters);
     }
   }
 }
 
 /*-----------------------------------------------------------------*/
 /*-----------------------------------------------------------------*/
-void sequencepCode(void)
+#if 0
+static void sequencepCode(void)
 {
   pBlock *pb;
   pCode *pc;
@@ -2429,16 +5764,18 @@ void sequencepCode(void)
   }
 
 }
+#endif
 
 /*-----------------------------------------------------------------*/
 /*-----------------------------------------------------------------*/
+/*
 set *register_usage(pBlock *pb)
 {
   pCode *pc,*pcn;
   set *registers=NULL;
   set *registersInCallPath = NULL;
 
-  /* check recursion */
+  / * check recursion * /
 
   pc = setFirstItem(pb->function_entries);
 
@@ -2454,7 +5791,7 @@ set *register_usage(pBlock *pb)
   for( ; pc; pc = setNextItem(pb->function_calls)) {
 
     if(pc->type == PC_OPCODE && PCI(pc)->op == POC_CALL) {
-      char *dest = get_op(PCI(pc));
+      char *dest = get_op_from_instruction(PCI(pc));
 
       pcn = findFunction(dest);
       if(pcn) 
@@ -2464,74 +5801,80 @@ set *register_usage(pBlock *pb)
 
   }
 
-
+#ifdef PCODE_DEBUG
   pBlockStats(stderr,pb);  // debug
+#endif
+
+  // Mark the registers in this block as used.
+
+  MarkUsedRegisters(pb->tregisters);
   if(registersInCallPath) {
-    /* registers were used in the functions this pBlock has called */
-    /* so now, we need to see if these collide with the ones we are */
-    /* using here */
+    / * registers were used in the functions this pBlock has called * /
+    / * so now, we need to see if these collide with the ones we are * /
+    / * using here * /
 
     regs *r1,*r2, *newreg;
 
-    fprintf(stderr,"comparing registers\n");
+    DFPRINTF((stderr,"comparing registers\n"));
 
     r1 = setFirstItem(registersInCallPath);
     while(r1) {
-
-      r2 = setFirstItem(pb->registers);
-
-      while(r2) {
-
-       if(r2->rIdx == r1->rIdx) {
-         newreg = pic14_findFreeReg();
-
-
-         if(!newreg) {
-           fprintf(stderr,"Bummer, no more registers.\n");
-           exit(1);
-         }
-
-         fprintf(stderr,"Cool found register collision nIdx=%d moving to %d\n",
-                 r1->rIdx, newreg->rIdx);
-         r2->rIdx = newreg->rIdx;
-         //if(r2->name) free(r2->name);
-         if(newreg->name)
-           r2->name = Safe_strdup(newreg->name);
-         else
-           r2->name = NULL;
-         newreg->isFree = 0;
-         newreg->wasUsed = 1;
-       }
-       r2 = setNextItem(pb->registers);
+      if (r1->type != REG_STK) {
+        r2 = setFirstItem(pb->tregisters);
+
+        while(r2 && (r2->type != REG_STK)) {
+
+          if(r2->rIdx == r1->rIdx) {
+            newreg = pic14_findFreeReg(REG_GPR);
+
+
+            if(!newreg) {
+              DFPRINTF((stderr,"Bummer, no more registers.\n"));
+              exit(1);
+            }
+
+            DFPRINTF((stderr,"Cool found register collision nIdx=%d moving to %d\n",
+            r1->rIdx, newreg->rIdx));
+            r2->rIdx = newreg->rIdx;
+            if(newreg->name)
+              r2->name = Safe_strdup(newreg->name);
+            else
+              r2->name = NULL;
+            newreg->isFree = 0;
+            newreg->wasUsed = 1;
+          }
+          r2 = setNextItem(pb->tregisters);
+        }
       }
 
       r1 = setNextItem(registersInCallPath);
     }
 
-    /* Collisions have been resolved. Now free the registers in the call path */
+    / * Collisions have been resolved. Now free the registers in the call path * /
     r1 = setFirstItem(registersInCallPath);
     while(r1) {
-      newreg = pic14_regWithIdx(r1->rIdx);
-      newreg->isFree = 1;
+       newreg = pic14_regWithIdx(r1->rIdx);
+       if (newreg) newreg->isFree = 1;
       r1 = setNextItem(registersInCallPath);
     }
 
-  } else
-    MarkUsedRegisters(pb->registers);
-
-  registers = unionSets(pb->registers, registersInCallPath, THROW_NONE);
+  }// else
+  //    MarkUsedRegisters(pb->registers);
 
+  registers = unionSets(pb->tregisters, registersInCallPath, THROW_NONE);
+#ifdef PCODE_DEBUG
   if(registers) 
-    fprintf(stderr,"returning regs\n");
+    DFPRINTF((stderr,"returning regs\n"));
   else
-    fprintf(stderr,"not returning regs\n");
+    DFPRINTF((stderr,"not returning regs\n"));
 
-  fprintf(stderr,"pBlock after register optim.\n");
+  DFPRINTF((stderr,"pBlock after register optim.\n"));
   pBlockStats(stderr,pb);  // debug
-
+#endif
 
   return registers;
 }
+*/
 
 /*-----------------------------------------------------------------*/
 /* printCallTree - writes the call tree to a file                  */
@@ -2544,10 +5887,10 @@ void pct2(FILE *of,pBlock *pb,int indent)
   //  set *registersInCallPath = NULL;
 
   if(!of)
-    return;// registers;
+    return;
 
   if(indent > 10)
-    return; // registers;   //recursion ?
+    return; //recursion ?
 
   pc = setFirstItem(pb->function_entries);
 
@@ -2569,7 +5912,7 @@ void pct2(FILE *of,pBlock *pb,int indent)
   for( ; pc; pc = setNextItem(pb->function_calls)) {
 
     if(pc->type == PC_OPCODE && PCI(pc)->op == POC_CALL) {
-      char *dest = get_op(PCI(pc));
+      char *dest = get_op_from_instruction(PCI(pc));
 
       pcn = findFunction(dest);
       if(pcn) 
@@ -2582,77 +5925,6 @@ void pct2(FILE *of,pBlock *pb,int indent)
 
 }
 
-#if 0
-  fprintf(stderr,"pBlock before register optim.\n");
-  pBlockStats(stderr,pb);  // debug
-
-  if(registersInCallPath) {
-    /* registers were used in the functions this pBlock has called */
-    /* so now, we need to see if these collide with the ones we are using here */
-
-    regs *r1,*r2, *newreg;
-
-    fprintf(stderr,"comparing registers\n");
-
-    r1 = setFirstItem(registersInCallPath);
-    while(r1) {
-
-      r2 = setFirstItem(pb->registers);
-
-      while(r2) {
-
-       if(r2->rIdx == r1->rIdx) {
-         newreg = pic14_findFreeReg();
-
-
-         if(!newreg) {
-           fprintf(stderr,"Bummer, no more registers.\n");
-           exit(1);
-         }
-
-         fprintf(stderr,"Cool found register collision nIdx=%d moving to %d\n",
-                 r1->rIdx, newreg->rIdx);
-         r2->rIdx = newreg->rIdx;
-         //if(r2->name) free(r2->name);
-         if(newreg->name)
-           r2->name = Safe_strdup(newreg->name);
-         else
-           r2->name = NULL;
-         newreg->isFree = 0;
-         newreg->wasUsed = 1;
-       }
-       r2 = setNextItem(pb->registers);
-      }
-
-      r1 = setNextItem(registersInCallPath);
-    }
-
-    /* Collisions have been resolved. Now free the registers in the call path */
-    r1 = setFirstItem(registersInCallPath);
-    while(r1) {
-      newreg = pic14_regWithIdx(r1->rIdx);
-      newreg->isFree = 1;
-      r1 = setNextItem(registersInCallPath);
-    }
-
-  } else
-    MarkUsedRegisters(pb->registers);
-
-  registers = unionSets(pb->registers, registersInCallPath, THROW_NONE);
-
-  if(registers) 
-    fprintf(stderr,"returning regs\n");
-  else
-    fprintf(stderr,"not returning regs\n");
-
-  fprintf(stderr,"pBlock after register optim.\n");
-  pBlockStats(stderr,pb);  // debug
-
-
-  return registers;
-
-#endif
-
 
 /*-----------------------------------------------------------------*/
 /* printCallTree - writes the call tree to a file                  */
@@ -2673,7 +5945,7 @@ void printCallTree(FILE *of)
 
   fprintf(of, "\npBlock statistics\n");
   for(pb = the_pFile->pbHead; pb;  pb = pb->next )
-    pBlockStats(stderr,pb);
+    pBlockStats(of,pb);
 
 
 
@@ -2691,7 +5963,7 @@ void printCallTree(FILE *of)
       while(pc->next && !ispCodeFunction(pc->next)) {
        pc = pc->next;
        if(pc->type == PC_OPCODE && PCI(pc)->op == POC_CALL)
-         fprintf(of,"\t%s\n",get_op(PCI(pc)));
+         fprintf(of,"\t%s\n",get_op_from_instruction(PCI(pc)));
       }
     }
 
@@ -2699,16 +5971,6 @@ void printCallTree(FILE *of)
   }
 
 
-  /* Re-allocate the registers so that there are no collisions
-   * between local variables when one function call another */
-
-  pic14_deallocateAllRegs();
-
-  for(pb = the_pFile->pbHead; pb; pb = pb->next) {
-    if(!pb->visited)
-      register_usage(pb);
-  }
-
   fprintf(of,"\n**************\n\na better call tree\n");
   for(pb = the_pFile->pbHead; pb; pb = pb->next) {
     if(pb->visited)
@@ -2719,3 +5981,165 @@ void printCallTree(FILE *of)
     fprintf(of,"block dbname: %c\n", getpBlock_dbName(pb));
   }
 }
+
+
+
+/*-----------------------------------------------------------------*/
+/*                                                                 */
+/*-----------------------------------------------------------------*/
+
+void InlineFunction(pBlock *pb)
+{
+  pCode *pc;
+  pCode *pc_call;
+
+  if(!pb)
+    return;
+
+  pc = setFirstItem(pb->function_calls);
+
+  for( ; pc; pc = setNextItem(pb->function_calls)) {
+
+    if(isCALL(pc)) {
+      pCode *pcn = findFunction(get_op_from_instruction(PCI(pc)));
+         pCode *pcp = pc->prev;
+      pCode *pct;
+      pCode *pce;
+
+      pBranch *pbr;
+
+      if(pcn && isPCF(pcn) && (PCF(pcn)->ncalled == 1) && !PCF(pcn)->isPublic && (pcp && (isPCI_BITSKIP(pcp)||!isPCI_SKIP(pcp)))) { /* Bit skips can be inverted other skips can not */
+
+        InlineFunction(pcn->pb);
+
+        /*
+          At this point, *pc points to a CALL mnemonic, and
+          *pcn points to the function that is being called.
+
+          To in-line this call, we need to remove the CALL
+          and RETURN(s), and link the function pCode in with
+          the CALLee pCode.
+
+        */
+
+        pc_call = pc;
+
+        /* Check if previous instruction was a bit skip */
+        if (isPCI_BITSKIP(pcp)) {
+          pCodeLabel *pcl;
+          /* Invert skip instruction and add a goto */
+          PCI(pcp)->op = (PCI(pcp)->op == POC_BTFSS) ? POC_BTFSC : POC_BTFSS;
+
+          if(isPCL(pc_call->next)) { // Label pcode
+            pcl = PCL(pc_call->next);
+          } else if (isPCI(pc_call->next) && PCI(pc_call->next)->label) { // pcode instruction with a label
+            pcl = PCL(PCI(pc_call->next)->label->pc);
+          } else {
+            pcl = PCL(newpCodeLabel(NULL, newiTempLabel(NULL)->key+100));
+            PCI(pc_call->next)->label->pc = (struct pCode*)pcl;
+          }
+          pCodeInsertAfter(pcp, newpCode(POC_GOTO, newpCodeOp(pcl->label,PO_STR)));
+        }
+
+        /* remove callee pBlock from the pBlock linked list */
+        removepBlock(pcn->pb);
+
+        pce = pcn;
+        while(pce) {
+          pce->pb = pb;
+          pce = pce->next;
+        }
+
+        /* Remove the Function pCode */
+        pct = findNextInstruction(pcn->next);
+
+        /* Link the function with the callee */
+        if (pcp) pcp->next = pcn->next;
+        pcn->next->prev = pcp;
+
+        /* Convert the function name into a label */
+
+        pbr = Safe_calloc(1,sizeof(pBranch));
+        pbr->pc = newpCodeLabel(PCF(pcn)->fname, -1);
+        pbr->next = NULL;
+        PCI(pct)->label = pBranchAppend(PCI(pct)->label,pbr);
+        PCI(pct)->label = pBranchAppend(PCI(pct)->label,PCI(pc_call)->label);
+
+        /* turn all of the return's except the last into goto's */
+        /* check case for 2 instruction pBlocks */
+        pce = findNextInstruction(pcn->next);
+        while(pce) {
+        pCode *pce_next = findNextInstruction(pce->next);
+
+          if(pce_next == NULL) {
+            /* found the last return */
+            pCode *pc_call_next =  findNextInstruction(pc_call->next);
+
+            //fprintf(stderr,"found last return\n");
+            //pce->print(stderr,pce);
+            pce->prev->next = pc_call->next;
+            pc_call->next->prev = pce->prev;
+            PCI(pc_call_next)->label = pBranchAppend(PCI(pc_call_next)->label,
+            PCI(pce)->label);
+          }
+
+          pce = pce_next;
+        }
+
+      }
+    } else
+      fprintf(stderr,"BUG? pCode isn't a POC_CALL %d\n",__LINE__);
+
+  }
+
+}
+
+/*-----------------------------------------------------------------*/
+/*                                                                 */
+/*-----------------------------------------------------------------*/
+
+void InlinepCode(void)
+{
+
+  pBlock  *pb;
+  pCode   *pc;
+
+  if(!the_pFile)
+    return;
+
+  if(!functionInlining)
+    return;
+
+  /* Loop through all of the function definitions and count the
+   * number of times each one is called */
+  //fprintf(stderr,"inlining %d\n",__LINE__);
+
+  for(pb = the_pFile->pbHead; pb; pb = pb->next) {
+
+    pc = setFirstItem(pb->function_calls);
+
+    for( ; pc; pc = setNextItem(pb->function_calls)) {
+
+      if(isCALL(pc)) {
+       pCode *pcn = findFunction(get_op_from_instruction(PCI(pc)));
+       if(pcn && isPCF(pcn)) {
+         PCF(pcn)->ncalled++;
+       }
+      } else
+       fprintf(stderr,"BUG? pCode isn't a POC_CALL %d\n",__LINE__);
+
+    }
+  }
+
+  //fprintf(stderr,"inlining %d\n",__LINE__);
+
+  /* Now, Loop through the function definitions again, but this
+   * time inline those functions that have only been called once. */
+  
+  InlineFunction(the_pFile->pbHead);
+  //fprintf(stderr,"inlining %d\n",__LINE__);
+
+  for(pb = the_pFile->pbHead; pb; pb = pb->next)
+    unBuildFlow(pb);
+
+}