Compare commits

...

3 Commits

Author SHA1 Message Date
5761d5c513 Added long_mul function 2024-07-14 23:43:05 +02:00
71a551d028 Fix dec for next arg 2024-07-03 07:37:44 +02:00
ffeea2dfaf New functions 2024-07-03 07:37:01 +02:00
10 changed files with 236 additions and 1 deletions

View File

@ -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))

View File

@ -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

View File

@ -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
View 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
View 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
View 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
View 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
View 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
View 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;
}

View File

@ -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