ruberon/source/MSP430.ob07

MODULE MSP430;

IMPORT IL, LISTS, REG, CHL := CHUNKLISTS, ERRORS, WR := WRITER, HEX,
       UTILS, C := CONSOLE, PROG, RTL := MSP430RTL;


CONST

    chkSTK* = 6;

    minRAM* = 128;  maxRAM* = 2048;
    minROM* = 2048; maxROM* = 24576;

    StkReserve = RTL.StkReserve;

    IntVectorSize* = RTL.IntVectorSize;

    PC = 0; SP = 1; SR = 2; CG = 3;

    R4 = 4; R5 = 5; R6 = 6; R7 = 7;

    HP = RTL.HP;

    ACC = R4;

    opRRC  = 1000H;  opSWPB = 1080H;  opRRA  = 1100H;  opSXT = 1180H;
    opPUSH = 1200H;  opCALL = 1280H;  opRETI = 1300H;

    opMOV = 04000H;  opADD = 05000H;  opADDC = 06000H;  opSUBC = 07000H;
    opSUB = 08000H;  opCMP = 09000H;  opDADD = 0A000H;  opBIT  = 0B000H;
    opBIC = 0C000H;  opBIS = 0D000H;  opXOR  = 0E000H;  opAND  = 0F000H;

    opJNE = 2000H;  opJEQ = 2400H;  opJNC = 2800H;  opJC  = 2C00H;
    opJN  = 3000H;  opJGE = 3400H;  opJL  = 3800H;  opJMP = 3C00H;

    sREG = 0; sIDX = 16; sINDIR = 32; sINCR = 48; BW = 64; dIDX = 128;

    NOWORD = 10000H;

    RCODE = 0; RDATA = 1; RBSS = 2;

    je  = 0;  jne = je  + 1;
    jge = 2;  jl  = jge + 1;
    jle = 4;  jg  = jle + 1;
    jb  = 6;


TYPE

    ANYCODE = POINTER TO RECORD (LISTS.ITEM)

        offset: INTEGER

    END;

    WORD = POINTER TO RECORD (ANYCODE)

        val: INTEGER

    END;

    LABEL = POINTER TO RECORD (ANYCODE)

        num: INTEGER

    END;

    JMP = POINTER TO RECORD (ANYCODE)

        cc, label: INTEGER;
        short: BOOLEAN

    END;

    CALL = POINTER TO RECORD (ANYCODE)

        label: INTEGER

    END;

    COMMAND = IL.COMMAND;

    RELOC = POINTER TO RECORD (LISTS.ITEM)

        section: INTEGER;
        WordPtr: WORD

    END;


VAR

    R: REG.REGS;

    CodeList: LISTS.LIST;
    RelList:  LISTS.LIST;

    mem: ARRAY 65536 OF BYTE;

    Labels: CHL.INTLIST;

    IV: ARRAY RTL.LenIV OF INTEGER;

    IdxWords: RECORD src, dst: INTEGER END;

    StkCnt, MaxStkCnt: INTEGER;


PROCEDURE CheckProcDataSize* (VarSize, RamSize: INTEGER): BOOLEAN;
        RETURN (VarSize + 1) * 2 + StkReserve + RTL.VarSize < RamSize
    END CheckProcDataSize;


PROCEDURE EmitLabel (L: INTEGER);
    VAR
        label: LABEL;

    BEGIN
        NEW(label);
        label.num := L;
        LISTS.push(CodeList, label)
    END EmitLabel;


PROCEDURE EmitWord (val: INTEGER);
    VAR
        word: WORD;

    BEGIN
        IF val < 0 THEN
            ASSERT(val >= -32768);
            val := val MOD 65536
        ELSE
            ASSERT(val <= 65535)
        END;
        NEW(word);
        word.val := val;
        LISTS.push(CodeList, word)
    END EmitWord;


PROCEDURE EmitJmp (cc, label: INTEGER);
    VAR
        jmp: JMP;

    BEGIN
        NEW(jmp);
        jmp.cc := cc;
        jmp.label := label;
        jmp.short := FALSE;
        LISTS.push(CodeList, jmp)
    END EmitJmp;


PROCEDURE EmitCall (label: INTEGER);
    VAR
        call: CALL;

    BEGIN
        NEW(call);
        call.label := label;
        LISTS.push(CodeList, call)
    END EmitCall;


PROCEDURE IncStk;
    BEGIN
        INC(StkCnt);
        MaxStkCnt := MAX(StkCnt, MaxStkCnt)
    END IncStk;


PROCEDURE bw (b: BOOLEAN): INTEGER;
        RETURN BW * ORD(b)
    END bw;


PROCEDURE src_x (x, Rn: INTEGER): INTEGER;
    VAR
        res: INTEGER;

    BEGIN
        IF (x = 0) & ~(Rn IN {PC, SR, CG}) THEN
            res := Rn * 256 + sINDIR
        ELSE
            IdxWords.src := x;
            res := Rn * 256 + sIDX
        END

        RETURN res
    END src_x;


PROCEDURE dst_x (x, Rn: INTEGER): INTEGER;
    BEGIN
        IdxWords.dst := x
        RETURN Rn + dIDX
    END dst_x;


PROCEDURE indir (Rn: INTEGER): INTEGER;
        RETURN Rn * 256 + sINDIR
    END indir;


PROCEDURE incr (Rn: INTEGER): INTEGER;
        RETURN Rn * 256 + sINCR
    END incr;


PROCEDURE imm (x: INTEGER): INTEGER;
    VAR
        res: INTEGER;

    BEGIN
        CASE x OF
        | 0: res := CG * 256
        | 1: res := CG * 256 + sIDX
        | 2: res := indir(CG)
        | 4: res := indir(SR)
        | 8: res := incr(SR)
        |-1: res := incr(CG)
        ELSE
            res := incr(PC);
            IdxWords.src := x
        END

        RETURN res
    END imm;


PROCEDURE Op2 (op, src, dst: INTEGER);
    BEGIN
        ASSERT(BITS(op) - {6, 12..15} = {});
        ASSERT(BITS(src) - {4, 5, 8..11} = {});
        ASSERT(BITS(dst) - {0..3, 7} = {});

        EmitWord(op + src + dst);

        IF IdxWords.src # NOWORD THEN
            EmitWord(IdxWords.src);
            IdxWords.src := NOWORD
        END;

        IF IdxWords.dst # NOWORD THEN
            EmitWord(IdxWords.dst);
            IdxWords.dst := NOWORD
        END
    END Op2;


PROCEDURE Op1 (op, reg, As: INTEGER);
    BEGIN
        EmitWord(op + reg + As)
    END Op1;


PROCEDURE MovRR (src, dst: INTEGER);
    BEGIN
        Op2(opMOV, src * 256, dst)
    END MovRR;


PROCEDURE PushImm (imm: INTEGER);
    BEGIN
        imm := UTILS.Long(imm);
        CASE imm OF
        | 0: Op1(opPUSH, CG, sREG)
        | 1: Op1(opPUSH, CG, sIDX)
        | 2: Op1(opPUSH, CG, sINDIR)
        |-1: Op1(opPUSH, CG, sINCR)
        ELSE
            Op1(opPUSH, PC, sINCR);
            EmitWord(imm)
        END;
        IncStk
    END PushImm;


PROCEDURE PutWord (word: INTEGER; VAR adr: INTEGER);
    BEGIN
        ASSERT(~ODD(adr));
        ASSERT((0 <= word) & (word <= 65535));
        mem[adr] := word MOD 256;
        mem[adr + 1] := word DIV 256;
        INC(adr, 2)
    END PutWord;


PROCEDURE NewLabel (): INTEGER;
    BEGIN
        CHL.PushInt(Labels, 0)
        RETURN IL.NewLabel()
    END NewLabel;


PROCEDURE LabelOffs (n: INTEGER): INTEGER;
        RETURN CHL.GetInt(Labels, n)
    END LabelOffs;


PROCEDURE Fixup (CodeAdr, IntVectorSize: INTEGER): INTEGER;
    VAR
        cmd:      ANYCODE;
        adr:      INTEGER;
        offset:   INTEGER;
        diff:     INTEGER;
        cc:       INTEGER;
        shorted:  BOOLEAN;

    BEGIN
        REPEAT
            shorted := FALSE;
            offset := CodeAdr DIV 2;

            cmd := CodeList.first(ANYCODE);
            WHILE cmd # NIL DO
                cmd.offset := offset;
                CASE cmd OF
                |LABEL: CHL.SetInt(Labels, cmd.num, offset)
                |JMP:   INC(offset);
                        IF ~cmd.short THEN
                            INC(offset);
                            IF cmd.cc # opJMP THEN
                                INC(offset)
                            END
                        END

                |CALL:  INC(offset, 2)
                |WORD:  INC(offset)
                END;
                cmd := cmd.next(ANYCODE)
            END;

            cmd := CodeList.first(ANYCODE);
            WHILE cmd # NIL DO
                IF (cmd IS JMP) & ~cmd(JMP).short THEN
                    diff := LabelOffs(cmd(JMP).label) - cmd.offset - 1;
                    IF ABS(diff) <= 512 THEN
                        cmd(JMP).short := TRUE;
                        shorted := TRUE
                    END
                END;
                cmd := cmd.next(ANYCODE)
            END

        UNTIL ~shorted;

        IF offset * 2 > 10000H - IntVectorSize THEN
            ERRORS.Error(203)
        END;

        adr := CodeAdr;
        cmd := CodeList.first(ANYCODE);
        WHILE cmd # NIL DO
            CASE cmd OF
            |LABEL:

            |JMP:   IF ~cmd.short THEN
                        CASE cmd.cc OF
                        |opJNE: cc := opJEQ
                        |opJEQ: cc := opJNE
                        |opJNC: cc := opJC
                        |opJC:  cc := opJNC
                        |opJGE: cc := opJL
                        |opJL:  cc := opJGE
                        |opJMP: cc := opJMP
                        END;

                        IF cc # opJMP THEN
                            PutWord(cc + 2, adr)  (* jcc L *)
                        END;

                        PutWord(4030H, adr); (* MOV @PC+, PC *)
                        PutWord(LabelOffs(cmd.label) * 2, adr)
                        (* L: *)
                    ELSE
                        diff := LabelOffs(cmd.label) - cmd.offset - 1;
                        ASSERT((-512 <= diff) & (diff <= 511));
                        PutWord(cmd.cc + diff MOD 1024, adr)
                    END

            |CALL:  PutWord(12B0H, adr); (* CALL @PC+ *)
                    PutWord(LabelOffs(cmd.label) * 2, adr)

            |WORD:  PutWord(cmd.val, adr)

            END;
            cmd := cmd.next(ANYCODE)
        END

        RETURN adr - CodeAdr
    END Fixup;


PROCEDURE Push (reg: INTEGER);
    BEGIN
        Op1(opPUSH, reg, sREG);
        IncStk
    END Push;


PROCEDURE Pop (reg: INTEGER);
    BEGIN
        Op2(opMOV, incr(SP), reg);
        DEC(StkCnt)
    END Pop;


PROCEDURE Test (reg: INTEGER);
    BEGIN
        Op2(opCMP, imm(0), reg)
    END Test;


PROCEDURE Clear (reg: INTEGER);
    BEGIN
        Op2(opMOV, imm(0), reg)
    END Clear;


PROCEDURE mov (dst, src: INTEGER);
    BEGIN
        MovRR(src, dst)
    END mov;


PROCEDURE xchg (reg1, reg2: INTEGER);
    BEGIN
        Push(reg1);
        mov(reg1, reg2);
        Pop(reg2)
    END xchg;


PROCEDURE Reloc (section: INTEGER);
    VAR
        reloc: RELOC;

    BEGIN
        NEW(reloc);
        reloc.section := section;
        reloc.WordPtr := CodeList.last(WORD);
        LISTS.push(RelList, reloc)
    END Reloc;


PROCEDURE CallRTL (proc, params: INTEGER);
    BEGIN
        IncStk;
        DEC(StkCnt);
        EmitCall(RTL.rtl[proc].label);
        RTL.Used(proc);
        IF params > 0 THEN
            Op2(opADD, imm(params * 2), SP);
            DEC(StkCnt, params)
        END
    END CallRTL;


PROCEDURE UnOp (VAR reg: INTEGER);
    BEGIN
        REG.UnOp(R, reg)
    END UnOp;


PROCEDURE BinOp (VAR reg1, reg2: INTEGER);
    BEGIN
        REG.BinOp(R, reg1, reg2)
    END BinOp;


PROCEDURE GetRegA;
    BEGIN
        ASSERT(REG.GetReg(R, ACC))
    END GetRegA;


PROCEDURE drop;
    BEGIN
        REG.Drop(R)
    END drop;


PROCEDURE GetAnyReg (): INTEGER;
        RETURN REG.GetAnyReg(R)
    END GetAnyReg;


PROCEDURE PushAll (NumberOfParameters: INTEGER);
    BEGIN
        REG.PushAll(R);
        DEC(R.pushed, NumberOfParameters)
    END PushAll;


PROCEDURE PushAll_1;
    BEGIN
        REG.PushAll_1(R)
    END PushAll_1;


PROCEDURE cond (op: INTEGER): INTEGER;
    VAR
        res: INTEGER;

    BEGIN
        CASE op OF
        |IL.opGT, IL.opGTC: res := jg
        |IL.opGE, IL.opGEC: res := jge
        |IL.opLT, IL.opLTC: res := jl
        |IL.opLE, IL.opLEC: res := jle
        |IL.opEQ, IL.opEQC: res := je
        |IL.opNE, IL.opNEC: res := jne
        END

        RETURN res
    END cond;


PROCEDURE jcc (cc, label: INTEGER);
    VAR
        L: INTEGER;

    BEGIN
        CASE cc OF
        |jne:
            EmitJmp(opJNE, label)
        |je:
            EmitJmp(opJEQ, label)
        |jge:
            EmitJmp(opJGE, label)
        |jl:
            EmitJmp(opJL, label)
        |jle:
            EmitJmp(opJL, label);
            EmitJmp(opJEQ, label)
        |jg:
            L := NewLabel();
            EmitJmp(opJEQ, L);
            EmitJmp(opJGE, label);
            EmitLabel(L)
        |jb:
            EmitJmp(opJNC, label)
        END
    END jcc;


PROCEDURE setcc (cc, reg: INTEGER);
    VAR
        L: INTEGER;

    BEGIN
        L := NewLabel();
        Op2(opMOV, imm(1), reg);
        jcc(cc, L);
        Clear(reg);
        EmitLabel(L)
    END setcc;


PROCEDURE Shift2 (op, reg, n: INTEGER);
    VAR
        reg2: INTEGER;

    BEGIN
        IF n >= 8 THEN
            CASE op OF
            |IL.opASR2: Op1(opSWPB, reg, sREG); Op1(opSXT, reg, sREG)
            |IL.opROR2: Op1(opSWPB, reg, sREG)
            |IL.opLSL2: Op1(opSWPB, reg, sREG); Op2(opBIC, imm(255), reg)
            |IL.opLSR2: Op2(opBIC, imm(255), reg); Op1(opSWPB, reg, sREG)
            END;
            DEC(n, 8)
        END;

        IF (op = IL.opROR2) & (n > 0) THEN
            reg2 := GetAnyReg();
            MovRR(reg, reg2)
        ELSE
            reg2 := -1
        END;

        WHILE n > 0 DO
            CASE op OF
            |IL.opASR2: Op1(opRRA, reg, sREG)
            |IL.opROR2: Op1(opRRC, reg2, sREG); Op1(opRRC, reg, sREG)
            |IL.opLSL2: Op2(opADD, reg * 256, reg)
            |IL.opLSR2: Op2(opBIC, imm(1), SR); Op1(opRRC, reg, sREG)
            END;
            DEC(n)
        END;

        IF reg2 # -1 THEN
            drop
        END

    END Shift2;


PROCEDURE Neg (reg: INTEGER);
    BEGIN
        Op2(opXOR, imm(-1), reg);
        Op2(opADD, imm(1), reg)
    END Neg;


PROCEDURE LocalOffset (offset: INTEGER): INTEGER;
        RETURN (offset + StkCnt - ORD(offset > 0)) * 2
    END LocalOffset;


PROCEDURE LocalDst (offset: INTEGER): INTEGER;
        RETURN dst_x(LocalOffset(offset), SP)
    END LocalDst;


PROCEDURE LocalSrc (offset: INTEGER): INTEGER;
        RETURN src_x(LocalOffset(offset), SP)
    END LocalSrc;


PROCEDURE translate (chk_stk: BOOLEAN);
    VAR
        cmd, next: COMMAND;

        opcode, param1, param2, L, a, n, c1, c2: INTEGER;

        reg1, reg2: INTEGER;

        cc: INTEGER;

        word: WORD;

    BEGIN
        cmd := IL.codes.commands.first(COMMAND);

        WHILE cmd # NIL DO

            param1 := cmd.param1;
            param2 := cmd.param2;

            opcode := cmd.opcode;

            CASE opcode OF
            |IL.opJMP:
                EmitJmp(opJMP, param1)

            |IL.opCALL:
                IncStk;
                DEC(StkCnt);
                EmitCall(param1)

            |IL.opCALLP:
                IncStk;
                DEC(StkCnt);
                UnOp(reg1);
                Op1(opCALL, reg1, sREG);
                drop;
                ASSERT(R.top = -1)

            |IL.opPRECALL:
                PushAll(0)

            |IL.opLABEL:
                EmitLabel(param1)

            |IL.opSADR_PARAM:
                Op1(opPUSH, PC, sINCR);
                IncStk;
                EmitWord(param2);
                Reloc(RDATA)

            |IL.opERR:
                CallRTL(RTL._error, 2)

            |IL.opPUSHC:
                PushImm(param2)

            |IL.opONERR:
                DEC(StkCnt);
                EmitWord(0C232H); (*  BIC   #8, SR; DINT  *)
                EmitWord(4303H);  (*  MOV   R3, R3; NOP   *)
                PushImm(param2);
                EmitJmp(opJMP, param1)

            |IL.opLEAVEC:
                Pop(PC)

            |IL.opENTER:
                ASSERT(R.top = -1);
                EmitLabel(param1);
                n := param2 MOD 65536;
                param2 := param2 DIV 65536;
                StkCnt := 0;
                IF chk_stk THEN
                    L := NewLabel();
                    Op2(opMOV, SP * 256, R4);
                    Op2(opSUB, HP * 256, R4);
                    Op2(opCMP, imm(StkReserve), R4);
                    word := CodeList.last(WORD);
                    jcc(jge, L);
                    DEC(StkCnt);
                    EmitWord(0C232H); (*  BIC   #8, SR; DINT  *)
                    EmitWord(4303H);  (*  MOV   R3, R3; NOP   *)
                    PushImm(n);
                    EmitJmp(opJMP, cmd.param3);
                    EmitLabel(L)
                END;

                IF param2 > 8 THEN
                    Op2(opMOV, imm(param2), R4);
                    L := NewLabel();
                    EmitLabel(L);
                    Push(CG);
                    Op2(opSUB, imm(1), R4);
                    jcc(jne, L)
                ELSE
                    FOR n := 1 TO param2 DO
                        Push(CG)
                    END
                END;
                StkCnt := param2;
                MaxStkCnt := StkCnt

            |IL.opLEAVE, IL.opLEAVER:
                ASSERT(param2 = 0);
                IF opcode = IL.opLEAVER THEN
                    UnOp(reg1);
                    IF reg1 # ACC THEN
                        mov(ACC, reg1)
                    END;
                    drop
                END;
                ASSERT(R.top = -1);
                ASSERT(StkCnt = param1);
                IF chk_stk THEN
                    INC(word.val, MaxStkCnt * 2)
                END;
                IF param1 > 0 THEN
                    Op2(opADD, imm(param1 * 2), SP)
                END;
                Pop(PC)

            |IL.opRES:
                ASSERT(R.top = -1);
                GetRegA

            |IL.opCLEANUP:
                IF param2 # 0 THEN
                    Op2(opADD, imm(param2 * 2), SP);
                    DEC(StkCnt, param2)
                END

            |IL.opCONST:
                next := cmd.next(COMMAND);
                IF next.opcode = IL.opCONST THEN
                    c1 := param2;
                    c2 := next.param2;
                    next := next.next(COMMAND);
                    IF (next.opcode = IL.opSAVE) OR (next.opcode = IL.opSAVE16) OR (next.opcode = IL.opSAVE8) THEN
                        Op2(opMOV + bw(next.opcode = IL.opSAVE8), imm(c1), dst_x(c2, SR));
                        cmd := next
                    ELSE
                        Op2(opMOV, imm(param2), GetAnyReg())
                    END
                ELSIF (next.opcode = IL.opSAVE) OR (next.opcode = IL.opSAVE16) OR (next.opcode = IL.opSAVE8) THEN
                    UnOp(reg1);
                    Op2(opMOV + bw(next.opcode = IL.opSAVE8), reg1 * 256, dst_x(param2, SR));
                    drop;
                    cmd := next
                ELSE
                    Op2(opMOV, imm(param2), GetAnyReg())
                END

            |IL.opSADR:
                Op2(opMOV, incr(PC), GetAnyReg());
                EmitWord(param2);
                Reloc(RDATA)

            |IL.opGADR:
                Op2(opMOV, incr(PC), GetAnyReg());
                EmitWord(param2);
                Reloc(RBSS)

            |IL.opLADR:
                reg1 := GetAnyReg();
                n := LocalOffset(param2);
                Op2(opMOV, SP * 256, reg1);
                IF n # 0 THEN
                    Op2(opADD, imm(n), reg1)
                END

            |IL.opLLOAD8:
                Op2(opMOV + BW, LocalSrc(param2), GetAnyReg())

            |IL.opLLOAD16, IL.opVADR:
                Op2(opMOV, LocalSrc(param2), GetAnyReg())

            |IL.opGLOAD8:
                Op2(opMOV + BW, src_x(param2, SR), GetAnyReg());
                Reloc(RBSS)

            |IL.opGLOAD16:
                Op2(opMOV, src_x(param2, SR), GetAnyReg());
                Reloc(RBSS)

            |IL.opLOAD8:
                UnOp(reg1);
                Op2(opMOV + BW, indir(reg1), reg1)

            |IL.opLOAD16:
                UnOp(reg1);
                Op2(opMOV, indir(reg1), reg1)

            |IL.opVLOAD8:
                reg1 := GetAnyReg();
                Op2(opMOV, LocalSrc(param2), reg1);
                Op2(opMOV + BW, indir(reg1), reg1)

            |IL.opVLOAD16:
                reg1 := GetAnyReg();
                Op2(opMOV, LocalSrc(param2), reg1);
                Op2(opMOV, indir(reg1), reg1)

            |IL.opSAVE, IL.opSAVE16:
                BinOp(reg2, reg1);
                Op2(opMOV, reg2 * 256, dst_x(0, reg1));
                drop;
                drop

            |IL.opSAVE8:
                BinOp(reg2, reg1);
                Op2(opMOV + BW, reg2 * 256, dst_x(0, reg1));
                drop;
                drop

            |IL.opSAVE8C:
                UnOp(reg1);
                Op2(opMOV + BW, imm(param2), dst_x(0, reg1));
                drop

            |IL.opSAVE16C, IL.opSAVEC:
                UnOp(reg1);
                Op2(opMOV, imm(param2), dst_x(0, reg1));
                drop

            |IL.opUMINUS:
                UnOp(reg1);
                Neg(reg1)

            |IL.opADD:
                BinOp(reg1, reg2);
                Op2(opADD, reg2 * 256, reg1);
                drop

            |IL.opADDC:
                IF param2 # 0 THEN
                    UnOp(reg1);
                    Op2(opADD, imm(param2), reg1)
                END

            |IL.opSUB:
                BinOp(reg1, reg2);
                Op2(opSUB, reg2 * 256, reg1);
                drop

            |IL.opSUBR, IL.opSUBL:
                UnOp(reg1);
                IF param2 # 0 THEN
                    Op2(opSUB, imm(param2), reg1)
                END;
                IF opcode = IL.opSUBL THEN
                    Neg(reg1)
                END

            |IL.opLADR_SAVEC:
                Op2(opMOV, imm(param2), LocalDst(param1))

            |IL.opLADR_SAVE:
                UnOp(reg1);
                Op2(opMOV, reg1 * 256, LocalDst(param2));
                drop

            |IL.opGADR_SAVEC:
                Op2(opMOV, imm(param2), dst_x(param1, SR));
                Reloc(RBSS)

            |IL.opCONST_PARAM:
                PushImm(param2)

            |IL.opPARAM:
                IF param2 = 1 THEN
                    UnOp(reg1);
                    Push(reg1);
                    drop
                ELSE
                    ASSERT(R.top + 1 <= param2);
                    PushAll(param2)
                END

            |IL.opEQ..IL.opGE,
            IL.opEQC..IL.opGEC:

                IF (IL.opEQ <= opcode) & (opcode <= IL.opGE) THEN
                    BinOp(reg1, reg2);
                    Op2(opCMP, reg2 * 256, reg1);
                    drop
                ELSE
                    UnOp(reg1);
                    Op2(opCMP, imm(param2), reg1)
                END;

                drop;
                cc := cond(opcode);
                next := cmd.next(COMMAND);

                IF next.opcode = IL.opJNZ THEN
                    jcc(cc, next.param1);
                    cmd := next
                ELSIF next.opcode = IL.opJZ THEN
                    jcc(ORD(BITS(cc) / {0}), next.param1);
                    cmd := next
                ELSE
                    setcc(cc, GetAnyReg())
                END

            |IL.opNOP, IL.opAND, IL.opOR:

            |IL.opCODE:
                EmitWord(param2)

            |IL.opDROP:
                UnOp(reg1);
                drop

            |IL.opJNZ1:
                UnOp(reg1);
                Test(reg1);
                jcc(jne, param1)

            |IL.opJG:
                UnOp(reg1);
                Test(reg1);
                jcc(jg, param1)

            |IL.opJNZ:
                UnOp(reg1);
                Test(reg1);
                jcc(jne, param1);
                drop

            |IL.opJZ:
                UnOp(reg1);
                Test(reg1);
                jcc(je, param1);
                drop

            |IL.opNOT:
                UnOp(reg1);
                Test(reg1);
                setcc(je, reg1)

            |IL.opORD:
                UnOp(reg1);
                Test(reg1);
                setcc(jne, reg1)

            |IL.opGET:
                BinOp(reg1, reg2);
                drop;
                drop;
                Op2(opMOV + bw(param2 = 1), indir(reg1), dst_x(0, reg2))

            |IL.opGETC:
                UnOp(reg2);
                drop;
                Op2(opMOV + bw(param2 = 1), src_x(param1, SR), dst_x(0, reg2))

            |IL.opCHKIDX:
                UnOp(reg1);
                Op2(opCMP, imm(param2), reg1);
                jcc(jb, param1)

            |IL.opCHKIDX2:
                BinOp(reg1, reg2);
                IF param2 # -1 THEN
                    Op2(opCMP, reg1 * 256, reg2);
                    jcc(jb, param1)
                END;
                INCL(R.regs, reg1);
                DEC(R.top);
                R.stk[R.top] := reg2

            |IL.opINCC, IL.opINCCB:
                UnOp(reg1);
                Op2(opADD + bw(opcode = IL.opINCCB), imm(param2), dst_x(0, reg1));
                drop

            |IL.opDECCB:
                UnOp(reg1);
                Op2(opSUB + BW, imm(param2), dst_x(0, reg1));
                drop

            |IL.opINC, IL.opINCB:
                BinOp(reg1, reg2);
                Op2(opADD + bw(opcode = IL.opINCB), reg1 * 256, dst_x(0, reg2));
                drop;
                drop

            |IL.opDEC, IL.opDECB:
                BinOp(reg1, reg2);
                Op2(opSUB + bw(opcode = IL.opDECB), reg1 * 256, dst_x(0, reg2));
                drop;
                drop

            |IL.opLADR_INCC, IL.opLADR_INCCB:
                Op2(opADD + bw(opcode = IL.opLADR_INCCB), imm(param2), LocalDst(param1))

            |IL.opLADR_DECCB:
                Op2(opSUB + BW, imm(param2), LocalDst(param1))

            |IL.opLADR_INC, IL.opLADR_INCB:
                UnOp(reg1);
                Op2(opADD + bw(opcode = IL.opLADR_INCB), reg1 * 256, LocalDst(param2));
                drop

            |IL.opLADR_DEC, IL.opLADR_DECB:
                UnOp(reg1);
                Op2(opSUB + bw(opcode = IL.opLADR_DECB), reg1 * 256, LocalDst(param2));
                drop

            |IL.opPUSHT:
                UnOp(reg1);
                Op2(opMOV, src_x(-2, reg1), GetAnyReg())

            |IL.opISREC:
                PushAll(2);
                PushImm(param2);
                CallRTL(RTL._guardrec, 3);
                GetRegA

            |IL.opIS:
                PushAll(1);
                PushImm(param2);
                CallRTL(RTL._is, 2);
                GetRegA

            |IL.opTYPEGR:
                PushAll(1);
                PushImm(param2);
                CallRTL(RTL._guardrec, 2);
                GetRegA

            |IL.opTYPEGP:
                UnOp(reg1);
                PushAll(0);
                Push(reg1);
                PushImm(param2);
                CallRTL(RTL._guard, 2);
                GetRegA

            |IL.opTYPEGD:
                UnOp(reg1);
                PushAll(0);
                Op1(opPUSH, reg1, sIDX);
                IncStk;
                EmitWord(-2);
                PushImm(param2);
                CallRTL(RTL._guardrec, 2);
                GetRegA

            |IL.opMULS:
                BinOp(reg1, reg2);
                Op2(opAND, reg2 * 256, reg1);
                drop

            |IL.opMULSC:
                UnOp(reg1);
                Op2(opAND, imm(param2), reg1)

            |IL.opDIVS:
                BinOp(reg1, reg2);
                Op2(opXOR, reg2 * 256, reg1);
                drop

            |IL.opDIVSC:
                UnOp(reg1);
                Op2(opXOR, imm(param2), reg1)

            |IL.opADDS:
                BinOp(reg1, reg2);
                Op2(opBIS, reg2 * 256, reg1);
                drop

            |IL.opSUBS:
                BinOp(reg1, reg2);
                Op2(opBIC, reg2 * 256, reg1);
                drop

            |IL.opADDSC:
                UnOp(reg1);
                Op2(opBIS, imm(param2), reg1)

            |IL.opSUBSL:
                UnOp(reg1);
                Op2(opXOR, imm(-1), reg1);
                Op2(opAND, imm(param2), reg1)

            |IL.opSUBSR:
                UnOp(reg1);
                Op2(opBIC, imm(param2), reg1)

            |IL.opUMINS:
                UnOp(reg1);
                Op2(opXOR, imm(-1), reg1)

            |IL.opLENGTH:
                PushAll(2);
                CallRTL(RTL._length, 2);
                GetRegA

            |IL.opMAX,IL.opMIN:
                BinOp(reg1, reg2);
                Op2(opCMP, reg2 * 256, reg1);
                IF opcode = IL.opMIN THEN
                    cc := opJL + 1
                ELSE
                    cc := opJGE + 1
                END;
                EmitWord(cc);        (* jge/jl L *)
                MovRR(reg2, reg1);
                                    (* L: *)
                drop

            |IL.opMAXC, IL.opMINC:
                UnOp(reg1);
                Op2(opCMP, imm(param2), reg1);
                L := NewLabel();
                IF opcode = IL.opMINC THEN
                    cc := jl
                ELSE
                    cc := jge
                END;
                jcc(cc, L);
                Op2(opMOV, imm(param2), reg1);
                EmitLabel(L)

            |IL.opSWITCH:
                UnOp(reg1);
                IF param2 = 0 THEN
                    reg2 := ACC
                ELSE
                    reg2 := R5
                END;
                IF reg1 # reg2 THEN
                    ASSERT(REG.GetReg(R, reg2));
                    ASSERT(REG.Exchange(R, reg1, reg2));
                    drop
                END;
                drop

            |IL.opENDSW:

            |IL.opCASEL:
                Op2(opCMP, imm(param1), ACC);
                jcc(jl, param2)

            |IL.opCASER:
                Op2(opCMP, imm(param1), ACC);
                jcc(jg, param2)

            |IL.opCASELR:
                Op2(opCMP, imm(param1), ACC);
                IF param2 = cmd.param3 THEN
                    jcc(jne, param2)
                ELSE
                    jcc(jl, param2);
                    jcc(jg, cmd.param3)
                END

            |IL.opSBOOL:
                BinOp(reg2, reg1);
                Test(reg2);
                setcc(jne, reg2);
                Op2(opMOV + BW, reg2 * 256, dst_x(0, reg1));
                drop;
                drop

            |IL.opSBOOLC:
                UnOp(reg1);
                Op2(opMOV + BW, imm(param2), dst_x(0, reg1));
                drop

            |IL.opEQS .. IL.opGES:
                PushAll(4);
                PushImm((opcode - IL.opEQS) * 12);
                CallRTL(RTL._strcmp, 5);
                GetRegA

            |IL.opLEN:
                UnOp(reg1);
                drop;
                EXCL(R.regs, reg1);

                WHILE param2 > 0 DO
                    UnOp(reg2);
                    drop;
                    DEC(param2)
                END;

                INCL(R.regs, reg1);
                ASSERT(REG.GetReg(R, reg1))

            |IL.opLSL, IL.opASR, IL.opROR, IL.opLSR:
                PushAll(2);
                CASE opcode OF
                |IL.opLSL: CallRTL(RTL._lsl, 2)
                |IL.opASR: CallRTL(RTL._asr, 2)
                |IL.opROR: CallRTL(RTL._ror, 2)
                |IL.opLSR: CallRTL(RTL._lsr, 2)
                END;
                GetRegA

            |IL.opLSL1, IL.opASR1, IL.opROR1, IL.opLSR1:
                UnOp(reg1);
                PushAll_1;
                PushImm(param2);
                Push(reg1);
                drop;
                CASE opcode OF
                |IL.opLSL1: CallRTL(RTL._lsl, 2)
                |IL.opASR1: CallRTL(RTL._asr, 2)
                |IL.opROR1: CallRTL(RTL._ror, 2)
                |IL.opLSR1: CallRTL(RTL._lsr, 2)
                END;
                GetRegA

            |IL.opASR2, IL.opROR2, IL.opLSL2, IL.opLSR2:
                param2 := param2 MOD 16;
                IF param2 # 0 THEN
                    UnOp(reg1);
                    Shift2(opcode, reg1, param2)
                END

            |IL.opMUL:
                PushAll(2);
                CallRTL(RTL._mul, 2);
                GetRegA

            |IL.opMULC:
                UnOp(reg1);

                a := param2;
                IF a > 1 THEN
                    n := UTILS.Log2(a)
                ELSIF a < -1 THEN
                    n := UTILS.Log2(-a)
                ELSE
                    n := -1
                END;

                IF a = 1 THEN

                ELSIF a = -1 THEN
                    Neg(reg1)
                ELSIF a = 0 THEN
                    Clear(reg1)
                ELSE
                    IF n > 0 THEN
                        IF a < 0 THEN
                            Neg(reg1)
                        END;
                        Shift2(IL.opLSL2, reg1, n)
                    ELSE
                        PushAll(1);
                        PushImm(a);
                        CallRTL(RTL._mul, 2);
                        GetRegA
                    END
                END

            |IL.opDIV:
                PushAll(2);
                CallRTL(RTL._divmod, 2);
                GetRegA

            |IL.opDIVR:
                ASSERT(param2 > 0);

                IF param2 > 1 THEN
                    n := UTILS.Log2(param2);
                    IF n > 0 THEN
                        UnOp(reg1);
                        Shift2(IL.opASR2, reg1, n)
                    ELSE
                        PushAll(1);
                        PushImm(param2);
                        CallRTL(RTL._divmod, 2);
                        GetRegA
                    END
                END

            |IL.opDIVL:
                UnOp(reg1);
                PushAll_1;
                PushImm(param2);
                Push(reg1);
                drop;
                CallRTL(RTL._divmod, 2);
                GetRegA

            |IL.opMOD:
                PushAll(2);
                CallRTL(RTL._divmod, 2);
                ASSERT(REG.GetReg(R, R5))

            |IL.opMODR:
                ASSERT(param2 > 0);

                IF param2 = 1 THEN
                    UnOp(reg1);
                    Clear(reg1)
                ELSE
                    IF UTILS.Log2(param2) > 0 THEN
                        UnOp(reg1);
                        Op2(opAND, imm(param2 - 1), reg1)
                    ELSE
                        PushAll(1);
                        PushImm(param2);
                        CallRTL(RTL._divmod, 2);
                        ASSERT(REG.GetReg(R, R5))
                    END
                END

            |IL.opMODL:
                UnOp(reg1);
                PushAll_1;
                PushImm(param2);
                Push(reg1);
                drop;
                CallRTL(RTL._divmod, 2);
                ASSERT(REG.GetReg(R, R5))

            |IL.opCOPYS:
                ASSERT(R.top = 3);
                Push(R.stk[2]);
                Push(R.stk[0]);
                Op2(opCMP, R.stk[1] * 256, R.stk[3]);
                EmitWord(3801H); (* JL L1 *)
                MovRR(R.stk[1], R.stk[3]);
                                (* L1:   *)
                Push(R.stk[3]);
                drop;
                drop;
                drop;
                drop;
                CallRTL(RTL._move, 3)

            |IL.opCOPY:
                PushAll(2);
                PushImm(param2);
                CallRTL(RTL._move, 3)

            |IL.opMOVE:
                PushAll(3);
                CallRTL(RTL._move, 3)

            |IL.opCOPYA:
                PushAll(4);
                PushImm(param2);
                CallRTL(RTL._arrcpy, 5);
                GetRegA

            |IL.opROT:
                PushAll(0);
                MovRR(SP, ACC);
                Push(ACC);
                PushImm(param2);
                CallRTL(RTL._rot, 2)

            |IL.opSAVES:
                UnOp(reg1);
                PushAll_1;
                Op1(opPUSH, PC, sINCR);
                IncStk;
                EmitWord(param2);
                Reloc(RDATA);
                Push(reg1);
                drop;
                PushImm(param1);
                CallRTL(RTL._move, 3)

            |IL.opCASET:
                Push(R5);
                Push(R5);
                PushImm(param2);
                CallRTL(RTL._guardrec, 2);
                Pop(R5);
                Test(ACC);
                jcc(jne, param1)

            |IL.opABS:
                UnOp(reg1);
                Test(reg1);
                L := NewLabel();
                jcc(jge, L);
                Neg(reg1);
                EmitLabel(L)

            |IL.opEQB, IL.opNEB:
                BinOp(reg1, reg2);
                drop;

                Test(reg1);
                L := NewLabel();
                jcc(je, L);
                Op2(opMOV, imm(1), reg1);
                EmitLabel(L);

                Test(reg2);
                L := NewLabel();
                jcc(je, L);
                Op2(opMOV, imm(1), reg2);
                EmitLabel(L);

                Op2(opCMP, reg2 * 256, reg1);
                IF opcode = IL.opEQB THEN
                    setcc(je, reg1)
                ELSE
                    setcc(jne, reg1)
                END

            |IL.opSAVEP:
                UnOp(reg1);
                Op2(opMOV, incr(PC), reg1 + dIDX);
                EmitWord(param2);
                Reloc(RCODE);
                EmitWord(0);
                drop

            |IL.opPUSHP:
                Op2(opMOV, incr(PC), GetAnyReg());
                EmitWord(param2);
                Reloc(RCODE)

            |IL.opEQP, IL.opNEP:
                UnOp(reg1);
                Op2(opCMP, incr(PC), reg1);
                EmitWord(param1);
                Reloc(RCODE);
                drop;
                reg1 := GetAnyReg();

                IF opcode = IL.opEQP THEN
                    setcc(je, reg1)
                ELSIF opcode = IL.opNEP THEN
                    setcc(jne, reg1)
                END

            |IL.opVADR_PARAM:
                reg1 := GetAnyReg();
                Op2(opMOV, LocalSrc(param2), reg1);
                Push(reg1);
                drop

            |IL.opNEW:
                PushAll(1);
                n := param2 + 2;
                ASSERT(UTILS.Align(n, 2));
                PushImm(n);
                PushImm(param1);
                CallRTL(RTL._new, 3)

            |IL.opRSET:
                PushAll(2);
                CallRTL(RTL._set, 2);
                GetRegA

            |IL.opRSETR:
                PushAll(1);
                PushImm(param2);
                CallRTL(RTL._set, 2);
                GetRegA

            |IL.opRSETL:
                UnOp(reg1);
                PushAll_1;
                PushImm(param2);
                Push(reg1);
                drop;
                CallRTL(RTL._set, 2);
                GetRegA

            |IL.opRSET1:
                PushAll(1);
                CallRTL(RTL._set1, 1);
                GetRegA

            |IL.opINCLC:
                UnOp(reg1);
                Op2(opBIS, imm(ORD({param2})), dst_x(0, reg1));
                drop

            |IL.opEXCLC:
                UnOp(reg1);
                Op2(opBIC, imm(ORD({param2})), dst_x(0, reg1));
                drop

            |IL.opIN:
                PushAll(2);
                CallRTL(RTL._in, 2);
                GetRegA

            |IL.opINR:
                PushAll(1);
                PushImm(param2);
                CallRTL(RTL._in, 2);
                GetRegA

            |IL.opINL:
                PushAll(1);
                PushImm(param2);
                CallRTL(RTL._in2, 2);
                GetRegA

            |IL.opINCL:
                PushAll(2);
                CallRTL(RTL._incl, 2)

            |IL.opEXCL:
                PushAll(2);
                CallRTL(RTL._excl, 2)

            |IL.opLADR_INCL, IL.opLADR_EXCL:
                PushAll(1);
                MovRR(SP, ACC);
                n := LocalOffset(param2);
                IF n # 0 THEN
                    Op2(opADD, imm(n), ACC)
                END;
                Push(ACC);
                IF opcode = IL.opLADR_INCL THEN
                    CallRTL(RTL._incl, 2)
                ELSIF opcode = IL.opLADR_EXCL THEN
                    CallRTL(RTL._excl, 2)
                END

            |IL.opLADR_INCLC:
                Op2(opBIS, imm(ORD({param2})), LocalDst(param1))

            |IL.opLADR_EXCLC:
                Op2(opBIC, imm(ORD({param2})), LocalDst(param1))

            END;

            cmd := cmd.next(COMMAND)
        END;

        ASSERT(R.pushed = 0);
        ASSERT(R.top = -1)
    END translate;


PROCEDURE prolog;
    VAR
        i: INTEGER;

    BEGIN
        RTL.Init(EmitLabel, EmitWord, EmitCall);
        FOR i := 0 TO LEN(RTL.rtl) - 1 DO
            RTL.Set(i, NewLabel())
        END;

        IV[LEN(IV) - 1] := NewLabel();
        EmitLabel(IV[LEN(IV) - 1]);
        Op2(opMOV, incr(PC), SP);
        EmitWord(0);
        Op2(opMOV, incr(PC), HP);
        EmitWord(0);
        Op2(opMOV, imm(5A80H), dst_x(0120H, SR)); (* stop WDT *)
        Op2(opMOV, imm(RTL.empty_proc), dst_x(0, SP));
        Op2(opMOV, imm(RTL.empty_proc), dst_x(2, SP));
    END prolog;


PROCEDURE epilog;
    VAR
        L1, i, n: INTEGER;

    BEGIN
        Op2(opBIS, imm(10H), SR); (* CPUOFF *)

        L1 := NewLabel();
        FOR i := 0 TO LEN(IV) - 2 DO
            IV[i] := NewLabel();
            EmitLabel(IV[i]);
            PushImm(i);
            IF i # LEN(IV) - 2 THEN
                EmitJmp(opJMP, L1)
            END
        END;

        EmitLabel(L1);

        n := 0;
        FOR i := 0 TO 15 DO
            IF i IN R.regs THEN
                Push(i);
                INC(n)
            END
        END;

        MovRR(SP, R4);
        Op2(opADD, imm(n * 2), R4);

        Push(R4);
        Op1(opPUSH, R4, sINDIR);
        Op1(opCALL, SR, sIDX); EmitWord(-RTL.VarSize); Reloc(RBSS); (* call int *)
        Op2(opADD, imm(4), SP);

        FOR i := 15 TO 0 BY -1 DO
            IF i IN R.regs THEN
                Pop(i)
            END
        END;

        Op2(opADD, imm(2), SP);
        Op1(opRETI, 0, 0);

        RTL.Gen
    END epilog;


PROCEDURE CodeGen* (outname: ARRAY OF CHAR; target: INTEGER; options: PROG.OPTIONS);
    VAR
        i, adr, heap, stack, TextSize, TypesSize, bits, n, val: INTEGER;

        Code, Data, Bss: RECORD address, size: INTEGER END;

        ram, rom: INTEGER;

        reloc: RELOC;

    BEGIN
        IdxWords.src := NOWORD;
        IdxWords.dst := NOWORD;

        ram := options.ram;
        rom := options.rom;

        IF ODD(ram) THEN DEC(ram) END;
        IF ODD(rom) THEN DEC(rom) END;

        ram := MIN(MAX(ram, minRAM), maxRAM);
        rom := MIN(MAX(rom, minROM), maxROM);

        IF IL.codes.bss > ram - StkReserve - RTL.VarSize THEN
            ERRORS.Error(204)
        END;

        Labels := CHL.CreateIntList();
        FOR i := 1 TO IL.codes.lcount DO
            CHL.PushInt(Labels, 0)
        END;

        CodeList := LISTS.create(NIL);
        RelList  := LISTS.create(NIL);
        REG.Init(R, Push, Pop, mov, xchg, {R4, R5, R6, R7});

        prolog;
        translate(chkSTK IN options.checking);
        epilog;

        TypesSize := CHL.Length(IL.codes.types) * 2;
        Data.size := CHL.Length(IL.codes.data);
        IF ODD(Data.size) THEN
            CHL.PushByte(IL.codes.data, 0);
            INC(Data.size)
        END;
        Code.size := Fixup(0, IntVectorSize + TypesSize + Data.size);
        Code.address := 10000H - (IntVectorSize + TypesSize + Data.size + Code.size);
        IF Code.address < 10000H - rom THEN
            ERRORS.Error(203)
        END;
        Code.size := Fixup(Code.address, IntVectorSize + TypesSize + Data.size);
        Data.address := Code.address + Code.size;
        TextSize := Code.size + Data.size;

        IF Code.address + TextSize + MAX(IL.codes.dmin - Data.size, IntVectorSize + TypesSize) > 10000H THEN
            ERRORS.Error(203)
        END;

        stack := RTL.ram + ram;
        Bss.size := IL.codes.bss + IL.codes.bss MOD 2;
        DEC(stack, Bss.size);
        Bss.address := stack;
        DEC(stack, RTL.VarSize);
        heap := RTL.ram;
        ASSERT(stack - heap >= StkReserve);
        adr := Code.address + 2;
        PutWord(stack, adr);
        adr := Code.address + 6;
        PutWord(heap, adr);

        reloc := RelList.first(RELOC);
        WHILE reloc # NIL DO
            adr := reloc.WordPtr.offset * 2;
            val := reloc.WordPtr.val;
            CASE reloc.section OF
            |RCODE: PutWord(LabelOffs(val) * 2, adr)
            |RDATA: PutWord(val + Data.address, adr)
            |RBSS:  PutWord((val + Bss.address) MOD 65536, adr)
            END;
            reloc := reloc.next(RELOC)
        END;

        adr := Data.address;

        FOR i := 0 TO Data.size - 1 DO
            mem[adr] := CHL.GetByte(IL.codes.data, i);
            INC(adr)
        END;

        FOR i := TypesSize DIV 2 - 1 TO 0 BY -1 DO
            PutWord(CHL.GetInt(IL.codes.types, i), adr)
        END;

        FOR i := 0 TO 15 DO
            PutWord((33 - i) * i, adr);
        END;

        FOR n := 0 TO 15 DO
            bits := ORD({0 .. n});
            FOR i := 0 TO 15 - n DO
                PutWord(bits, adr);
                bits := LSL(bits, 1)
            END
        END;

        PutWord(4130H, adr); (* RET *)
        PutWord(stack, adr);
        PutWord(0001H, adr); (* bsl signature (adr 0FFBEH) *)

        FOR i := 0 TO LEN(IV) - 1 DO
            PutWord(LabelOffs(IV[i]) * 2, adr)
        END;

        INC(TextSize, IntVectorSize + TypesSize + Code.address MOD 16);
        INC(Bss.size, StkReserve + RTL.VarSize);

        WR.Create(outname);
        HEX.Data(mem, Code.address - Code.address MOD 16, TextSize);
        HEX.End;
        WR.Close;

        C.Dashes;
        C.String("  rom:  "); C.Int(TextSize); C.String(" of "); C.Int(rom); C.String("  ("); C.Int(TextSize * 100 DIV rom); C.StringLn("%)");
        C.Ln;
        C.String("  ram:  "); C.Int(Bss.size); C.String(" of "); C.Int(ram); C.String("  ("); C.Int(Bss.size * 100 DIV ram); C.StringLn("%)")
    END CodeGen;


END MSP430.