#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;
}