39 lines
446 B
C
39 lines
446 B
C
#include "bcd.h"
|
|
|
|
|
|
#pragma disable_warning 59 // Disable "must return a value" warning
|
|
|
|
void bcd_shr(__idata uint8_t *v, uint8_t len, uint8_t d) __reentrant
|
|
{
|
|
(void)v; (void)len, (void)d;
|
|
|
|
__asm
|
|
mov a,_bp
|
|
add a,#0xfd
|
|
mov sp,a
|
|
|
|
pop ar7 ; r7 = len
|
|
pop B ;
|
|
mov a,dpl
|
|
add a,r7
|
|
mov r0,a
|
|
001$:
|
|
dec r0
|
|
mov a,@r0
|
|
swap a
|
|
mov r6,a
|
|
anl a,#0x0f
|
|
orl a,b
|
|
mov @r0,a
|
|
mov a,r6
|
|
anl a,#0xf0
|
|
mov b,a
|
|
djnz r7,001$
|
|
|
|
mov sp,_bp
|
|
|
|
__endasm;
|
|
}
|
|
|
|
|