inital commit
This commit is contained in:
parent
f1853c097c
commit
92144104ec
2
bcd.h
2
bcd.h
@ -10,5 +10,7 @@ void bcd_invert(__idata uint8_t *v1, uint8_t len);
|
||||
void bcd_addbyte(__idata uint8_t *v1, uint8_t len, uint8_t b) __reentrant;
|
||||
uint8_t bcd_getsig(__idata uint8_t*v, uint8_t len);
|
||||
|
||||
void long_tobcd(__idata uint8_t *binval, __idata uint8_t *bcdval, uint8_t binlen, uint8_t bcdlen) __reentrant;
|
||||
|
||||
#endif
|
||||
|
||||
|
33
long_add.c
Normal file
33
long_add.c
Normal file
@ -0,0 +1,33 @@
|
||||
#include "mc8051fun.h"
|
||||
#include "bcd.h"
|
||||
|
||||
#pragma disable_warning 59 // Disable "must return a value" warning
|
||||
|
||||
uint8_t long_add(__idata uint8_t *v1, __idata uint8_t *v2,uint8_t len) __reentrant
|
||||
{
|
||||
(void)v1; (void)v2; (void)len;
|
||||
__asm
|
||||
mov a,_bp
|
||||
add a,#0xfd
|
||||
mov sp,a
|
||||
pop ar1
|
||||
pop ar7
|
||||
mov ar0,dpl
|
||||
clr c
|
||||
001$:
|
||||
mov a,@r0
|
||||
addc a,@r1
|
||||
mov @r0,a
|
||||
inc r0
|
||||
inc r1
|
||||
djnz r7,001$
|
||||
mov dpl,#0x00
|
||||
jnc $002
|
||||
inc dpl
|
||||
$002:
|
||||
mov sp,_bp
|
||||
__endasm;
|
||||
}
|
||||
|
||||
|
||||
|
24
long_rlc__.c
Normal file
24
long_rlc__.c
Normal file
@ -0,0 +1,24 @@
|
||||
|
||||
/*
|
||||
* @r0 = number
|
||||
* r7 = len
|
||||
*
|
||||
* modyfies: r0,r7,a
|
||||
*/
|
||||
static void long_rlc__() __naked
|
||||
{
|
||||
__asm
|
||||
.globl long_rlc
|
||||
|
||||
long_rlc:
|
||||
mov a,@r0
|
||||
rlc a
|
||||
mov @r0,a
|
||||
inc r0
|
||||
djnz r7,long_rlc
|
||||
ret
|
||||
|
||||
__endasm;
|
||||
}
|
||||
|
||||
|
29
long_rrc__.c
Normal file
29
long_rrc__.c
Normal file
@ -0,0 +1,29 @@
|
||||
|
||||
/*
|
||||
* @r0 = number
|
||||
* r7 = len
|
||||
*
|
||||
* modyfies: r0,r7,a
|
||||
*/
|
||||
static void long_rrc__() __naked
|
||||
{
|
||||
__asm
|
||||
.globl long_rrc
|
||||
long_rrc:
|
||||
push PSW
|
||||
mov a,r0
|
||||
add a,r7
|
||||
mov r0,a
|
||||
pop PSW
|
||||
001$:
|
||||
dec r0
|
||||
mov a,@r0
|
||||
rrc a
|
||||
mov @r0,a
|
||||
djnz r7,001$
|
||||
ret
|
||||
|
||||
__endasm;
|
||||
}
|
||||
|
||||
|
33
long_tobcd.c
Normal file
33
long_tobcd.c
Normal file
@ -0,0 +1,33 @@
|
||||
|
||||
#include "mc8051fun.h"
|
||||
|
||||
/*
|
||||
* C-Wrapper for long_tobcd
|
||||
*/
|
||||
|
||||
void long_tobcd(__idata uint8_t *binval, __idata uint8_t *bcdval, uint8_t binlen, uint8_t bcdlen) __reentrant
|
||||
{
|
||||
(void)binval;
|
||||
(void)bcdval;
|
||||
(void)binlen;
|
||||
(void)bcdlen;
|
||||
|
||||
__asm
|
||||
mov a,_bp
|
||||
add a,#0xfd
|
||||
mov r0,a
|
||||
mov a,@r0
|
||||
mov r1,a
|
||||
dec r0
|
||||
mov a,@r0
|
||||
mov r7,a
|
||||
dec r0
|
||||
mov a,@r0
|
||||
mov r6,a
|
||||
mov r0,dpl
|
||||
lcall long_tobcd
|
||||
|
||||
__endasm;
|
||||
}
|
||||
|
||||
|
92
long_tobcd__.c
Normal file
92
long_tobcd__.c
Normal file
@ -0,0 +1,92 @@
|
||||
|
||||
/*
|
||||
r0 = bin
|
||||
r1 = bcd
|
||||
r7 = len of bin
|
||||
r6 = len of bcd
|
||||
*/
|
||||
|
||||
#include "mc8051fun.h"
|
||||
|
||||
#include "usebank0.h"
|
||||
|
||||
// double dabble
|
||||
|
||||
void long_tobcd__() __naked
|
||||
{
|
||||
__asm
|
||||
.globl long_tobcd
|
||||
|
||||
long_tobcd:
|
||||
|
||||
; fill dst with zeroes
|
||||
|
||||
mov r3,AR1 ; save r1 in r3
|
||||
mov r4,AR6 ; use r4 as counter
|
||||
; mov a,#0x00
|
||||
|
||||
000$:
|
||||
mov @r1,#0x0
|
||||
inc r1
|
||||
djnz r4,000$
|
||||
|
||||
|
||||
|
||||
mov a,r0
|
||||
add a,r7
|
||||
dec a
|
||||
mov r0,a ; r0 points to last byte of bin
|
||||
mov r2,AR0 ; save r0 in r2
|
||||
|
||||
006$:
|
||||
mov a,@r0
|
||||
mov r5,#0x08
|
||||
005$:
|
||||
mov r4,AR6 ; use r4 as counter
|
||||
mov r1,AR3
|
||||
|
||||
push ACC
|
||||
004$:
|
||||
mov a,@r1
|
||||
acall 003$
|
||||
acall 003$
|
||||
mov @r1,a
|
||||
inc r1
|
||||
djnz r4,004$
|
||||
|
||||
pop ACC
|
||||
|
||||
|
||||
rlc a
|
||||
push ACC
|
||||
push AR0
|
||||
push AR7
|
||||
mov r7,AR6
|
||||
mov r0,AR3
|
||||
lcall long_rlc
|
||||
pop AR7
|
||||
pop AR0
|
||||
pop ACC
|
||||
djnz r5,005$
|
||||
|
||||
|
||||
dec r0
|
||||
djnz r7,006$
|
||||
ret
|
||||
|
||||
|
||||
003$:
|
||||
swap a
|
||||
clr c
|
||||
subb a,#0x50
|
||||
jc 002$
|
||||
add a,#0x30
|
||||
002$:
|
||||
add a,#0x50
|
||||
ret
|
||||
|
||||
__endasm;
|
||||
}
|
||||
|
||||
|
||||
|
21
usebank0.h
Normal file
21
usebank0.h
Normal file
@ -0,0 +1,21 @@
|
||||
|
||||
#undef AR0
|
||||
#undef AR1
|
||||
#undef AR2
|
||||
#undef AR3
|
||||
#undef AR4
|
||||
#undef AR5
|
||||
#undef AR6
|
||||
#undef AR7
|
||||
|
||||
|
||||
#define AR0 0x00
|
||||
#define AR1 0x01
|
||||
#define AR2 0x02
|
||||
#define AR3 0x03
|
||||
#define AR4 0x04
|
||||
#define AR5 0x05
|
||||
#define AR6 0x06
|
||||
#define AR7 0x07
|
||||
|
||||
|
Loading…
Reference in New Issue
Block a user