You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
136 lines
2.4 KiB
136 lines
2.4 KiB
#include "libmfuart0.h"
|
|
#define uart_txfree uart0_txfree
|
|
#define uart_rxcount uart0_rxcount
|
|
#define uart_wait_txfree uart0_wait_txfree
|
|
#define _uart_wait_txfree _uart0_wait_txfree
|
|
#define uart_wait_rxcount uart0_wait_rxcount
|
|
#define uart_txbufptr uart0_txbufptr
|
|
#define _uart_txbufptr _uart0_txbufptr
|
|
#define uart_txfreelinear uart0_txfreelinear
|
|
#define _uart_txfreelinear _uart0_txfreelinear
|
|
#define uart_rxpeek uart0_rxpeek
|
|
#define uart_txpokehex uart0_txpokehex
|
|
#define uart_txpoke uart0_txpoke
|
|
#define uart_rxadvance uart0_rxadvance
|
|
#define uart_txadvance uart0_txadvance
|
|
#define _uart_txadvance _uart0_txadvance
|
|
#define uart_rx uart0_rx
|
|
#define uart_tx uart0_tx
|
|
#define uart_writestr uart0_writestr
|
|
#define uart_writehexu16 uart0_writehexu16
|
|
#define uart_writehexu32 uart0_writehexu32
|
|
#define uart_writeu16 uart0_writeu16
|
|
#define uart_writeu32 uart0_writeu32
|
|
|
|
#if defined(SDCC)
|
|
|
|
__reentrantb void uart_writestr(const char __generic *ch) __reentrant
|
|
{
|
|
ch;
|
|
__asm;
|
|
mov r0,dpl
|
|
mov r7,dph
|
|
clr a
|
|
mov r3,a
|
|
mov r2,a
|
|
00000$: jb _B_7,00010$ ; >0x80 code
|
|
jnb _B_6,00011$ ; <0x40 far
|
|
jb _B_5,00012$ ; >0x60 pdata
|
|
;; idata
|
|
mov a,@r0
|
|
inc r0
|
|
sjmp 00013$
|
|
00010$: ;; code
|
|
mov dpl,r0
|
|
mov dph,r7
|
|
clr a
|
|
movc a,@a+dptr
|
|
inc dptr
|
|
mov r0,dpl
|
|
mov r7,dph
|
|
sjmp 00013$
|
|
00011$: ;; xdata
|
|
mov dpl,r0
|
|
mov dph,r7
|
|
movx a,@dptr
|
|
inc dptr
|
|
mov r0,dpl
|
|
mov r7,dph
|
|
sjmp 00013$
|
|
00012$: ;; pdata
|
|
movx a,@r0
|
|
inc r0
|
|
00013$: jz 00001$
|
|
mov r1,a
|
|
mov a,r3
|
|
jnz 00002$
|
|
mov a,r2
|
|
jz 00003$
|
|
mov dpl,a
|
|
lcall _uart_txadvance
|
|
00003$: lcall _uart_txfreelinear
|
|
mov a,dpl
|
|
jnz 00004$
|
|
mov r4,b
|
|
mov dpl,#1
|
|
lcall _uart_wait_txfree
|
|
mov b,r4
|
|
lcall _uart_txfreelinear
|
|
mov a,dpl
|
|
00004$: mov r3,a
|
|
clr a
|
|
mov r2,a
|
|
mov dpl,a
|
|
lcall _uart_txbufptr
|
|
mov r4,dpl
|
|
mov r5,dph
|
|
00002$: mov dpl,r4
|
|
mov dph,r5
|
|
mov a,r1
|
|
movx @dptr,a
|
|
inc dptr
|
|
mov r4,dpl
|
|
mov r5,dph
|
|
inc r2
|
|
dec r3
|
|
sjmp 00000$
|
|
00001$: mov a,r2
|
|
jz 00005$
|
|
mov dpl,a
|
|
lcall _uart_txadvance
|
|
00005$:
|
|
__endasm;
|
|
}
|
|
|
|
#else
|
|
|
|
__reentrantb void uart_writestr(const char __generic *ch) __reentrant
|
|
{
|
|
uint8_t __xdata *p;
|
|
uint8_t f = 0;
|
|
uint8_t a = 0;
|
|
for (;;) {
|
|
char c = *ch++;
|
|
if (!c)
|
|
break;
|
|
if (!f) {
|
|
if (a)
|
|
uart_txadvance(a);
|
|
f = uart_txfreelinear();
|
|
if (!f) {
|
|
uart_wait_txfree(1);
|
|
f = uart_txfreelinear();
|
|
}
|
|
p = uart_txbufptr(0);
|
|
a = 0;
|
|
}
|
|
*p++ = c;
|
|
++a;
|
|
--f;
|
|
}
|
|
if (a)
|
|
uart_txadvance(a);
|
|
}
|
|
|
|
#endif
|