.FILE E:\DROPBOX_SWAP\PROJAVR\ADA-C ACV\ACV.pas ; Compiled by E-LAB AVRco PASCAL Compiler Rev 5.04.13 ; Version : Profi ; ; Licenced to : Redaktion CT P1 ; ; (c)E-LAB Computers, Grombacherstr. 27 e-mail info@e-lab.de ; D-74906 Bad Rappenau Tel. 07268/9124-0 Fax. 07268/9124-24 ; ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ ; Source File : ACV.pas ; Compiled : 12. August 2015 01:18:17 ; ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ .MEDIUM .ROMEND 03FFFh; .EEPROMEND 001FFh; ; ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ ; Constants and Variables definition ; ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ ; === Internal used memory and constants === FALSE .EQU 000h ; const TRUE .EQU 0FFh ; const NIL .EQU 000h ; const PI .EQU 000h ; const COMPILERREV .EQU 1F8h ; const COMPILERBUILD_Y .EQU 00Ch ; const COMPILERBUILD_M .EQU 00Bh ; const COMPILERBUILD_D .EQU 004h ; const COMPILEYEAR .EQU 00Fh ; const COMPILEMONTH .EQU 008h ; const COMPILEDAY .EQU 00Ch ; const COMPILEHOUR .EQU 001h ; const COMPILEMINUTE .EQU 012h ; const PROJECTBUILD .EQU 04Bh ; const OPTIMISERREV .EQU 000h ; const OPTIMISERBUILD .EQU 000h ; const INTFLAG .EQU 007h ; const _EEPROM .EQU 006h ; const _SIGN .EQU 005h ; const _WAITLCD .EQU 004h ; const _STRCONST .EQU 004h ; const _DEVICE .EQU 003h ; const _NEGATIVE .EQU 002h ; const _ERRFLAG .EQU 001h ; const _I2C2BYTE .EQU 000h ; const _TOGGLE300 .EQU 000h ; const _LCDLOWER .EQU 001h ; const _DSP7RFR .EQU 002h ; const _PWRSAVFLG .EQU 003h ; const _F64StrInt .EQU 004h ; const _F64StrFrac .EQU 005h ; const _FREQCNTFLAG .EQU 006h ; const _AUTOACK .EQU 007h ; const _ACCGLO .EQU 000h ; var Data byte _ACCGHI .EQU 001h ; var Data byte _ACCB .EQU 010h ; var Data byte _ACCA .EQU 011h ; var Data byte _ACCALO .EQU 012h ; var Data byte _ACCAHI .EQU 013h ; var Data byte _ACCDLO .EQU 014h ; var Data byte _ACCDHI .EQU 015h ; var Data byte _ACCELO .EQU 016h ; var Data byte _ACCEHI .EQU 017h ; var Data byte _ACCFLO .EQU 018h ; var Data byte _ACCFHI .EQU 019h ; var Data byte _ACCBLO .EQU 01Ah ; var Data byte _ACCBHI .EQU 01Bh ; var Data byte _FRAMEPTR .EQU 01Ch ; var Data byte _FPTRHI .EQU 01Dh ; var Data byte _ACCCLO .EQU 01Eh ; var Data byte _ACCCHI .EQU 01Fh ; var Data byte $_SAVERET .EQU 002h ; var Data byte $_SAVERET1 .EQU 003h ; var Data byte FLAGS .EQU 004h ; var Data byte FLAGS2 .EQU 005h ; var Data byte _SYSTFLAGS .EQU 006h ; var Data byte SYSTICK .EQU 00Ah ; const PROCCLOCK .EQU 0F42400h ; const DECIMALSEP .EQU 02Eh ; const CPU_ID .EQU 1E9406h ; const Flash_Page_Size .EQU 080h ; const ROMconstPage .EQU 0FFFFFFFFFFFFFFFFh ; const STACKSIZE .EQU 080h ; const FRAMESIZE .EQU 080h ; const UDR1 .EQU 0C6h ; var iData byte UBRR1H .EQU 0C5h ; var iData byte UBRRH .EQU 0C5h ; var iData byte UBRR1 .EQU 0C4h ; var iData byte UBRRL .EQU 0C4h ; var iData byte UCSRC .EQU 0C2h ; var iData byte UCSR0C .EQU 0C2h ; var iData byte UCR1 .EQU 0C1h ; var iData byte UCSRB .EQU 0C1h ; var iData byte UCSR0B .EQU 0C1h ; var iData byte USR1 .EQU 0C0h ; var iData byte UCSRA .EQU 0C0h ; var iData byte UCSR0A .EQU 0C0h ; var iData byte TWAMR .EQU 0BDh ; var iData byte TWCR .EQU 0BCh ; var iData byte TWDR .EQU 0BBh ; var iData byte TWAR .EQU 0BAh ; var iData byte TWSR .EQU 0B9h ; var iData byte TWBR .EQU 0B8h ; var iData byte ASSR .EQU 0B6h ; var iData byte OCR2B .EQU 0B4h ; var iData byte OCR2A .EQU 0B3h ; var iData byte OCR2 .EQU 0B3h ; var iData byte TCNT2 .EQU 0B2h ; var iData byte TCCR2B .EQU 0B1h ; var iData byte TCCR2A .EQU 0B0h ; var iData byte TCCR2 .EQU 0B1h ; var iData byte OCR1BH .EQU 08Bh ; var iData byte OCR1BL .EQU 08Ah ; var iData byte OCR1AH .EQU 089h ; var iData byte OCR1AL .EQU 088h ; var iData byte ICR1H .EQU 087h ; var iData byte ICR1L .EQU 086h ; var iData byte TCNT1H .EQU 085h ; var iData byte TCNT1L .EQU 084h ; var iData byte TCCR1C .EQU 082h ; var iData byte TCCR1B .EQU 081h ; var iData byte TCCR1A .EQU 080h ; var iData byte DIDR1 .EQU 07Fh ; var iData byte DIDR0 .EQU 07Eh ; var iData byte ADMUX .EQU 07Ch ; var iData byte ADCSR .EQU 07Ah ; var iData byte ADCSRB .EQU 07Bh ; var iData byte ADCSRA .EQU 07Ah ; var iData byte ADCH .EQU 079h ; var iData byte ADCL .EQU 078h ; var iData byte TIMSK2 .EQU 070h ; var iData byte TIMSK1 .EQU 06Fh ; var iData byte TIMSK0 .EQU 06Eh ; var iData byte PCMSK2 .EQU 06Dh ; var iData byte PCMSK1 .EQU 06Ch ; var iData byte PCMSK0 .EQU 06Bh ; var iData byte EICRA .EQU 069h ; var iData byte PCICR .EQU 068h ; var iData byte OSCCAL .EQU 066h ; var iData byte PRR .EQU 064h ; var iData byte CLKPR .EQU 061h ; var iData byte WDTCR .EQU 060h ; var iData byte SREG .EQU 05Fh ; var pData byte SPH .EQU 05Eh ; var pData byte SPL .EQU 05Dh ; var pData byte SPMCR .EQU 057h ; var pData byte SPMCSR .EQU 057h ; var pData byte MCUCR .EQU 055h ; var pData byte MCUCSR .EQU 054h ; var pData byte MCUSR .EQU 054h ; var pData byte SMCR .EQU 053h ; var pData byte MONDR .EQU 051h ; var pData byte ACSR .EQU 050h ; var pData byte SPDR .EQU 04Eh ; var pData byte SPSR .EQU 04Dh ; var pData byte SPCR .EQU 04Ch ; var pData byte GPIOR2 .EQU 04Bh ; var pData byte GPIOR1 .EQU 04Ah ; var pData byte OCR0B .EQU 048h ; var pData byte OCR0A .EQU 047h ; var pData byte TCNT0 .EQU 046h ; var pData byte TCCR0B .EQU 045h ; var pData byte TCCR0A .EQU 044h ; var pData byte TCCR0 .EQU 045h ; var pData byte GTCCR .EQU 043h ; var pData byte EEARH .EQU 042h ; var pData byte EEARL .EQU 041h ; var pData byte EEDR .EQU 040h ; var pData byte EECR .EQU 03Fh ; var pData byte GPIOR0 .EQU 03Eh ; var pData byte GIMSK .EQU 03Dh ; var pData byte EIMSK .EQU 03Dh ; var pData byte GIFR .EQU 03Ch ; var pData byte EIFR .EQU 03Ch ; var pData byte PCIFR .EQU 03Bh ; var pData byte TIFR2 .EQU 037h ; var pData byte TIFR1 .EQU 036h ; var pData byte TIFR0 .EQU 035h ; var pData byte PORTD .EQU 02Bh ; var pData byte DDRD .EQU 02Ah ; var pData byte PIND .EQU 029h ; var pData byte PORTC .EQU 028h ; var pData byte DDRC .EQU 027h ; var pData byte PINC .EQU 026h ; var pData byte PORTB .EQU 025h ; var pData byte DDRB .EQU 024h ; var pData byte PINB .EQU 023h ; var pData byte OCR1B .EQU 08Ah ; var iData word OCR1A .EQU 088h ; var iData word ICR1 .EQU 086h ; var iData word TCNT1 .EQU 084h ; var iData word ADC .EQU 078h ; var iData word EEAR .EQU 041h ; var pData word _iDataStart .EQU 100h ; const _iDataEnd .EQU 4FFh ; const _EEpromStart .EQU 000h ; const _EEpromEnd .EQU 1FFh ; const _FlashStart .EQU 000h ; const _FlashEnd .EQU 3FFFh ; const LCD_m1 .EQU 000h ; const LCD_m2 .EQU 001h ; const LCD_m3 .EQU 002h ; const LCD_m4 .EQU 003h ; const LCD_m5 .EQU 004h ; const LCD_m6 .EQU 005h ; const LCD_m7 .EQU 006h ; const LCD_m8 .EQU 007h ; const _LCDM_PORT .EQU 100h ; var iData byte TWI_BR100 .EQU 048h ; const TWI_BR400 .EQU 00Ch ; const TWI_BR500 .EQU 008h ; const TWI_BR600 .EQU 005h ; const TWI_BR800 .EQU 002h ; const SysTickTime .EQU 101h ; var iData byte _INCRSTATE4 .EQU 102h ; var iData byte _INCRCOUNT4_0 .EQU 103h ; var iData integer _INCRCOUNT4_D0 .EQU 105h ; var iData integer _TWI_TO .EQU 107h ; var iData byte TWI_DevLock .EQU 108h ; var iData DeviceLock EEPROM .EQU 000h ; var EEprom array EEPROMEND .EQU 1FFh ; const .RESET 000000h .ORG 000000h, CODE_START .STARTCODE 000068h .UNIT PanelTest .XDATASTART -1 ; ============ user definitions module: PanelTest ============ PanelTest.DDRDinit .EQU 00Ch ; const byte 12 PanelTest.PortDinit .EQU 0FCh ; const byte 252 PanelTest.DDRCinit .EQU 0FFh ; const byte 255 PanelTest.PortCinit .EQU 0FFh ; const byte 255 PanelTest.low .EQU 000h ; const boolean false PanelTest.high .EQU 0FFh ; const boolean true .SYM i, 00007h, 00004h, 3 PanelTest.i .EQU 007h ; var Data integer .SYM b, 00009h, 0000Dh, 3 PanelTest.b .EQU 009h ; var Data byte .SYM k, 0000Ah, 0000Dh, 3 PanelTest.k .EQU 00Ah ; var Data byte .SYM t, 0000Bh, 00003h, 3 PanelTest.t .EQU 00Bh ; var Data boolean .SYM IO8_LEDs, 003A1h, 00000h, 3 PanelTest.IO8_LEDs .EQU 3A1h ; var iData byte .SYM IO8_LEDsDDR, 003A3h, 00000h, 3 PanelTest.IO8_LEDsDDR .EQU 3A3h ; var iData byte .SYM ButtonTemp, 00109h, 0000Dh, 3 PanelTest.ButtonTemp .EQU 109h ; var iData byte .SYM IncrValue, 0010Ah, 00004h, 3 PanelTest.IncrValue .EQU 10Ah ; var iData integer .SYM OldIncrValue, 0010Ch, 00004h, 3 PanelTest.OldIncrValue .EQU 10Ch ; var iData integer .SYM IncrDiffByte, 0010Eh, 0000Dh, 3 PanelTest.IncrDiffByte .EQU 10Eh ; var iData byte PanelTest.FlashTimer .EQU 10Fh ; var iData word .SYM FlashTimer, 0010Fh, 0000Eh, 3 PanelTest.ActivityTimer .EQU 111h ; var iData word .SYM ActivityTimer, 00111h, 0000Eh, 3 .FUNC initall, 00052h, 00020h PanelTest.initall: .RETURNS 0 .BLOCK 84 .LINE 85 LDI _ACCA, 0FFh OUT DDRC, _ACCA .LINE 86 LDI _ACCA, 0FFh OUT PORTC, _ACCA .LINE 87 LDI _ACCA, 00Ch OUT DDRD, _ACCA .LINE 88 LDI _ACCA, 0FCh OUT PORTD, _ACCA .LINE 89 LDI _ACCA, 0FFh COM _ACCA LDI _ACCDLO, 03Ah LDI _ACCAHI, 003h CALL SYSTEM.I2CEXPOUT .LINE 91 LDI _ACCA, 1 SHLB IntFlag OR Flags, _ACCA SEI .LINE 92 LDI _ACCA, 000h .FRAME 0 CALL SYSTEM.LCDSETUP_M TST _ACCA .BRANCH 4,PanelTest._L0002 BRNE PanelTest._L0002 .BRANCH 20,PanelTest._L0000 JMP PanelTest._L0000 PanelTest._L0002: .BLOCK 92 .LINE 93 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 000h ST -Y, _ACCA .FRAME 1 LDI _ACCA, 000h ST -Y, _ACCA .FRAME 2 LDI _ACCA, 000h ST -Y, _ACCA .FRAME 3 .FRAME 0 CALL SYSTEM.LCDCURSOR_M POP _FPTRHI POP _FRAMEPTR .LINE 94 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 1 SHLB _DEVICE OR Flags, _ACCA LDI _ACCB, SYSTEM.lcdout_m SHRB 1 LDI _ACCA, SYSTEM.lcdout_m SHRB 9 ST -Y, _ACCA ST -Y, _ACCB .FRAME 2 LDI _ACCCLO, $St_String1 AND 0FFh LDI _ACCCHI, $St_String1 SHRB 8 CALL SYSTEM.StrConst2Str PanelTest._L0003: POP _FPTRHI POP _FRAMEPTR .FRAME 0 .LINE 95 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 000h ST -Y, _ACCA .FRAME 1 LDI _ACCA, 000h ST -Y, _ACCA .FRAME 2 LDI _ACCA, 001h ST -Y, _ACCA .FRAME 3 .FRAME 0 CALL SYSTEM.LCDXY_M POP _FPTRHI POP _FRAMEPTR .LINE 96 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 1 SHLB _DEVICE OR Flags, _ACCA LDI _ACCB, SYSTEM.lcdout_m SHRB 1 LDI _ACCA, SYSTEM.lcdout_m SHRB 9 ST -Y, _ACCA ST -Y, _ACCB .FRAME 2 LDI _ACCCLO, $St_String2 AND 0FFh LDI _ACCCHI, $St_String2 SHRB 8 CALL SYSTEM.StrConst2Str PanelTest._L0004: POP _FPTRHI POP _FRAMEPTR .FRAME 0 .ENDBLOCK 97 PanelTest._L0000: PanelTest._L0001: .LINE 98 LDI _ACCA, 000h LDI _ACCDLO, 03Ah LDI _ACCAHI, 001h CALL SYSTEM.I2CEXPOUT .LINE 99 LDI _ACCCLO, PanelTest.FlashTimer AND 0FFh LDI _ACCCHI, PanelTest.FlashTimer SHRB 8 LDI _ACCB, 0FEh CALL SYSTEM.SetSysTimZ .LINE 100 LDI _ACCCLO, PanelTest.ActivityTimer AND 0FFh LDI _ACCCHI, PanelTest.ActivityTimer SHRB 8 LDI _ACCB, 0FDh CALL SYSTEM.SetSysTimZ .LINE 101 CALL SYSTEM.INCRCOUNT4START .LINE 102 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 000h ST -Y, _ACCA .FRAME 1 LDI _ACCA, 00000h SHRB 8 LDI _ACCB, 00000h AND 0FFh ST -Y, _ACCA ST -Y, _ACCB .FRAME 3 .FRAME 0 CALL SYSTEM.SETINCRVAL4 POP _FPTRHI POP _FRAMEPTR .ENDBLOCK 103 PanelTest.initall_X: .LINE 103 .BRANCH 19 RET .ENDFUNC 103 ; ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ ; Program body ; ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ .FUNC $_Main, 0006Bh, 00020h .ENTRYMAIN $ PanelTest.$_Main: .BLOCK 107 .LINE 108 .BRANCH 17,PanelTest.INITALL CALL PanelTest.INITALL .LINE 110 LDI _ACCA, 00000h SHRB 8 LDI _ACCB, 00000h AND 0FFh MOV PANELTEST.I, _ACCB MOV PANELTEST.I+1, _ACCA .LINE 111 LDI _ACCA, 000h MOV PANELTEST.T, _ACCA .LINE 112 LDI _ACCA, 00064h SHRB 8 LDI _ACCB, 00064h AND 0FFh .FRAME 0 CALL SYSTEM.MDELAY PanelTest._L0005: .BLOCK 113 .LINE 114 CLR _ACCA MOV _ACCB, _SYSTFLAGS ANDI _ACCB, 001h BRNE PanelTest._L0007 COM _ACCA PanelTest._L0007: TST _ACCA .BRANCH 4,PanelTest._L0010 BRNE PanelTest._L0010 .BRANCH 20,PanelTest._L0008 JMP PanelTest._L0008 PanelTest._L0010: .BLOCK 114 .LINE 115 LDI _ACCA, 00014h SHRB 8 LDI _ACCB, 00014h AND 0FFh LDI _ACCCLO, PanelTest.FlashTimer AND 0FFh LDI _ACCCHI, PanelTest.FlashTimer SHRB 8 LDI _ACCBHI, 001h CALL SYSTEM.SetSysTimer .LINE 116 MOV _ACCA, PanelTest.t CLT TST _ACCA BREQ PanelTest._L0011 SET PanelTest._L0011: IN _ACCA, 0002Bh BLD _ACCA, 002h OUT 0002Bh, _ACCA .LINE 117 MOV _ACCA, PanelTest.t COM _ACCA MOV PANELTEST.T, _ACCA .LINE 118 MOV _ACCA, PanelTest.t CLT TST _ACCA BREQ PanelTest._L0013 SET PanelTest._L0013: IN _ACCA, 0002Bh BLD _ACCA, 003h OUT 0002Bh, _ACCA .LINE 119 MOV _ACCA, PanelTest.k LSL _ACCA MOV PANELTEST.K, _ACCA .LINE 120 MOV _ACCA, PanelTest.k CPI _ACCA, 000h LDI _ACCA, 0h BRNE PanelTest._L0015 SER _ACCA PanelTest._L0015: TST _ACCA .BRANCH 4,PanelTest._L0018 BRNE PanelTest._L0018 .BRANCH 20,PanelTest._L0016 JMP PanelTest._L0016 PanelTest._L0018: .BLOCK 120 .LINE 121 LDI _ACCA, 001h MOV PANELTEST.K, _ACCA .ENDBLOCK 122 PanelTest._L0016: PanelTest._L0017: .LINE 123 MOV _ACCA, PanelTest.k LDI _ACCB, 0FFh EOR _ACCA, _ACCB LDI _ACCDLO, 03Ah LDI _ACCAHI, 001h CALL SYSTEM.I2CEXPOUT .ENDBLOCK 124 PanelTest._L0008: PanelTest._L0009: .LINE 126 LDI _ACCA, 000h .FRAME 0 CALL SYSTEM.GETINCRVAL4 STS PANELTEST.INCRVALUE, _ACCB STS PANELTEST.INCRVALUE+1, _ACCA .LINE 127 LDS _ACCB, PanelTest.IncrValue LDS _ACCA, PanelTest.IncrValue+1 PUSH _ACCB PUSH _ACCA LDS _ACCB, PanelTest.OldIncrValue LDS _ACCA, PanelTest.OldIncrValue+1 MOVW _ACCALO, _ACCB POP _ACCA POP _ACCB LDI _ACCBLO, 080h EOR _ACCA, _ACCBLO EOR _ACCAHI, _ACCBLO CP _ACCA, _ACCAHI BRNE PanelTest._L0019 CP _ACCB, _ACCALO PanelTest._L0019: LDI _ACCA, 0h BREQ PanelTest._L0020 SER _ACCA PanelTest._L0020: TST _ACCA .BRANCH 4,PanelTest._L0023 BRNE PanelTest._L0023 .BRANCH 20,PanelTest._L0021 JMP PanelTest._L0021 PanelTest._L0023: .BLOCK 127 .LINE 128 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 000h ST -Y, _ACCA .FRAME 1 LDI _ACCA, 00Ch ST -Y, _ACCA .FRAME 2 LDI _ACCA, 000h ST -Y, _ACCA .FRAME 3 .FRAME 0 CALL SYSTEM.LCDXY_M POP _FPTRHI POP _FRAMEPTR .LINE 129 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 1 SHLB _DEVICE OR Flags, _ACCA LDI _ACCB, SYSTEM.lcdout_m SHRB 1 LDI _ACCA, SYSTEM.lcdout_m SHRB 9 ST -Y, _ACCA ST -Y, _ACCB .FRAME 2 LDS _ACCB, PanelTest.IncrValue LDS _ACCA, PanelTest.IncrValue+1 MOVW _ACCBLO, _ACCB LDI _ACCALO, 00004h AND 0FFh LDI _ACCAHI, 00004h SHRB 8 SET BLD Flags, _SIGN CALL SYSTEM.DIV16_R PUSH _FRAMEPTR PUSH _FPTRHI ST -Y, _ACCA ST -Y, _ACCB .FRAME 4 LDI _ACCA, 000h ST -Y, _ACCA LDI _ACCA, 000h ST -Y, _ACCA LDI _ACCA, 020h ST -Y, _ACCA .FRAME 7 SET BLD Flags, _DEVICE SET BLD Flags, _SIGN CLT BLD Flags2, _F64StrInt BLD Flags2, _F64StrFrac CALL SYSTEM.Int2Str .FRAME 2 POP _FPTRHI POP _FRAMEPTR LDI _ACCCLO, $St_String3 AND 0FFh LDI _ACCCHI, $St_String3 SHRB 8 CALL SYSTEM.StrConst2Str PanelTest._L0024: POP _FPTRHI POP _FRAMEPTR .FRAME 0 .LINE 130 LDI _ACCA, 00064h SHRB 8 LDI _ACCB, 00064h AND 0FFh LDI _ACCCLO, PanelTest.ActivityTimer AND 0FFh LDI _ACCCHI, PanelTest.ActivityTimer SHRB 8 LDI _ACCBHI, 002h CALL SYSTEM.SetSysTimer .ENDBLOCK 131 PanelTest._L0021: PanelTest._L0022: .LINE 132 LDS _ACCB, PanelTest.IncrValue LDS _ACCA, PanelTest.IncrValue+1 STS PANELTEST.OLDINCRVALUE, _ACCB STS PANELTEST.OLDINCRVALUE+1, _ACCA .LINE 134 LDI _ACCA, 0000Ah SHRB 8 LDI _ACCB, 0000Ah AND 0FFh .FRAME 0 CALL SYSTEM.MDELAY .LINE 135 LDI _ACCA, 000h .FRAME 0 CALL SYSTEM.LCDPORTINP_M ORI _ACCA, 0C7h STS PANELTEST.BUTTONTEMP, _ACCA .LINE 136 LDS _ACCA, PanelTest.ButtonTemp CPI _ACCA, 0FFh LDI _ACCA, 0h BREQ PanelTest._L0025 SER _ACCA PanelTest._L0025: TST _ACCA .BRANCH 4,PanelTest._L0028 BRNE PanelTest._L0028 .BRANCH 20,PanelTest._L0026 JMP PanelTest._L0026 PanelTest._L0028: .BLOCK 136 .LINE 137 LDI _ACCA, 0000Ah SHRB 8 LDI _ACCB, 0000Ah AND 0FFh .FRAME 0 CALL SYSTEM.MDELAY .LINE 138 LDI _ACCA, 000h .FRAME 0 CALL SYSTEM.LCDPORTINP_M ORI _ACCA, 0C7h STS PANELTEST.BUTTONTEMP, _ACCA .LINE 139 LDS _ACCA, PanelTest.ButtonTemp CPI _ACCA, 0FFh LDI _ACCA, 0h BREQ PanelTest._L0029 SER _ACCA PanelTest._L0029: TST _ACCA .BRANCH 4,PanelTest._L0032 BRNE PanelTest._L0032 .BRANCH 20,PanelTest._L0030 JMP PanelTest._L0030 PanelTest._L0032: .BLOCK 139 .LINE 140 LDS _ACCB, 00109h CLR _ACCA SBRC _ACCB, 003h SER _ACCA COM _ACCA TST _ACCA .BRANCH 4,PanelTest._L0035 BRNE PanelTest._L0035 .BRANCH 20,PanelTest._L0033 JMP PanelTest._L0033 PanelTest._L0035: .BLOCK 140 .LINE 141 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 000h ST -Y, _ACCA .FRAME 1 LDI _ACCA, 00Ch ST -Y, _ACCA .FRAME 2 LDI _ACCA, 000h ST -Y, _ACCA .FRAME 3 .FRAME 0 CALL SYSTEM.LCDXY_M POP _FPTRHI POP _FRAMEPTR .LINE 142 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 1 SHLB _DEVICE OR Flags, _ACCA LDI _ACCB, SYSTEM.lcdout_m SHRB 1 LDI _ACCA, SYSTEM.lcdout_m SHRB 9 ST -Y, _ACCA ST -Y, _ACCB .FRAME 2 LDI _ACCCLO, $St_String4 AND 0FFh LDI _ACCCHI, $St_String4 SHRB 8 CALL SYSTEM.StrConst2Str PanelTest._L0036: POP _FPTRHI POP _FRAMEPTR .FRAME 0 .ENDBLOCK 143 PanelTest._L0033: PanelTest._L0034: .LINE 144 LDS _ACCB, 00109h CLR _ACCA SBRC _ACCB, 005h SER _ACCA COM _ACCA TST _ACCA .BRANCH 4,PanelTest._L0039 BRNE PanelTest._L0039 .BRANCH 20,PanelTest._L0037 JMP PanelTest._L0037 PanelTest._L0039: .BLOCK 144 .LINE 145 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 000h ST -Y, _ACCA .FRAME 1 LDI _ACCA, 00Ch ST -Y, _ACCA .FRAME 2 LDI _ACCA, 000h ST -Y, _ACCA .FRAME 3 .FRAME 0 CALL SYSTEM.LCDXY_M POP _FPTRHI POP _FRAMEPTR .LINE 146 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 1 SHLB _DEVICE OR Flags, _ACCA LDI _ACCB, SYSTEM.lcdout_m SHRB 1 LDI _ACCA, SYSTEM.lcdout_m SHRB 9 ST -Y, _ACCA ST -Y, _ACCB .FRAME 2 LDI _ACCCLO, $St_String5 AND 0FFh LDI _ACCCHI, $St_String5 SHRB 8 CALL SYSTEM.StrConst2Str PanelTest._L0040: POP _FPTRHI POP _FRAMEPTR .FRAME 0 .ENDBLOCK 147 PanelTest._L0037: PanelTest._L0038: .LINE 148 LDS _ACCB, 00109h CLR _ACCA SBRC _ACCB, 004h SER _ACCA COM _ACCA TST _ACCA .BRANCH 4,PanelTest._L0043 BRNE PanelTest._L0043 .BRANCH 20,PanelTest._L0041 JMP PanelTest._L0041 PanelTest._L0043: .BLOCK 148 .LINE 149 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 000h ST -Y, _ACCA .FRAME 1 LDI _ACCA, 00Ch ST -Y, _ACCA .FRAME 2 LDI _ACCA, 000h ST -Y, _ACCA .FRAME 3 .FRAME 0 CALL SYSTEM.LCDXY_M POP _FPTRHI POP _FRAMEPTR .LINE 150 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 1 SHLB _DEVICE OR Flags, _ACCA LDI _ACCB, SYSTEM.lcdout_m SHRB 1 LDI _ACCA, SYSTEM.lcdout_m SHRB 9 ST -Y, _ACCA ST -Y, _ACCB .FRAME 2 LDI _ACCCLO, $St_String6 AND 0FFh LDI _ACCCHI, $St_String6 SHRB 8 CALL SYSTEM.StrConst2Str PanelTest._L0044: POP _FPTRHI POP _FRAMEPTR .FRAME 0 .ENDBLOCK 151 PanelTest._L0041: PanelTest._L0042: PanelTest._L0045: .BLOCK 152 .LINE 153 LDI _ACCA, 0000Ah SHRB 8 LDI _ACCB, 0000Ah AND 0FFh .FRAME 0 CALL SYSTEM.MDELAY .LINE 154 LDI _ACCA, 000h .FRAME 0 CALL SYSTEM.LCDPORTINP_M ORI _ACCA, 0C7h STS PANELTEST.BUTTONTEMP, _ACCA .LINE 155 LDI _ACCA, 00064h SHRB 8 LDI _ACCB, 00064h AND 0FFh LDI _ACCCLO, PanelTest.ActivityTimer AND 0FFh LDI _ACCCHI, PanelTest.ActivityTimer SHRB 8 LDI _ACCBHI, 002h CALL SYSTEM.SetSysTimer .ENDBLOCK 156 .LINE 156 PanelTest._L0046: LDS _ACCA, PanelTest.ButtonTemp CPI _ACCA, 0FFh LDI _ACCA, 0h BRNE PanelTest._L0048 SER _ACCA PanelTest._L0048: TST _ACCA .BRANCH 4,PanelTest._L0049 BRNE PanelTest._L0049 .BRANCH 20,PanelTest._L0045 JMP PanelTest._L0045 PanelTest._L0049: PanelTest._L0047: .ENDBLOCK 157 PanelTest._L0030: PanelTest._L0031: .ENDBLOCK 158 PanelTest._L0026: PanelTest._L0027: .LINE 159 CLR _ACCA MOV _ACCB, _SYSTFLAGS ANDI _ACCB, 002h BRNE PanelTest._L0050 COM _ACCA PanelTest._L0050: TST _ACCA .BRANCH 4,PanelTest._L0053 BRNE PanelTest._L0053 .BRANCH 20,PanelTest._L0051 JMP PanelTest._L0051 PanelTest._L0053: .BLOCK 159 .LINE 160 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 000h ST -Y, _ACCA .FRAME 1 LDI _ACCA, 00Ch ST -Y, _ACCA .FRAME 2 LDI _ACCA, 000h ST -Y, _ACCA .FRAME 3 .FRAME 0 CALL SYSTEM.LCDXY_M POP _FPTRHI POP _FRAMEPTR .LINE 161 PUSH _FRAMEPTR PUSH _FPTRHI LDI _ACCA, 1 SHLB _DEVICE OR Flags, _ACCA LDI _ACCB, SYSTEM.lcdout_m SHRB 1 LDI _ACCA, SYSTEM.lcdout_m SHRB 9 ST -Y, _ACCA ST -Y, _ACCB .FRAME 2 LDI _ACCCLO, $St_String7 AND 0FFh LDI _ACCCHI, $St_String7 SHRB 8 CALL SYSTEM.StrConst2Str PanelTest._L0054: POP _FPTRHI POP _FRAMEPTR .FRAME 0 .ENDBLOCK 162 PanelTest._L0051: PanelTest._L0052: .ENDBLOCK 163 .LINE 163 .BRANCH 20,PanelTest._L0005 JMP PanelTest._L0005 PanelTest._L0006: .ENDBLOCK 165 PanelTest.$_MAINEX: .LINE 165 NOP .LINE 165 .BRANCH 20,PanelTest.$_MAINEX RJMP PanelTest.$_MAINEX .ENDFUNC 165 SYSTEM.$Main_stk .EQU 00113h ; var iData Process stack area SYSTEM.$Main_stk_e .EQU 00192h ; var iData Process stack area SYSTEM.$Main_reg .EQU 00193h ; var iData Process register area SYSTEM.$Main_reg_e .EQU 001A3h ; var iData Process register area SYSTEM.$Main_Frame .EQU 001A4h ; var iData Process stack area SYSTEM.$Main_Frame_e .EQU 00223h ; var iData Process stack area ; ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ ; Initialisation and Library Routines ; ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ .ENTRY SYSTEM.RESET: CLI ; >> Stack Init [main process only] << LDI _ACCA, 001h LDI _ACCB, 092h OUT sph, _ACCA OUT spl, _ACCB ; >> Memory init << CLR _ACCA LDI _ACCCLO, 16 LDI _ACCCHI, 0 LDI _ACCBLO, 0 LDI _ACCBHI, 0 ADIW _ACCCLO, 1 NOP SYSTEM._L0055: SBIW _ACCCLO, 001h BREQ SYSTEM._L0057 SYSTEM._L0056: ST X+, _ACCA RJMP SYSTEM._L0055 SYSTEM._L0057: LDI _ACCBLO, 00100h AND 0FFh LDI _ACCBHI, 00100h SHRB 8 LDI _ACCCLO, 00400h AND 0FFh LDI _ACCCHI, 00400h SHRB 8 ADIW _ACCCLO, 1 NOP SYSTEM._L0058: SBIW _ACCCLO, 001h BREQ SYSTEM._L0060 SYSTEM._L0059: ST X+, _ACCA RJMP SYSTEM._L0058 SYSTEM._L0060: LDI _FRAMEPTR, 00223h AND 0FFh LDI _FPTRHI, 00223h SHRB 8 CLI LDI _ACCA, 0FEH ROLB IntFlag AND Flags, _ACCA ; ============ init structured constants ============ ; >> Hardware Init << ; >> SysTick init: 10msec << ; >> real SysTick (exact): 9.984 msec << LDI _ACCA, 064h STS SysTickTime, _ACCA OUT tcnt0, _ACCA LDI _ACCA, 5 OUT tccr0, _ACCA LDI _ACCA, 001h STS timsk0, _ACCA ; >> IncrPort4 Init << LDI _ACCA, 0 STS TCCR1A, _ACCA LDI _ACCA, 009h STS TCCR1B, _ACCA LDI _ACCA, 00FA0h SHRB 8 LDI _ACCB, 00FA0h AND 0FFh STS OCR1AH, _ACCA STS OCR1AL, _ACCB ; >> TWIPORT Init << LDI _ACCA, 00Ch STS TWBR, _ACCA LDI _ACCA, 0FFh STS TWI_DevLock, _ACCA CLR Flags CLR Flags2 ; ============ Start User Main Program ============ .DEB MAINENTRY JMP PanelTest.$_Main ; ============ Interrupt Service ============ SYSTEM.$INTERRUPT_TIMER0: .DEB SYSTICKENTRY PUSH _ACCCLO PUSH _ACCCHI PUSH _ACCB PUSH _ACCA IN _ACCA, SREG PUSH _ACCA LDS _ACCA, SysTickTime IN _ACCB, tcnt0 ADD _ACCA, _ACCB OUT tcnt0, _ACCA LDI _ACCA, 0FEH ROLB IntFlag AND Flags, _ACCA LDS _ACCB, _TWI_TO TST _ACCB BREQ SYSTEM._L0061 DEC _ACCB STS _TWI_TO, _ACCB SYSTEM._L0061: LDS _ACCCLO, PanelTest.FlashTimer LDS _ACCCHI, PanelTest.FlashTimer+1 TST _ACCCHI BRNE SYSTEM._L0062 TST _ACCCLO BREQ SYSTEM._L0063 SYSTEM._L0062: SBIW _ACCCLO, 1 STS PanelTest.FlashTimer, _ACCCLO STS PanelTest.FlashTimer+1, _ACCCHI RJMP SYSTEM._L0064 SYSTEM._L0063: MOV _ACCA, _SYSTFLAGS ANDI _ACCA, 0FEh MOV _SYSTFLAGS, _ACCA SYSTEM._L0064: LDS _ACCCLO, PanelTest.ActivityTimer LDS _ACCCHI, PanelTest.ActivityTimer+1 TST _ACCCHI BRNE SYSTEM._L0065 TST _ACCCLO BREQ SYSTEM._L0066 SYSTEM._L0065: SBIW _ACCCLO, 1 STS PanelTest.ActivityTimer, _ACCCLO STS PanelTest.ActivityTimer+1, _ACCCHI RJMP SYSTEM._L0067 SYSTEM._L0066: MOV _ACCA, _SYSTFLAGS ANDI _ACCA, 0FDh MOV _SYSTFLAGS, _ACCA SYSTEM._L0067: LDI _ACCA, 1 SHLB IntFlag OR Flags, _ACCA POP _ACCA OUT SREG, _ACCA POP _ACCA POP _ACCB POP _ACCCHI POP _ACCCLO .DEB SYSTICKEXIT RETI SYSTEM.$INTERRUPT_TIMER1COMPA: PUSH _ACCCLO PUSH _ACCCHI PUSH _ACCB PUSH _ACCA IN _ACCA, SREG PUSH _ACCA RJMP SYSTEM._L0073 SYSTEM._L0068: MOV _ACCB, _ACCA LSR _ACCA LSR _ACCA ANDI _ACCB, 3 BREQ SYSTEM._L0069 CPI _ACCB, 3 BRNE SYSTEM._L0070 SYSTEM._L0069: ADIW _ACCCLO, 2 RET SYSTEM._L0070: LDD _ACCALO, Z+0 LDD _ACCAHI, Z+1 CPI _ACCB, 1 BREQ SYSTEM._L0071 SUBI _ACCALO, 0FFh SBCI _ACCAHI, 0FFh RJMP SYSTEM._L0072 SYSTEM._L0071: SUBI _ACCALO, 1 SBCI _ACCAHI, 0 SYSTEM._L0072: ST Z+, _ACCALO ST Z+, _ACCAHI RET SYSTEM._L0073: PUSH _ACCALO PUSH _ACCAHI PUSH _ACCDLO PUSH _ACCDHI IN _ACCA, PINC .DEB Incr4Int ANDI _ACCA, 03h; LDI _ACCCLO, _INCRSTATE4 AND 0FFh LDI _ACCCHI, _INCRSTATE4 SHRB 8 LDD _ACCB, Z+0 STD Z+0, _ACCA MOV _ACCALO, _ACCB; EOR _ACCALO, _ACCA; BREQ SYSTEM._L0074 MOV _ACCAHI, _ACCALO; ANDI _ACCALO, 055h; ANDI _ACCAHI, 0AAh; MOV _ACCDLO, _ACCALO; EOR _ACCDLO, _ACCAHI; AND _ACCALO, _ACCDLO AND _ACCAHI, _ACCDLO MOV _ACCCLO, _ACCB; ANDI _ACCCLO, 055h; MOV _ACCDLO, _ACCB; ANDI _ACCDLO, 0AAh; LSR _ACCDLO; EOR _ACCCLO, _ACCDLO; COM _ACCCLO; MOV _ACCCHI, _ACCA; ANDI _ACCCHI, 055h; MOV _ACCDLO, _ACCA; ANDI _ACCDLO, 0AAh; LSR _ACCDLO; EOR _ACCCHI, _ACCDLO; COM _ACCCHI; MOV _ACCA, _ACCALO; AND _ACCA, _ACCCLO; MOV _ACCB, _ACCCHI; LSL _ACCB; AND _ACCB, _ACCAHI; LSR _ACCB; OR _ACCA, _ACCB; AND _ACCALO, _ACCCHI; LSL _ACCALO; LSL _ACCCLO; AND _ACCAHI, _ACCCLO; OR _ACCALO, _ACCAHI; OR _ACCA, _ACCALO; LDI _ACCCLO, _INCRCOUNT4_0 AND 0FFh LDI _ACCCHI, _INCRCOUNT4_0 SHRB 8 RCALL SYSTEM._L0068 SYSTEM._L0074: POP _ACCDHI POP _ACCDLO POP _ACCAHI POP _ACCALO POP _ACCA OUT SREG, _ACCA POP _ACCA POP _ACCB POP _ACCCHI POP _ACCCLO RETI ; ============ Library ============ SYSTEM._LCDM_ini: LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00002h AND 0FFh LDI _ACCBHI, 00002h SHRB 8 LDI _ACCAHI, 002h LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 LDI _ACCELO, 00000h AND 0FFh LDI _ACCEHI, 00000h SHRB 8 CLT BLD Flags, _I2C2BYTE LDI _ACCDHI, 000h CALL SYSTEM.TWIout LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00002h AND 0FFh LDI _ACCBHI, 00002h SHRB 8 LDI _ACCAHI, 004h LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 LDI _ACCELO, 00000h AND 0FFh LDI _ACCEHI, 00000h SHRB 8 LDI _ACCDHI, 000h CALL SYSTEM.TWIout LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00002h AND 0FFh LDI _ACCBHI, 00002h SHRB 8 LDI _ACCAHI, 006h LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 LDI _ACCELO, 0F800h AND 0FFh LDI _ACCEHI, 0F800h SHRB 8 LDI _ACCDHI, 000h CALL SYSTEM.TWIout RET SYSTEM._LCDM_CLOSE: LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00001h AND 0FFh LDI _ACCBHI, 00001h SHRB 8 LDI _ACCAHI, 003h LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 CLT BLD Flags, _I2C2BYTE LDI _ACCDHI, 000h CALL SYSTEM.TWIout LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00001h AND 0FFh LDI _ACCBHI, 00001h SHRB 8 LDI _ACCAHI, 003h LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 LDI _ACCELO, 000h LDI _ACCDHI, 000h CALL SYSTEM.TWIout RET SYSTEM._LCDM_START_RW: PUSH _ACCELO MOV _ACCALO, _ACCA LDI _ACCELO, 000h RCALL SYSTEM._LCDM_CLOSE POP _ACCELO PUSH _ACCELO ANDI _ACCELO, 2 BREQ SYSTEM._L0075 LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00001h AND 0FFh LDI _ACCBHI, 00001h SHRB 8 LDI _ACCAHI, 006h LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 LDI _ACCELO, 0FFh LDI _ACCDHI, 000h CALL SYSTEM.TWIout RJMP SYSTEM._L0076 SYSTEM._L0075: LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00001h AND 0FFh LDI _ACCBHI, 00001h SHRB 8 LDI _ACCAHI, 006h LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 LDI _ACCELO, 000h LDI _ACCDHI, 000h CALL SYSTEM.TWIout LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00001h AND 0FFh LDI _ACCBHI, 00001h SHRB 8 LDI _ACCAHI, 006h LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 MOV _ACCELO, _ACCALO LDI _ACCDHI, 000h CALL SYSTEM.TWIout SYSTEM._L0076: LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00001h AND 0FFh LDI _ACCBHI, 00001h SHRB 8 LDI _ACCAHI, 003h LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 POP _ACCELO PUSH _ACCELO LDI _ACCDHI, 000h CALL SYSTEM.TWIout LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00001h AND 0FFh LDI _ACCBHI, 00001h SHRB 8 LDI _ACCAHI, 003h LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 POP _ACCELO PUSH _ACCELO ORI _ACCELO, 1 LDI _ACCDHI, 000h CALL SYSTEM.TWIout POP _ACCELO ANDI _ACCELO, 2 BREQ SYSTEM._L0077 LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00000h AND 0FFh LDI _ACCBHI, 00000h SHRB 8 LDI _ACCAHI, 000h LDI _ACCDHI, 000h CALL SYSTEM.TWIout SYSTEM._L0077: RET SYSTEM._LCDM_Busy_Rd: LDI _ACCELO, 002h RCALL SYSTEM._LCDM_START_RW LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00001h AND 0FFh LDI _ACCBHI, 00001h SHRB 8 LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 CALL SYSTEM.TWIinp PUSH _ACCELO LDI _ACCELO, 002h RCALL SYSTEM._LCDM_CLOSE POP _ACCA .DEB LCDBUSY_RD RET SYSTEM._LCDWAIT_M: LDI _ACCCLO, 00280h AND 0FFh LDI _ACCCHI, 00280h SHRB 8 SYSTEM._L0078: RCALL SYSTEM._LCDM_Busy_Rd TST _ACCA BRPL SYSTEM._L0079 SBIW _ACCCLO, 1 BRNE SYSTEM._L0078 CLR _ACCB CLR _ACCA RET SYSTEM._L0079: MOV _ACCB, _ACCA SER _ACCA RET SYSTEM._LCDM_Ctrl_Wr: PUSH _ACCA RCALL SYSTEM._LCDWAIT_M TST _ACCA BRNE SYSTEM._L0080 POP _ACCB RET SYSTEM._L0080: POP _ACCA SYSTEM._LCDM_Ctrl_Wr_NW: .DEB LCDCTRL_WR LDI _ACCELO, 000h RCALL SYSTEM._LCDM_START_RW LDI _ACCELO, 000h RCALL SYSTEM._LCDM_CLOSE SER _ACCA RET SYSTEM._LCDM_Data_Wr: .DEB LCDOUT_M LDI _ACCELO, 004h RCALL SYSTEM._LCDM_START_RW LDI _ACCELO, 004h RCALL SYSTEM._LCDM_CLOSE SER _ACCA RET SYSTEM._LCDM_Data_Rd: LDI _ACCELO, 006h RCALL SYSTEM._LCDM_START_RW LDS _ACCDLO, _LCDM_PORT ORI _ACCDLO, 20h LDI _ACCBLO, 00001h AND 0FFh LDI _ACCBHI, 00001h SHRB 8 LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 CALL SYSTEM.TWIinp PUSH _ACCELO LDI _ACCELO, 006h RCALL SYSTEM._LCDM_CLOSE POP _ACCA .DEB LCDINP_M RET SYSTEM.LCDSETUP_M: STS _LCDM_PORT, _ACCA ORI _ACCA, 20h CALL SYSTEM.TWIstat .DEB I2CSTAT_M TST _ACCA BRNE SYSTEM._L0081 RET SYSTEM._L0081: RCALL SYSTEM._LCDM_ini LDI _ACCB, 16 CLR _ACCA CALL SYSTEM.MDELAY LDI _ACCA, 30h RCALL SYSTEM._LCDM_Ctrl_Wr_NW LDI _ACCB, 5 CLR _ACCA CALL SYSTEM.MDELAY LDI _ACCA, 30h RCALL SYSTEM._LCDM_Ctrl_Wr_NW LDI _ACCB, 1 CLR _ACCA CALL SYSTEM.MDELAY LDI _ACCA, 30h RCALL SYSTEM._LCDM_Ctrl_Wr_NW LDI _ACCB, 1 CLR _ACCA CALL SYSTEM.MDELAY LDI _ACCA, 38h RCALL SYSTEM._LCDM_Ctrl_Wr LDI _ACCA, 08h RCALL SYSTEM._LCDM_Ctrl_Wr LDI _ACCA, 1 RCALL SYSTEM._LCDM_Ctrl_Wr LDI _ACCA, 6 RCALL SYSTEM._LCDM_Ctrl_Wr_NW RET SYSTEM.LCDOUT_M: RJMP SYSTEM._LCDM_Data_Wr SYSTEM.LCDCTRL_M: LDD _ACCA, Y+001h STS _LCDM_PORT, _ACCA LDD _ACCA, Y+000h RJMP SYSTEM._LCDM_Ctrl_Wr SYSTEM.LCDINP_M: STS _LCDM_PORT, _ACCA RJMP SYSTEM._LCDM_Data_Rd SYSTEM.LCDSTAT_M: STS _LCDM_PORT, _ACCA RJMP SYSTEM._LCDM_Busy_Rd SYSTEM.LCDsetPort_M: STS _LCDM_PORT, _ACCA RET SYSTEM.LCDgetPort_M: LDS _ACCA, _LCDM_PORT RET SYSTEM.LCDON_M: LDD _ACCA, Y+000h STS _LCDM_PORT, _ACCA LDI _ACCA, 0FFh LDI _ACCB, 0FFh RJMP SYSTEM._L0082 SYSTEM.LCDCURSOR_M: LDD _ACCA, Y+002h STS _LCDM_PORT, _ACCA LDD _ACCA, Y+000h LDD _ACCB, Y+001h SYSTEM._L0082: TST _ACCA BRNE SYSTEM._L0083 LDI _ACCA, 0Ch RJMP SYSTEM._L0084 SYSTEM._L0083: LDI _ACCA, 0Dh SYSTEM._L0084: TST _ACCB BREQ SYSTEM._L0085 ORI _ACCA, 2 SYSTEM._L0085: RJMP SYSTEM._LCDM_Ctrl_Wr SYSTEM.LCDXY_M: LDD _ACCA, Y+002h STS _LCDM_PORT, _ACCA LDD _ACCA, Y+000h LDD _ACCB, Y+001h CPI _ACCA, 0 BRNE SYSTEM._L0086 LDI _ACCA, 080h RJMP SYSTEM._L0090 SYSTEM._L0086: CPI _ACCA, 1 BRNE SYSTEM._L0087 LDI _ACCA, 0C0h RJMP SYSTEM._L0090 SYSTEM._L0087: CPI _ACCA, 2 BRNE SYSTEM._L0088 LDI _ACCA, 090h RJMP SYSTEM._L0090 SYSTEM._L0088: CPI _ACCA, 3 BRNE SYSTEM._L0089 LDI _ACCA, 0D0h RJMP SYSTEM._L0090 SYSTEM._L0089: LDI _ACCA, 080h SYSTEM._L0090: ADD _ACCA, _ACCB RJMP SYSTEM._LCDM_Ctrl_Wr_NW SYSTEM.LCDportInp_M: MOV _ACCDLO, _ACCA ORI _ACCDLO, 20h PUSH _ACCDLO LDI _ACCBLO, 00000h AND 0FFh LDI _ACCBHI, 00000h SHRB 8 LDI _ACCAHI, 001h LDI _ACCDHI, 000h CALL SYSTEM.TWIout POP _ACCDLO LDI _ACCBLO, 00001h AND 0FFh LDI _ACCBHI, 00001h SHRB 8 LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 CALL SYSTEM.TWIinp MOV _ACCA, _ACCELO ANDI _ACCA, 0F8h RET SYSTEM.I2CexpStat: CALL SYSTEM.TWIstat .DEB I2CExpStat RET SYSTEM.I2CEXPOUT: LDI _ACCBLO, 00001h AND 0FFh LDI _ACCBHI, 00001h SHRB 8 LDI _ACCCLO, _ACCELO AND 0FFh LDI _ACCCHI, _ACCELO SHRB 8 MOV _ACCELO, _ACCA .DEB I2CExpOutW LDI _ACCDHI, 000h CALL SYSTEM.TWIout RET SYSTEM.TWISTARTB: LDI _ACCA, 0 STS TWI_DevLock, _ACCA LDS _ACCA, TWSR ANDI _ACCA, 0FCh CPI _ACCA, 000h BRNE SYSTEM._L0093 LDI _ACCA, 090h STS TWCR, _ACCA SYSTEM._L0093: LDI _ACCA, 0A4h STS TWCR, _ACCA LDI _ACCA, 10 STS _TWI_TO, _ACCA SYSTEM._L0091: LDS _ACCA, TWCR ANDI _ACCA, 080h BRNE SYSTEM._L0094 LDS _ACCA, _TWI_TO TST _ACCA BRNE SYSTEM._L0091 STS TWCR, _ACCA RJMP SYSTEM.TWI_ERROR SYSTEM._L0094: LDS _ACCA, TWSR ANDI _ACCA, 0FCh CPI _ACCA, 008h BRNE SYSTEM._L0098 RJMP SYSTEM.TWI_ERROR SYSTEM._L0098: RJMP SYSTEM.TWI_OK SYSTEM.TWISTOPB: SYSTEM._L0099: LDS _ACCA, TWSR ANDI _ACCA, 0FCh CPI _ACCA, 0F8h BREQ SYSTEM._L0099 CPI _ACCA, 000h BRNE SYSTEM._L0100 LDI _ACCA, 090h STS TWCR, _ACCA NOP SYSTEM._L0100: LDI _ACCB, 094h STS TWCR, _ACCB SER _ACCA STS TWI_DevLock, _ACCA RET SYSTEM.TWISENDBYTE: STS TWDR, _ACCDLO LDI _ACCA, 084h STS TWCR, _ACCA LDI _ACCA, 10 STS _TWI_TO, _ACCA SYSTEM._L0102: LDS _ACCA, TWCR ANDI _ACCA, 080h BRNE SYSTEM._L0103 LDS _ACCA, _TWI_TO TST _ACCA BRNE SYSTEM._L0102 RJMP SYSTEM.TWI_ERROR SYSTEM._L0103: LDS _ACCA, TWSR ANDI _ACCA, 0FCh CPI _ACCA, 028h BREQ SYSTEM.TWI_OK CPI _ACCA, 018h BREQ SYSTEM.TWI_OK CPI _ACCA, 040h BREQ SYSTEM.TWI_OK RJMP SYSTEM.TWI_ERROR SYSTEM.TWIRECVBYTE: LDI _ACCA, 0C4h SBIW _ACCBLO, 1 BRMI SYSTEM.TWISTOPB BRNE SYSTEM._L0104 LDI _ACCA, 084h SYSTEM._L0104: STS TWCR, _ACCA SYSTEM._L0105: LDS _ACCA, TWCR SBRS _ACCA, 7 RJMP SYSTEM._L0105 LDS _ACCA, TWSR ANDI _ACCA, 0FCh CPI _ACCA, 058h BREQ SYSTEM._L0107 CPI _ACCA, 050h BRNE SYSTEM.TWI_ERROR SYSTEM._L0107: LDS _ACCA, TWDR ST Z+, _ACCA RJMP SYSTEM.TWIRECVBYTE SYSTEM.TWI_OK: LDI _ACCA, true RET SYSTEM.TWI_ERROR: LDS _ACCA, TWSR ANDI _ACCA, 0FCh CPI _ACCA, 000h BRNE SYSTEM._L0106 LDI _ACCA, 090h STS TWCR, _ACCA SYSTEM._L0106: LDI _ACCA, false RET SYSTEM.TWISTAT: MOV _ACCDLO, _ACCA RCALL SYSTEM.TWISTARTB CLC ROL _ACCDLO RCALL SYSTEM.TWISENDBYTE MOV _ACCBHI, _ACCA RCALL SYSTEM.TWISTOPB MOV _ACCA, _ACCBHI RET SYSTEM.TWIINP: RCALL SYSTEM.TWISTARTB SEC ROL _ACCDLO RCALL SYSTEM.TWISENDBYTE TST _ACCA BREQ SYSTEM._L0109 RCALL SYSTEM.TWIRECVBYTE TST _ACCA BREQ SYSTEM._L0109 RJMP SYSTEM.TWI_OK SYSTEM._L0109: RCALL SYSTEM.TWI_ERROR SER _ACCB STS TWI_DevLock, _ACCB RET SYSTEM.TWIOUT: RCALL SYSTEM.TWISTARTB CLC ROL _ACCDLO RCALL SYSTEM.TWISENDBYTE TST _ACCA BREQ SYSTEM._L0115 SYSTEM._L0110: MOV _ACCDLO, _ACCAHI RCALL SYSTEM.TWISENDBYTE TST _ACCA BREQ SYSTEM._L0115 BST Flags, _I2C2BYTE BRTC SYSTEM._L0114 MOV _ACCDLO, _ACCALO SYSTEM._L0112: RCALL SYSTEM.TWISENDBYTE TST _ACCA BREQ SYSTEM._L0115 SYSTEM._L0114: TST _ACCBLO BRNE SYSTEM._L0119 TST _ACCBHI BREQ SYSTEM._L0113 SYSTEM._L0119: TST _ACCDHI BRNE SYSTEM._L0116 LD _ACCDLO, Z+ RJMP SYSTEM._L0118 SYSTEM._L0116: CPI _ACCDHI, 1 BRNE SYSTEM._L0117 LPM _ACCDLO, Z+ RJMP SYSTEM._L0118 SYSTEM._L0117: CALL SYSTEM.ReadEEp8D ADIW _ACCCLO, 01h SYSTEM._L0118: SBIW _ACCBLO, 1 RJMP SYSTEM._L0112 SYSTEM._L0113: RCALL SYSTEM.TWISTOPB RJMP SYSTEM.TWI_OK SYSTEM._L0115: RCALL SYSTEM.TWI_ERROR SER _ACCB STS TWI_DevLock, _ACCB CLR _ACCA RET SYSTEM.IncrCount4start: CLI LDS _ACCA, TIMSK1 ORI _ACCA, 002h STS TIMSK1, _ACCA SBRC Flags, IntFlag SEI RET SYSTEM.GetIncrVal4: LDI _ACCCLO, _INCRCOUNT4_0 AND 0FFh LDI _ACCCHI, _INCRCOUNT4_0 SHRB 8 CPI _ACCA, 1 BRCS SYSTEM._L0120 LDI _ACCB, 0 LDI _ACCA, 0 RET SYSTEM._L0120: CLR _ACCB LSL _ACCA ADD _ACCCLO, _ACCA ADC _ACCCHI, _ACCB CLI LD _ACCB, Z+ LD _ACCA, Z+ SBRC Flags, IntFlag SEI RET SYSTEM.SetIncrVal4: LDD _ACCA, Y+002h CPI _ACCA, 1 BRCS SYSTEM._L0121 RET SYSTEM._L0121: LDI _ACCCLO, _INCRCOUNT4_0 AND 0FFh LDI _ACCCHI, _INCRCOUNT4_0 SHRB 8 CLR _ACCB LSL _ACCA ADD _ACCCLO, _ACCA ADC _ACCCHI, _ACCB LDD _ACCB, Y+000h LDD _ACCA, Y+001h CLI ST Z+, _ACCB ST Z+, _ACCA SBRC Flags, IntFlag SEI RET SYSTEM.SaveAllRegs: POP $_SaveRet1 POP $_SaveRet STS SYSTEM.$Main_reg, _ACCA STS SYSTEM.$Main_reg+1, _ACCB IN _ACCA, SREG PUSH _ACCA STS SYSTEM.$Main_reg+2, _ACCAHI STS SYSTEM.$Main_reg+3, _ACCALO STS SYSTEM.$Main_reg+4, _ACCBHI STS SYSTEM.$Main_reg+5, _ACCBLO STS SYSTEM.$Main_reg+6, _ACCCHI STS SYSTEM.$Main_reg+7, _ACCCLO STS SYSTEM.$Main_reg+8, _ACCDHI STS SYSTEM.$Main_reg+9, _ACCDLO STS SYSTEM.$Main_reg+10, _ACCEHI STS SYSTEM.$Main_reg+11, _ACCELO STS SYSTEM.$Main_reg+12, Flags STS SYSTEM.$Main_reg+13, _ACCGLO STS SYSTEM.$Main_reg+14, _ACCFHI STS SYSTEM.$Main_reg+15, _ACCFLO STS SYSTEM.$Main_reg+16, _ACCGHI CLT BLD Flags, IntFlag MOVW _ACCCLO, $_SaveRet IJMP SYSTEM.RestoreAllRegs: LDS _ACCA, SYSTEM.$Main_reg LDS _ACCB, SYSTEM.$Main_reg+1 LDS _ACCAHI, SYSTEM.$Main_reg+2 LDS _ACCALO, SYSTEM.$Main_reg+3 LDS _ACCBHI, SYSTEM.$Main_reg+4 LDS _ACCBLO, SYSTEM.$Main_reg+5 LDS _ACCCHI, SYSTEM.$Main_reg+6 LDS _ACCCLO, SYSTEM.$Main_reg+7 LDS _ACCDHI, SYSTEM.$Main_reg+8 LDS _ACCDLO, SYSTEM.$Main_reg+9 LDS _ACCEHI, SYSTEM.$Main_reg+10 LDS _ACCELO, SYSTEM.$Main_reg+11 LDS Flags, SYSTEM.$Main_reg+12 LDS _ACCGLO, SYSTEM.$Main_reg+13 LDS _ACCFHI, SYSTEM.$Main_reg+14 LDS _ACCFLO, SYSTEM.$Main_reg+15 LDS _ACCGHI, SYSTEM.$Main_reg+16 SET BLD Flags, IntFlag RET SYSTEM.MDELAY: .DEB DEBdelay MOVW _ACCDLO, _ACCB CLR _ACCA CP _ACCDLO, _ACCA CPC _ACCDHI, _ACCA BREQ SYSTEM.MDELAY3 SYSTEM.MDELAY1: LDI _ACCB, 00C7Ah AND 0FFh LDI _ACCA, 00C7Ah SHRB 8 SYSTEM.MDELAY2: SUBI _ACCB, 001h SBCI _ACCA, 000h NOP BRNE SYSTEM.MDELAY2 SUBI _ACCDLO, 001h SBCI _ACCDHI, 000h BRNE SYSTEM.MDELAY1 SYSTEM.MDELAY3: RET SYSTEM.UDELAY: TST _ACCA BREQ SYSTEM.UDELAY3 SYSTEM.UDELAY1: LDI _ACCB, 00026h AND 0FFh SYSTEM.UDELAY2: DEC _ACCB NOP BRNE SYSTEM.UDELAY2 DEC _ACCA BRNE SYSTEM.UDELAY1 SYSTEM.UDELAY3: RET SYSTEM.BlockCopyC: SYSTEM._L0124: SUBI _ACCALO, 001h SBCI _ACCAHI, 000h BRCS SYSTEM._L0125 LD _ACCA, Z+ ST X+, _ACCA RJMP SYSTEM._L0124 SYSTEM._L0125: RET SYSTEM._EEpWaitReady: SBRC Flags, IntFlag SEI SBIC eecr, 1 RJMP SYSTEM._EEpWaitReady CLI SBIC eecr, 1 RJMP SYSTEM._EEpWaitReady RET SYSTEM.ReadEEp8D: RCALL SYSTEM._EEpWaitReady OUT eearl, _ACCCLO OUT eearh, _ACCCHI SBI eecr, 0 NOP IN _ACCDLO, eedr SBRC Flags, IntFlag SEI RET SYSTEM.StrConst2Str: LPM _ACCBHI, Z+ TST _ACCBHI BREQ SYSTEM._L0127 SYSTEM.StrConst2StrPart: SYSTEM._L0126: LPM _ACCA, Z+ CALL SYSTEM.Char2Str DEC _ACCBHI BRNE SYSTEM._L0126 SYSTEM._L0127: RET SYSTEM._B2STR: PUSH _ACCBLO PUSH _ACCBHI LD _ACCA, X+ LD _ACCB, X+ LD _ACCELO, X+ MOVW _ACCBLO, _ACCCLO ST -Y, _ACCELO ST -Y, _ACCB ST -Y, _ACCA TST _ACCFLO BREQ SYSTEM._B2STR_NM TST _ACCALO BREQ SYSTEM._B2STR_NM DEC _ACCALO SYSTEM._B2STR_NM: MOV _ACCELO, _ACCDHI MOV _ACCEHI, _ACCDHI LSL _ACCEHI DEC _ACCEHI CLR _ACCB ADD XL, _ACCEHI ADC XH, _ACCB SYSTEM._B2STR_0: LD _ACCA, -X TST _ACCA BRNE SYSTEM._B2STR_1 SBIW XL, 1 DEC _ACCELO BRNE SYSTEM._B2STR_0 SYSTEM._B2STR_1: TST _ACCELO BRNE SYSTEM._B2STR_2 ADIW XL, 1 INC _ACCELO SYSTEM._B2STR_2: ADIW XL, 2 TST _ACCAHI BRNE SYSTEM._B2STR_PNT TST _ACCALO BREQ SYSTEM._B2STR_3 RJMP SYSTEM._B2STR_FILL SYSTEM._B2STR_3: RJMP SYSTEM._B2STR_WR SYSTEM._B2STR_PNT: TST _ACCALO BREQ SYSTEM._B2STR_PNTE0 DEC _ACCALO SYSTEM._B2STR_PNTE0: CLR _ACCB MOVW _ACCBLO, _ACCCLO CP _ACCAHI, _ACCDHI BRCC SYSTEM._B2STR_PNTGT MOV _ACCEHI, _ACCAHI LSL _ACCEHI ADD XL, _ACCEHI ADC XH, _ACCB LDI _ACCA, DECIMALSEP ST -X, _ACCA CP _ACCAHI, _ACCELO BRCS SYSTEM._B2STR_PNTE1 MOV _ACCELO, _ACCAHI INC _ACCELO SYSTEM._B2STR_PNTE1: MOV _ACCEHI, _ACCELO LSL _ACCEHI MOVW _ACCBLO, _ACCCLO ADD XL, _ACCEHI ADC XH, _ACCB RJMP SYSTEM._B2STR_FILL SYSTEM._B2STR_PNTGT: ADD XL, _ACCEHI ADC XH, _ACCB ADIW XL, 1 MOV _ACCEHI, _ACCAHI ADDI _ACCEHI, 2 CP _ACCALO, _ACCEHI BRCS SYSTEM._B2STR_PNTG0 MOV _ACCB, _ACCALO SUB _ACCB, _ACCEHI INC _ACCB RJMP SYSTEM._B2STR_PNTG1 SYSTEM._B2STR_PNTG0: CLR _ACCB SYSTEM._B2STR_PNTG1: MOV _ACCALO, _ACCB SYSTEM._B2STR_PNTG2: TST _ACCB BREQ SYSTEM._B2STR_PNTG3 MOV _ACCA, _ACCDLO CALL SYSTEM.Char2Str DEC _ACCB RJMP SYSTEM._B2STR_PNTG2 SYSTEM._B2STR_PNTG3: MOV _ACCEHI, _ACCAHI SUB _ACCEHI, _ACCDHI MOV _ACCELO, _ACCDHI ADD _ACCALO, _ACCEHI TST _ACCFLO BREQ SYSTEM._B2STR_PNTG4 MOV _ACCA, _ACCFLO CALL SYSTEM.Char2Str CLR _ACCFLO INC _ACCALO SYSTEM._B2STR_PNTG4: ADDI _ACCALO, 2 LDI _ACCA, 30h CALL SYSTEM.Char2Str LDI _ACCA, DECIMALSEP CALL SYSTEM.Char2Str LDI _ACCA, 30h SYSTEM._B2STR_PNTG5: TST _ACCEHI BREQ SYSTEM._B2STR_WR CALL SYSTEM.Char2Str DEC _ACCEHI RJMP SYSTEM._B2STR_PNTG5 SYSTEM._B2STR_FILL: CP _ACCELO, _ACCALO BRCS SYSTEM._B2STR_F0 CLR _ACCALO RJMP SYSTEM._B2STR_WR SYSTEM._B2STR_F0: SUB _ACCALO, _ACCELO MOV _ACCB, _ACCALO BST Flags2, _F64StrFrac BRTC SYSTEM._B2STR_F1 LDD _ACCELO, Y+32 SYSTEM._B2STR_F3: CP _ACCELO, _ACCB BRCC SYSTEM._L0128 SUB _ACCB, _ACCELO SYSTEM._L0128: SUB _ACCELO, _ACCB STD Y+32, _ACCELO SYSTEM._B2STR_F1: MOV _ACCA, _ACCDLO CALL SYSTEM.Char2Str DEC _ACCB BRNE SYSTEM._B2STR_F1 SYSTEM._B2STR_WR: BST Flags2, _F64StrFrac BRTC SYSTEM._L0129 LDD _ACCELO, Y+32 SYSTEM._B2STR_F2: TST _ACCELO BREQ SYSTEM._B2STR_WR2 SYSTEM._L0129: TST _ACCFLO BREQ SYSTEM._B2STR_WR0 MOV _ACCA, _ACCFLO CALL SYSTEM.Char2Str SYSTEM._B2STR_WR0: LD _ACCA, -X TST _ACCA BREQ SYSTEM._B2STR_WR1 CALL SYSTEM.Char2Str SYSTEM._B2STR_WR1: LD _ACCA, -X ORI _ACCA, 30h CALL SYSTEM.Char2Str DEC _ACCELO BRNE SYSTEM._B2STR_WR0 SYSTEM._B2STR_WR2: BST Flags2, _F64StrInt BRTC SYSTEM._L0130 LDD _ACCA, Y+32 SYSTEM._B2STR_F4: TST _ACCA BREQ SYSTEM._L0130 LDI _ACCA, DECIMALSEP CALL SYSTEM.Char2Str SYSTEM._L0130: POP _ACCBHI POP _ACCBLO LDD _ACCA, Y+0 ST X+, _ACCA LDD _ACCA, Y+1 ST X+, _ACCA LDD _ACCA, Y+2 ST X+, _ACCA RET SYSTEM.Int2Str: PUSH _FRAMEPTR PUSH _FPTRHI SBIW _FRAMEPTR, 10 LDD XL, Y+13 LDD XH, Y+14 CLR _ACCFLO BST Flags, _SIGN BRTC SYSTEM._cv16_0 TST XH BRPL SYSTEM._cv16_0 LDI _ACCFLO, 2Dh SUBI XL, 01h SBCI XH, 00h COM XL COM XH SYSTEM._cv16_0: PUSH _ACCFLO mov r24, XH swap r24 andi r24, 0Fh subi r24, -0F0h and 0FFh mov r19, r24 add r19, r24 subi r24, -0E2h and 0ffh mov r18, r24 subi r24, -32h and 0ffh mov r16, r24 mov r24, XH andi r24, 0Fh add r18, r24 add r18, r24 add r16, r24 subi r24, -0E9h and $ff mov r17, r24 add r17, r24 add r17, r24 mov r24, XL swap r24 andi r24, 0Fh add r17, r24 add r16, r24 rol r17 rol r16 com r16 clc rol r16 mov r24, XL andi r24, 0Fh add r16, r24 rol r19 ldi r24, 07h mov r20, r24 ldi r24, 0Ah SYSTEM._cv16_1: add r16,r24 dec r17 brcc SYSTEM._cv16_1 SYSTEM._cv16_2: add r17, r24 dec r18 brcc SYSTEM._cv16_2 SYSTEM._cv16_3: add r18, r24 dec r19 brcc SYSTEM._cv16_3 SYSTEM._cv16_4: add r19, r24 dec r20 brcc SYSTEM._cv16_4 SYSTEM._cv16_5: MOVW _ACCBLO, _FRAMEPTR clr ZH ldi ZL, 16 ldi r25, 5 ldi r23, 0 SYSTEM._cv16_6: ld r24, Z+ st X+, r24 st X+, r23 dec r25 brne SYSTEM._cv16_6 LDD _ACCALO, Y+12 LDD _ACCAHI, Y+11 LDD _ACCDLO, Y+10 LDI _ACCDHI, 5 POP _ACCFLO MOVW _ACCCLO, _FRAMEPTR MOVW _ACCBLO, _FRAMEPTR ADIW XL, 15 RCALL SYSTEM._B2STR POP _FPTRHI POP _FRAMEPTR RET SYSTEM.Char2Str: PUSH _ACCCLO PUSH _ACCCHI BST Flags, _DEVICE BRTS SYSTEM._L0134 PUSH _ACCA LDD _ACCCLO, Y+001h LDD _ACCCHI, Y+002h LDD _ACCA, Y+000h TST _ACCA BRNE SYSTEM._L0131 POP _ACCA SET BLD Flags, _ERRFLAG POP _ACCCHI POP _ACCCLO RET SYSTEM._L0131: DEC _ACCA STD Y+000h, _ACCA POP _ACCA ST Z+, _ACCA STD Y+002h, _ACCCHI STD Y+001h, _ACCCLO POP _ACCCHI POP _ACCCLO RET SYSTEM._L0134: LDD _ACCCLO, Y+000h LDD _ACCCHI, Y+001h PUSH _ACCA PUSH _ACCB PUSH _ACCALO PUSH _ACCAHI PUSH _ACCBLO PUSH _ACCBHI PUSH _ACCELO PUSH _ACCEHI PUSH _ACCDLO PUSH _ACCDHI PUSH _ACCFLO PUSH _ACCFHI ICALL POP _ACCFHI POP _ACCFLO POP _ACCDHI POP _ACCDLO POP _ACCEHI POP _ACCELO POP _ACCBHI POP _ACCBLO POP _ACCAHI POP _ACCALO POP _ACCB POP _ACCA POP _ACCCHI POP _ACCCLO RET SYSTEM.DIV16: MOVW _ACCALO, _ACCB SYSTEM.DIV16_R: CLR _ACCDHI BST Flags, _SIGN BRTC SYSTEM._L0135 MOV _ACCDHI, _ACCBHI MOV _ACCDLO, _ACCAHI EOR _ACCDLO, _ACCBHI CLT SBRS _ACCDLO, 7 BLD Flags, _SIGN SBRS _ACCAHI, 7 RJMP SYSTEM._L0137 NEG _ACCALO BRNE SYSTEM._L0138 DEC _ACCAHI SYSTEM._L0138: COM _ACCAHI SYSTEM._L0137: SBRS _ACCBHI, 7 RJMP SYSTEM._L0135 NEG _ACCBLO BRNE SYSTEM._L0139 DEC _ACCBHI SYSTEM._L0139: COM _ACCBHI SYSTEM._L0135: CLR _ACCCLO SUB _ACCCHI, _ACCCHI LDI _ACCA, 17 SYSTEM._L0140: ROL _ACCBLO ROL _ACCBHI DEC _ACCA BRNE SYSTEM._L0141 MOVW _ACCB, _ACCBLO BST Flags, _SIGN BRTC SYSTEM._L0136 NEG _ACCB BRNE SYSTEM._L0143 DEC _ACCA SYSTEM._L0143: COM _ACCA SYSTEM._L0136: RET SYSTEM._L0141: ROL _ACCCLO ROL _ACCCHI SUB _ACCCLO, _ACCALO SBC _ACCCHI, _ACCAHI BRCC SYSTEM._L0142 ADD _ACCCLO, _ACCALO ADC _ACCCHI, _ACCAHI CLC RJMP SYSTEM._L0140 SYSTEM._L0142: SEC RJMP SYSTEM._L0140 SYSTEM.SetSysTimZ: CLI CLR _ACCA ST Z+, _ACCA ST Z+, _ACCA MOV _ACCA, _SYSTFLAGS AND _ACCA, _ACCB MOV _SYSTFLAGS, _ACCA SBRC Flags, IntFlag SEI RET SYSTEM.SetSysTimer: CLI ST Z+, _ACCB ST Z+, _ACCA MOV _ACCBLO, _SYSTFLAGS TST _ACCA BRNE SYSTEM._L0144 TST _ACCB BRNE SYSTEM._L0144 COM _ACCBHI AND _ACCBLO, _ACCBHI MOV _SYSTFLAGS, _ACCBLO SBRC Flags, IntFlag SEI RET SYSTEM._L0144: OR _ACCBLO, _ACCBHI MOV _SYSTFLAGS, _ACCBLO SBRC Flags, IntFlag SEI RET SYSTEM.DefIntErr: RETI .ROMCONST $ ; ============ String-constant tables ============ $St_String1: .BYTE 13 .ASCII "PanelTest 0" $St_String2: .BYTE 15 .ASCII "KeyboardPartner" $St_String3: .BYTE 3 .ASCII " " $St_String4: .BYTE 4 .ASCII "KNOB" $St_String5: .BYTE 4 .ASCII "DOWN" $St_String6: .BYTE 4 .ASCII "UP " $St_String7: .BYTE 4 .ASCII " " ; ============ Fixed addr String-constant tables ============ ; ============ fixed addr array-constant tables ============ ; ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ ; Reset and Interrupt vectors ; ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ .ENDCODE SYSTEM.ENDCODE: .ORG 000000h, VECTTAB .VECTTAB SYSTEM.VectTab: JMP SYSTEM.RESET JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.$INTERRUPT_TIMER1COMPA JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.$INTERRUPT_TIMER0 JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr JMP SYSTEM.DefIntErr .VECTTABE SYSTEM.ENDPROG: .END ; ============ End of Program ============ ; System uses registers ; from bottom = 00000h ; upto = 00006h ; and ; from = 00010h ; upto = 0001Fh ; ; Stackframe at = ...00192h ; ===== Current top of User Vars in Data is 0000Bh ===== ; ===== Current top of User Vars in IData is 00223h ===== ; ===== EEprom currently not used ===== ; ===== Imported Library Routines ===== ; Divide word DIV16 ; Convert int to string ; Pascal Statements : 58 ; Assembler Lines : 5196 ; Optimizer removed : 22 lines = 44Bytes ; >> real SysTick (exact): 9.984 msec <<