Added long_mul function

Makefile

@@ -25,7 +25,15 @@ LIBSRC = uart_init_.c uart_send_chr.c uart_send_str.c \
 	 multest.c \
 	 bcd_add.c bcd_getsig.c bcd_invert.c bcd_9cpl.c bcd_addbyte.c bcd_shr.c \
 	long_rrc__.c long_rlc__.c \
-	long_tobcd__.c long_tobcd.c
+	long_tobcd__.c long_tobcd.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_sub__.c \
+       long_div__.c	long_div.c  \
+       long_fill__.c long_mul__.c long_mul.c
+
 
 LIBOBJ =$(patsubst %.c,%.rel, $(LIBSRC))
 LIBNAME=mc8051fun.lib

bcd_tolong.c

@@ -0,0 +1,33 @@
+#include "mc8051fun.h"
+
+/*
+ * C-Wrapper for bcd_tolong
+ */
+
+void bcd_tolong(__idata uint8_t *bcdval, __idata uint8_t *binval, uint8_t bcdlen, uint8_t binlen) __reentrant
+{
+	(void)binval;
+	(void)bcdval;
+	(void)binlen;
+	(void)bcdlen;
+
+	__asm
+	mov	a,_bp
+	add	a,#0xfd
+	mov	r0,a
+	mov	a,@r0		; binval
+	mov	r1,a		
+	dec	r0
+	mov	a,@r0		; bcdlen
+	mov	r7,a
+	dec	r0		
+	mov	a,@r0		; binlen
+	mov	r6,a
+	mov	r0,dpl		; bcdval
+	lcall	bcd_tolong
+			
+	__endasm;
+}
+
+
+

bcd_tolong__.c

@@ -0,0 +1,67 @@
+#include "usebank0.h"
+/*
+r0 = bcd
+r1 = bin
+r7 = len of bcd
+r6 = len of bin
+
+
+reverse double dabble
+*/
+ 
+static void bcd_tolong__() __naked
+{
+
+	__asm
+
+	.globl	bcd_tolong
+bcd_tolong:
+	mov	a,AR6		; use r4 as counter
+	mov	b,#0x08
+	mul	ab
+	mov	r4,a
+
+
+000$:
+	push	AR0
+	push	AR7
+	clr	c
+
+	lcall	long_rrc
+	mov	r0,AR1
+	mov	r7,AR6
+
+	lcall	long_rrc
+	pop	AR7
+	pop	AR0
+	push	AR0
+	push 	AR7
+	
+001$:
+	mov	a,@r0
+	acall	003$
+	acall	003$
+	mov	@r0,a
+
+	inc 	r0
+	djnz	r7,001$
+	pop	AR7
+	pop	AR0
+	djnz	r4,000$
+	ret				
+003$:
+	swap	a
+	clr	c
+	subb	a,#0x80
+	jc	002$
+	subb	a,#0x30
+002$:
+	add	a,#0x80
+	ret
+	
+	__endasm;
+
+}
+
+
+

long_1cpl__.c

@@ -0,0 +1,22 @@
+
+#include "mc8051fun.h"
+
+static void long_1cpl__() __naked
+{
+	__asm
+	.globl	long_1cpl
+
+long_1cpl:
+
+	clr	c
+001$:	
+	mov	a,#0xff
+	subb	a,@r0
+	mov	@r0,a
+	inc	r0
+	djnz	r7,001$
+	ret
+
+	__endasm;	
+}
+

long_add.c

@@ -9,23 +9,18 @@ uint8_t long_add(__idata uint8_t *v1, __idata uint8_t *v2,uint8_t len) __reentra
 	__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	r0,a
+	mov	a,@r0		; *v2
+	dec	r0
+	mov	r1,a
+	mov	a,@r0		; len
+	mov	r7,a		
+	mov	r0,dpl
+	lcall	long_invert
 	mov	dpl,#0x00
 	jnc	$002
 	inc	dpl
 $002:
-	mov	sp,_bp
 	__endasm;
 }
 

long_add__.c

@@ -0,0 +1,27 @@
+/*
+ * @r0 = @r0+@r1
+ * r7=len
+ */
+
+static void long_add__() __naked
+{
+	__asm
+	.globl	long_add
+	.globl	long_addc
+long_add:
+	clr	c
+long_addc:
+001$:		
+	mov	a,@r0
+	addc	a,@r1
+	mov	@r0,a
+	inc	r0
+	inc	r1
+	djnz	r7,001$
+	ret
+
+	__endasm;
+}
+
+
+

long_addbyte.c

@@ -0,0 +1,26 @@
+#include "mc8051fun.h"
+
+/**
+ * C wrapper for long_addbyte 
+ */
+
+static void long_addbyte(__idata uint8_t * val, uint8_t len, uint8_t b) __reentrant
+{
+	(void)val;
+	(void)b;
+
+	__asm
+	mov	a,_bp
+	add	a,#0xfd
+	mov	r0,a
+	mov	a,@r0		; len
+	mov	r7,a
+	dec	r0
+	mov	a,@r0		; b
+	mov	r0,dpl
+	lcall	long_addbyte
+			
+	__endasm;
+	
+}
+

long_addbyte__.c

@@ -0,0 +1,23 @@
+/*
+ * a = byte to add
+ * @r0 = long val
+ * r7 = length
+ *
+ */
+static void long_addbyte__() __naked
+{
+	__asm
+	.globl	long_addbyte
+long_addbyte:
+	clr	c
+	ajmp	002$
+001$:
+	mov	a,#0x00
+002$:
+	addc	a,@r0
+	mov	@r0,a
+	inc	r0
+	djnz	r7,001$	
+	ret
+	__endasm;
+}

long_div.c

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

long_div__.c

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

long_fill__.c

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

long_invert.c

@@ -0,0 +1,21 @@
+#include "mc8051fun.h"
+
+void long_invert(__idata uint8_t *val, uint8_t len) __reentrant
+{
+	(void)val;
+	(void)len;
+
+	__asm
+
+	mov	a,_bp
+	add	a,#0xfd
+	mov	r0,a
+	mov	a,@r0		; len
+	mov	r7,a		
+	mov	r0,dpl
+	lcall	long_invert
+	__endasm;
+
+
+}
+

long_invert__.c

@@ -0,0 +1,22 @@
+#include "mc8051fun.h"
+
+static void long_invert__() __naked
+{
+	__asm
+
+	.globl	long_invert
+long_invert:
+	push 	AR0
+	push	AR7
+
+	lcall	long_1cpl
+
+	pop	AR7
+	pop	AR0
+
+	mov	a,#0x01
+	lcall	long_addbyte
+	ret
+	__endasm;
+
+}

long_mul.c

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

long_mul__.c

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

long_sub__.c

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

mc8051fun.h

@@ -88,6 +88,10 @@ uint8_t getport(int n);
 
 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