Compare commits
3 Commits
6153bb3fb4
...
master
Author | SHA1 | Date | |
---|---|---|---|
5761d5c513 | |||
71a551d028 | |||
ffeea2dfaf |
5
Makefile
5
Makefile
@ -29,7 +29,10 @@ LIBSRC = uart_init_.c uart_send_chr.c uart_send_str.c \
|
||||
bcd_tolong__.c bcd_tolong.c \
|
||||
long_addbyte__.c long_addbyte.c \
|
||||
long_add__.c long_add.c \
|
||||
long_1cpl__.c long_invert__.c long_invert.c
|
||||
long_1cpl__.c long_invert__.c long_invert.c \
|
||||
long_sub__.c \
|
||||
long_div__.c long_div.c \
|
||||
long_fill__.c long_mul__.c long_mul.c
|
||||
|
||||
|
||||
LIBOBJ =$(patsubst %.c,%.rel, $(LIBSRC))
|
||||
|
@ -11,6 +11,7 @@ uint8_t long_add(__idata uint8_t *v1, __idata uint8_t *v2,uint8_t len) __reentra
|
||||
add a,#0xfd
|
||||
mov r0,a
|
||||
mov a,@r0 ; *v2
|
||||
dec r0
|
||||
mov r1,a
|
||||
mov a,@r0 ; len
|
||||
mov r7,a
|
||||
|
@ -6,6 +6,8 @@
|
||||
static void long_add__() __naked
|
||||
{
|
||||
__asm
|
||||
.globl long_add
|
||||
.globl long_addc
|
||||
long_add:
|
||||
clr c
|
||||
long_addc:
|
||||
|
34
long_div.c
Normal file
34
long_div.c
Normal file
@ -0,0 +1,34 @@
|
||||
#include "mc8051fun.h"
|
||||
#include "bcd.h"
|
||||
|
||||
#pragma disable_warning 59 // Disable "must return a value" warning
|
||||
|
||||
|
||||
void long_div(__idata uint8_t *v1, __idata uint8_t *v2,
|
||||
__idata uint8_t *result, __idata uint8_t *rest, uint8_t len) __reentrant
|
||||
{
|
||||
|
||||
(void)v1; (void)v2; (void)len;
|
||||
(void)result; (void)rest;
|
||||
|
||||
__asm
|
||||
mov a,_bp
|
||||
add a,#0xfd
|
||||
mov r0,a
|
||||
mov a,@r0 ; *v2
|
||||
dec r0
|
||||
mov r1,a
|
||||
mov a,@r0 ; *result
|
||||
dec r0
|
||||
mov r2,a
|
||||
mov a,@r0 ; *rest
|
||||
dec r0
|
||||
mov r3,a
|
||||
mov a,@r0 ; len
|
||||
mov r7,a
|
||||
mov r0,dpl ; *v1
|
||||
lcall long_div
|
||||
__endasm;
|
||||
|
||||
}
|
||||
|
67
long_div__.c
Normal file
67
long_div__.c
Normal file
@ -0,0 +1,67 @@
|
||||
#include "mc8051fun.h"
|
||||
|
||||
/*
|
||||
* r0 = numerator
|
||||
* r1 = denominator
|
||||
* r2 = quotient (result)
|
||||
* r3 = rest
|
||||
* r7 = length in bytes
|
||||
*/
|
||||
static void long_div__() __naked
|
||||
{
|
||||
__asm
|
||||
.globl long_div
|
||||
long_div:
|
||||
|
||||
mov r5,AR7 ;#0x01
|
||||
push AR0
|
||||
mov r0,AR3
|
||||
; lcall long_xset_zero
|
||||
pop AR0
|
||||
|
||||
|
||||
mov r4,AR1
|
||||
mov a,r0
|
||||
add a,r5 ;#DIGITS-1
|
||||
mov r0,a
|
||||
003$:
|
||||
mov a,@r0
|
||||
mov r6,#8
|
||||
002$:
|
||||
rlc a
|
||||
push ACC
|
||||
push AR0
|
||||
|
||||
mov r0,AR3 ;#_rest
|
||||
mov r7,AR5 ;#DIGITS
|
||||
lcall long_rlc
|
||||
|
||||
mov r0,AR3 ;#_rest
|
||||
mov r7,AR5 ;#DIGITS
|
||||
push AR1
|
||||
lcall long_sub
|
||||
pop AR1
|
||||
|
||||
jnc 001$
|
||||
mov r0,AR3 ;#_rest
|
||||
mov r7,AR5 ;#DIGITS
|
||||
push AR1
|
||||
lcall long_add
|
||||
pop AR1
|
||||
setb c
|
||||
001$:
|
||||
cpl c
|
||||
mov r0,AR2 ; #_result
|
||||
mov r7,AR5 ;#DIGITS
|
||||
lcall long_rlc
|
||||
|
||||
pop AR0
|
||||
pop ACC
|
||||
djnz r6,002$
|
||||
djnz r0,003$
|
||||
ret
|
||||
|
||||
__endasm;
|
||||
}
|
||||
|
||||
|
19
long_fill__.c
Normal file
19
long_fill__.c
Normal file
@ -0,0 +1,19 @@
|
||||
|
||||
|
||||
void long_fill() __naked
|
||||
{
|
||||
__asm
|
||||
.globl long_fill_zero
|
||||
.globl long_fill
|
||||
|
||||
long_fill_zero:
|
||||
mov a,#0x00
|
||||
long_fill:
|
||||
mov @r0,a
|
||||
inc r0
|
||||
djnz r7,long_fill
|
||||
ret
|
||||
__endasm;
|
||||
}
|
||||
|
||||
|
28
long_mul.c
Normal file
28
long_mul.c
Normal file
@ -0,0 +1,28 @@
|
||||
#include "mc8051fun.h"
|
||||
|
||||
uint8_t long_mul(__idata uint8_t *v1, __idata uint8_t *v2,uint8_t len, __idata uint8_t *result) __reentrant
|
||||
{
|
||||
(void)v1; (void)v2; (void)len,(void)result;
|
||||
__asm
|
||||
mov a,_bp
|
||||
add a,#0xfd
|
||||
mov r0,a
|
||||
mov a,@r0 ; *v2
|
||||
dec r0
|
||||
mov r1,a
|
||||
mov a,@r0 ; len
|
||||
mov r7,a
|
||||
dec r0
|
||||
mov a,@r0 ; result
|
||||
mov r2,a
|
||||
mov r0,dpl
|
||||
lcall long_mul
|
||||
mov dpl,#0x00
|
||||
jnc $002
|
||||
inc dpl
|
||||
$002:
|
||||
__endasm;
|
||||
}
|
||||
|
||||
|
||||
|
55
long_mul__.c
Normal file
55
long_mul__.c
Normal file
@ -0,0 +1,55 @@
|
||||
#include "mc8051fun.h"
|
||||
|
||||
/*
|
||||
* val0,val1 = r0,r1
|
||||
* r2 = result
|
||||
* r7 = len of val0,val1
|
||||
*/
|
||||
void long_mul__() __naked
|
||||
{
|
||||
|
||||
__asm
|
||||
.globl long_mul
|
||||
|
||||
long_mul:
|
||||
push AR0
|
||||
push AR7
|
||||
mov r0,AR2
|
||||
lcall long_fill_zero
|
||||
pop AR7
|
||||
pop AR0
|
||||
|
||||
mov r6,#8
|
||||
mov a,@r1
|
||||
000$:
|
||||
rrc a
|
||||
jnc 001$
|
||||
|
||||
push ACC
|
||||
push AR0
|
||||
push AR1
|
||||
push AR7
|
||||
mov r1,AR0
|
||||
mov r0,AR2
|
||||
lcall long_add
|
||||
pop AR7
|
||||
pop AR1
|
||||
pop AR0
|
||||
pop ACC
|
||||
|
||||
001$:
|
||||
push ACC
|
||||
push AR7
|
||||
push AR0
|
||||
clr c
|
||||
lcall long_rlc
|
||||
pop AR0
|
||||
pop AR7
|
||||
pop ACC
|
||||
|
||||
djnz r6,000$
|
||||
ret
|
||||
__endasm;
|
||||
}
|
||||
|
||||
|
25
long_sub__.c
Normal file
25
long_sub__.c
Normal file
@ -0,0 +1,25 @@
|
||||
|
||||
/**
|
||||
* @r0=@r0-@r1
|
||||
* r7=len
|
||||
*/
|
||||
static void long_sub() __naked
|
||||
{
|
||||
__asm
|
||||
.globl long_sub
|
||||
.globl long_subb
|
||||
long_sub:
|
||||
clr c
|
||||
long_subb:
|
||||
mov a,@r0
|
||||
subb a,@r1
|
||||
mov @r0,a
|
||||
inc r0
|
||||
inc r1
|
||||
djnz r7,long_xsubb
|
||||
ret
|
||||
|
||||
__endasm;
|
||||
}
|
||||
|
||||
|
@ -91,6 +91,7 @@ uint8_t multest(uint8_t a, uint8_t b);
|
||||
void bcd_tolong(__idata uint8_t *bcdval, __idata uint8_t *binval, uint8_t bcdlen, uint8_t binlen) __reentrant;
|
||||
void long_invert(__idata uint8_t *val, uint8_t len) __reentrant;
|
||||
uint8_t long_add(__idata uint8_t *v1, __idata uint8_t *v2,uint8_t len) __reentrant;
|
||||
uint8_t long_mul(__idata uint8_t *v1, __idata uint8_t *v2,uint8_t len, __idata uint8_t *result) __reentrant;
|
||||
|
||||
|
||||
#endif
|
||||
|
Reference in New Issue
Block a user