diff options
| -rw-r--r-- | RawDoFmt.S | 51 |
1 files changed, 29 insertions, 22 deletions
@@ -19,6 +19,9 @@ SECTION text,CODE + INCLUDE "relcustom.i" + + XDEF RawDoFmtFunc,_RawPrintfFunc RB_LEFTALIGNED: EQU 0 ; Flag-Definitionen @@ -42,7 +45,7 @@ MainLoop: move.b (a4)+,d0 ; Nächstes Zeichen beq.s Ende ; fertig ---> cmpi.b #'%',d0 beq.s DoFormat -DirectOut: jsr (a2) ; Zeichen direkt ausgeben +DirectOut: jsr (a2) ; Zeichen direkt ausgeben (schrottet d1) bra.s MainLoop ; ---> Ende: jsr (a2) ; Endzeichen ausgeben @@ -327,38 +330,42 @@ Filler: move.b #' ',d2 ; Füllcode: Space * This function may be called at any time, including * interrupts. * -* Bryce Nesbitt, 02-24-89 +* Bryce Nesbitt, 02-24-89, enhanced by CHW! * ************************************************************************* XDEF _RawPrintfFunc -_RawPrintfFunc: movem.l a0/a1,-(SP) - move.l 4*3(SP),A0 ;grab format string - lea.l 4*4(SP),A1 ;grab stack address of parameters - movem.l A2/A3/D0/D1,-(SP) - lea.l PSCODE(pc),a2 - suba.l a3,a3 +_RawPrintfFunc: movem.l d0-d1/a0-a3,-(SP) + move.l 4*7(SP),a0 ; grab format string + lea 4*8(SP),a1 ; grab stack address of parameters + lea serputchar(pc),a2 + lea custom,a3 ; will be available in serputchar bsr RawDoFmtFunc - movem.l (SP)+,D0/D1/A2/A3 - movem.l (SP)+,a0/a1 + movem.l (SP)+,d0-d1/a0-a3 rts + *** called by RawDoFmt, d0=char to write, a3=custom + +serputchar: tst.b d0 + beq.s .ignore + +.wait: move.w serdatr(a3),d1 ; serdatr + btst #13,d1 ; transmit buffer empty? + beq.s .wait ; not yet ---> wait -PSCODE: tst.b d0 - beq.s ignore -1$ move.w $DFF018,d1 ;_serdatr - btst #13,d1 ;TBE bit - beq.s 1$ and.b #$7f,d1 - cmp.b #$18,d1 ;Check for CAN (^X) - beq.s ignore - cmp.b #$13,d1 ;Check for Xoff - beq.s 1$ + cmp.b #$18,d1 ; Check for CAN (^X) + beq.s .ignore + cmp.b #$13,d1 ; Check for Xoff + beq.s .wait ; --> wait + and.w #$ff,d0 - or.w #$100,d0 - move.w d0,$DFF030 ;_serdat -ignore: rts + or.w #$100,d0 ; add stop bit + move.w d0,serdat(a3) +.ignore: + rts + ***************************************************************************** |