;********************************************************** ; general Subroutines ;********************************************************** ; ;***************** ; S E L F T E S T ;***************** ;selftest ; ; ; ; ;******************************** ; W A T C H D O G T O G G L E ;******************************** watchdog_toggle pshb ldab irq_wd_flag ; Watchdog Flag holen bne wdt_set_hi ; Data zuletzt auf Hi gesetzt? inc irq_wd_flag ; Dann jetzt auf Lo setzen ldab Port2_DDR_buf orab #%10 ; Data auf Ausgang stab Port2_DDR_buf stab Port2_DDR aim #%11111101,Port2_Data ;Data auf 0 pulb rts wdt_set_hi clr irq_wd_flag ldab Port2_DDR_buf andb #%11111101 ; Data auf Eingang/Hi stab Port2_DDR_buf stab Port2_DDR pulb rts watchdog_toggle2 ldab Port2_DDR_buf orab #%10 ; Data auf Ausgang stab Port2_DDR_buf stab Port2_DDR aim #%11111101,Port2_Data ;Data auf 0 nop nop ldab Port2_DDR_buf andb #%11111101 ; Data auf Eingang/Hi stab Port2_DDR_buf stab Port2_DDR rts ;*********************** ; W A T C H D O G L O ;*********************** watchdog_lo pshb ldab Port2_DDR_buf orab #%10 ; Data auf Ausgang stab Port2_DDR_buf stab Port2_DDR aim #%11111101,Port2_Data ;Data auf 0 pulb rts ;*********************** ; W A T C H D O G H I ;*********************** watchdog_hi pshb ldab Port2_DDR_buf andb #%11111101 ; Data auf Eingang/Hi stab Port2_DDR_buf stab Port2_DDR pulb rts ;************************ ; W A I T _ M S ;************************ wait_ms ; X : Time to wait in ms ; changed Regs: X pshb psha xgdx ; Wartezeit nach D addd tick_ms ; aktuellen Tickzähler addieren xgdx ; wieder nach X bcc wms_loop2 ; Kein Überlauf bei der Addition? Dann Sprung wms_loop1 cpx tick_ms ; Es gab einen Überlauf - Dann müssen wir warten bcs wms_loop1 ; bis tick_ms auch überläuft wms_loop2 cpx tick_ms ; und dann noch solange bis tick_ms bcc wms_loop2 ; größer ist als unsere Wartezeit pula pulb rts ;************************* ; P T T _ C H K ;************************* ; ; Parameter: none ; ; Ergebnis: B - 0=keine PTT, 1=PTT ; ; changed Regs: B ; ptt_chk ldab Port6_Data ; Port6 Data lesen andb #%10000000 ; alles ausser PTT Bit ausblenden bne ptc_on ; clrb bra ptc_end ptc_on ldab #1 ptc_end rts ;**************** ; S Q U E L C H ;**************** ; ; last change: 9.7.05 ; ; Parameter: none ; ; Ergebnis: none ; ; changed Regs: none ; ; ; ; squelch pshb psha ldab sql_timer bne cql_end ldab #122 stab sql_timer ldab Port5_Data andb #%01000000 ; Squelch Input auslesen cmpb sql_flag ; mit gespeicherten Werten vergleichen tpa stab sql_flag tap beq cql_end ; Keine Änderung -> nichts machen tstb ; Signal vorhanden beq sql_no_sig ; Wenn nicht, dann springen ldaa #%01111111 ldab #%10000000 jsr send2shift_reg ; RX Audio an bra cql_end sql_no_sig ldaa #%01111111 ldab #%00000000 jsr send2shift_reg ; RX Audio aus cql_end pula pulb rts ;********************** ; P W R S W C H K ;********************** ; ; Parameter: none ; ; Ergebnis: none ; ; changed Regs: none ; ; ; prüft den Ein-/Ausschalter und schaltet das Gerät ggf. aus (CPU in Standby Mode) ; pwr_sw_chk pshb psha ldab Port5_Data andb #%100 ;SWB+ ? beq still_on ldaa #%11101101 ldab #%00000000 jsr send2shift_reg ;Gerät ist aus, STBY&9,6V löschen ; hier sollte es NIE weitergehen, da das Gerät in den Stanby Mode gesetzt wird ; und erst mit einem Reset wieder "geweckt" wird still_on pula pulb rts ;************************ ; V C O S W I T C H ;************************ ; ; Parameter: B - RX:0 ; ; Ergebnis: none ; ; changed Regs: none ; vco_switch pshb psha pshx tstb ; TX oder RX? bne vcs_tx ; TX, dann jump aim #%11011111,Port2_Data ; für RX, Portbit löschen bra vcs_end vcs_tx oim #%00100000,Port2_Data ; Für TX, Portbit setzen vcs_end pulx pula pulb rts ;************************* ; C R C 1 6 ;************************* ; ; berechnet CRC16 über die angegebene Anzahl von Bytes ; ; Parameter : D - Bytecount ; X - Startadresse ; Stack - Initialisierungswert ; ; Ergebnis : D - CRC16 ; Stack - CRC16 ; crc16 pshx ; Startadresse sichern tsx addd 0,x ; Bytecount + Adresse pshb psha ; Endadresse sichern ldd 4,x ; Initialisierungswert/CRC holen ldx 0,x ; Startadresse holen crc_loop pshx ; Adresse sichern pshb ; CRC LoByte sichern eora 0,x ; CRC/HiByte XOR Datenbyte tab ; nach B kopieren (wird Index für Tabelle) ldx #crc_table ; Basisadresse der CRC Tabelle holen abx ; abx ; Index 2* addieren (2 Byte pro Eintrag) pula ; CRC LoByte holen -> wird HiByte (8 Bit Shift) ldab 1,x ; neues CRC LoByte eora 0,x ; Mit Wert aus Tabelle verknüpfen, neues CRC Byte berechnen pulx ; Adresse holen pshb psha ; CRC sichern inx ; Adresse erhöhen pshx ; Adresse sichern xgdx tsx subd 4,x ; Endadresse erreicht? pulx ; Adresse wiederholen pula pulb ; CRC wiederholen bne crc_loop ; loop bis Endadresse erreicht... pulx ; Startadresse vom Stack löschen tsx std 4,x ; CRC auf Stack speichern, Initialisierungswert überschreiben pulx ; Endadresse vom Stack löschen rts crc_rom .db "123456789" crc_init .dw $1D0F ; Initialisierungswert für "non-augmented message" ($FFFF für "augmented messages") crc_table ; CCIT / ITU CRC-16 .dw $0000, $1021, $2042, $3063, $4084, $50a5, $60c6, $70e7 ;00 .dw $8108, $9129, $a14a, $b16b, $c18c, $d1ad, $e1ce, $f1ef ;08 .dw $1231, $0210, $3273, $2252, $52b5, $4294, $72f7, $62d6 ;10 .dw $9339, $8318, $b37b, $a35a, $d3bd, $c39c, $f3ff, $e3de ;18 .dw $2462, $3443, $0420, $1401, $64e6, $74c7, $44a4, $5485 ;20 .dw $a56a, $b54b, $8528, $9509, $e5ee, $f5cf, $c5ac, $d58d ;28 .dw $3653, $2672, $1611, $0630, $76d7, $66f6, $5695, $46b4 ;30 .dw $b75b, $a77a, $9719, $8738, $f7df, $e7fe, $d79d, $c7bc ;38 .dw $48c4, $58e5, $6886, $78a7, $0840, $1861, $2802, $3823 ;40 .dw $c9cc, $d9ed, $e98e, $f9af, $8948, $9969, $a90a, $b92b ;48 .dw $5af5, $4ad4, $7ab7, $6a96, $1a71, $0a50, $3a33, $2a12 ;50 .dw $dbfd, $cbdc, $fbbf, $eb9e, $9b79, $8b58, $bb3b, $ab1a ;58 .dw $6ca6, $7c87, $4ce4, $5cc5, $2c22, $3c03, $0c60, $1c41 ;60 .dw $edae, $fd8f, $cdec, $ddcd, $ad2a, $bd0b, $8d68, $9d49 ;68 .dw $7e97, $6eb6, $5ed5, $4ef4, $3e13, $2e32, $1e51, $0e70 ;70 .dw $ff9f, $efbe, $dfdd, $cffc, $bf1b, $af3a, $9f59, $8f78 ;78 .dw $9188, $81a9, $b1ca, $a1eb, $d10c, $c12d, $f14e, $e16f ;80 .dw $1080, $00a1, $30c2, $20e3, $5004, $4025, $7046, $6067 ;88 .dw $83b9, $9398, $a3fb, $b3da, $c33d, $d31c, $e37f, $f35e ;90 .dw $02b1, $1290, $22f3, $32d2, $4235, $5214, $6277, $7256 ;98 .dw $b5ea, $a5cb, $95a8, $8589, $f56e, $e54f, $d52c, $c50d ;A0 .dw $34e2, $24c3, $14a0, $0481, $7466, $6447, $5424, $4405 ;A8 .dw $a7db, $b7fa, $8799, $97b8, $e75f, $f77e, $c71d, $d73c ;B0 .dw $26d3, $36f2, $0691, $16b0, $6657, $7676, $4615, $5634 ;B8 .dw $d94c, $c96d, $f90e, $e92f, $99c8, $89e9, $b98a, $a9ab ;C0 .dw $5844, $4865, $7806, $6827, $18c0, $08e1, $3882, $28a3 ;C8 .dw $cb7d, $db5c, $eb3f, $fb1e, $8bf9, $9bd8, $abbb, $bb9a ;D0 .dw $4a75, $5a54, $6a37, $7a16, $0af1, $1ad0, $2ab3, $3a92 ;D8 .dw $fd2e, $ed0f, $dd6c, $cd4d, $bdaa, $ad8b, $9de8, $8dc9 ;E0 .dw $7c26, $6c07, $5c64, $4c45, $3ca2, $2c83, $1ce0, $0cc1 ;E8 .dw $ef1f, $ff3e, $cf5d, $df7c, $af9b, $bfba, $8fd9, $9ff8 ;F0 .dw $6e17, $7e36, $4e55, $5e74, $2e93, $3eb2, $0ed1, $1ef0 ;F8