Микроконтроллеры

Смотри внутри исходник. Нашел его за 7 секунд. Научись сначала интернетом пользоваться ;***************************************************************** ;* * ;* Maths Subroutines for the 8051 microcontroller * ;* W.G.Marshall 2002 * ;* * ;***************************************************************** ; All parameters in Register bank 0, (r0 to r7) ; Bits 21H and 22H reserved for sign bits ;================================================================= ; subroutine Cr0 ; 8-Bit 2's Complement -> magnitude / Sign Bit Conversion ; ; input: r0 = signed byte ; ; output: r0 = magnitude ; Bit 21H = sign (21H is set if r0 is a negative number) ; ; alters: acc ;================================================================= Cr0: mov a, r0 ; read X into accumulator jb acc.7, Cr0a ; X is negative if bit 7 is 1 clr 21H ; clear sign bit if 'positive' ret ; done Cr0a: cpl a ; X negative, find abs value inc a ; XA = complement(XT)+1 mov r0, a ; save magnitude setb 21H ; set sign bit if 'negative' ret ;================================================================= ; subroutine Cr1 ; 8-Bit 2's Complement -> magnitude / Sign Bit Conversion ; ; input: r1 = signed byte ; ; output: r1 = magnitude ; Bit 22H = sign (22H is set if r1 is a negative number) ; ; alters: acc ;================================================================= Cr1: mov a, r1 ; read X into accumulator jb acc.7, Cr1a ; X is negative if bit 7 is 1 clr 22H ; clear sign bit if 'positive' ret ; done Cr1a: cpl a ; X negative, find abs value inc a ; XA = complement(XT)+1 mov r1, a ; save magnitude setb 22H ; set sign bit if 'negative' ret ;=================================================================== ; subroutine Cr0r1 ; 16-Bit 2's Complement -> magnitude / Sign Bit Conversion ; ; input: r1, r0 = signed word ; ; output: r1, r0 = magnitude ; Bit 21H = sign (21H is set if negative number) ; ; alters: acc, C ;=================================================================== Cr0r1: mov a, r1 ; high byte into accumulator jb acc.7, c0a ; negative if bit 7 is 1 clr 21H ; clear sign bit if 'positive' ret ; done c0a: setb 21H ; set sign flag mov a, r0 ; number is negative cpl a ; complement add a, #1 ; and add +1 mov r0, a mov a, r1 ; get next byte cpl a ; complement addc a, #0 mov r1, a ret ;==================================================================== ; subroutine Cr2r3 ; 16-Bit 2's Complement -> magnitude / Sign Bit Conversion ; ; input: r3, r2 = signed word ; ; output: r3, r2 = magnitude ; Bit 22H = sign (22H is set if negative number) ; ; alters: acc, C ;==================================================================== Cr2r3: mov a, r3 ; read high into accumulator jb acc.7, c1a ; negative if bit 7 is 1 clr 22H ; clear sign bit if 'positive' ret ; done c1a: setb 22H ; set sign flag mov a, r2 ; number is negative cpl a ; complement add a, #1 ; and add +1 mov r2, a mov a, r3 ; get next byte cpl a ; complement addc a, #0 mov r3, a ret ;==================================================================== ; subroutine Cr4r5 ; 16-Bit 2's Complement -> magnitude / Sign Bit Conversion ; ; input: r5, r4 = signed word ; ; output: r5, r4 = magnitude ; Bit 22H = sign (22H is set if negative number) ; ; alters: acc, C ;==================================================================== Cr4r5: mov a, r5 ; read high into accumulator jb acc.7, c3a ; negative if bit 7 is 1 clr 22H ; clear sign bit if 'positive' ret ; done c3a: setb 22H ; set sign flag mov a, r4 ; number is negative cpl a ; complement add a, #1 ; and add +1 mov r4, a mov a, r5 ; get next byte cpl a ; complement addc a, #0 mov r5, a ret ;==================================================================== ; subroutine Cr0r3 ; 32-Bit 2's Complement -> magnitude / Sign Bit Conversion ; ; input: r3, r2, r1, r0 = signed word ; ; output: r3, r2, r1, r0 = magnitude ; Bit 21H = sign (21H is set if negative number) ; ; alters: acc ;==================================================================== Cr0r3: mov a, r3 ; read high into accumulator jb acc.7, c2a ; negative if bit 7 is 1 clr 21H ; clear sign flag if 'positive' ret ; done c2a: setb 21H ; set sign flag mov a, r0 ; number is negative cpl a ; complement add a, #1 ; and add +1 mov r0, a mov a, r1 ; get next byte cpl a ; complement addc a, #0 mov r1,a mov a, r2 ; get next byte cpl a ; complement addc a, #0 mov r2,a mov a, r3 ; get next byte cpl a ; complement addc a, #0 mov r3, a ret ; done ;================================================================== ; subroutine Mr0 ; 8-Bit magnitude / Sign Bit -> 2's Complement Conversion ; ; input: r0 = magnitude ; Bits 21H & 22H = sign bits of operands X and Y ; (set if negative) ; ; output: r0 = signed byte ; ; alters: acc ;================================================================== Mr0: jb 21H, Mr0b ; test X sign jb 22H, Mr0a ; test Y sign ret Mr0b: jnb 22H, Mr0a ret Mr0a: mov a, r0 ; if r0 negative, get abs value cpl a ; complement magnitude of X inc a ; r0 = complement(r0)+1 mov r0, a ; save in 2's complement ret ; done ;==================================================================== ; subroutine Mr0r1 ; 16-Bit magnitude / Sign Bit -> 2's Complement Conversion ; ; input: r1, r0 = magnitude ; Bits 21H & 22H = sign bits of operands X and Y ; (set if negative) ; ; output: r1, r0 = signed word ; ; alters: acc, C ;==================================================================== Mr0r1: jb 21H, Mr0r1b ; test X sign jb 22H, Mr0r1a ; test Y sign ret Mr0r1b: jnb 22H, Mr0r1a ret Mr0r1a: mov a, r0 ; negate number cpl a ; complement add a, #1 ; and add +1 mov r0, a mov a, r1 ; get next byte cpl a ; complement addc a, #0 mov r1, a ret ;==================================================================== ; subroutine Mr0r3 ; 32-Bit magnitude / Sign Bit -> 2's Complement Conversion ; ; input: r3, r2, r1, r0 = magnitude ; Bits 21H & 22H = sign bits of operands X and Y ; (set if negative) ; ; output: r3, r2, r1, r0 = signed word ; ; alters: acc, C ;==================================================================== Mr0r3: jb 21H, Mr0r3b ; test X sign jb 22H, Mr0r3a ; test Y sign ret Mr0r3b: jnb 22H, Mr0r3a ret Mr0r3a: mov a, r0 ; negate number cpl a ; complement add a, #1 ; and add +1 mov r0, a mov a, r1 ; get next byte cpl a ; complement addc a, #0 mov r1, a mov a, r2 ; get next byte cpl a ; complement addc a, #0 mov r2, a mov a, r3 ; get next byte cpl a ; complement addc a, #0 mov r3, a ret ; done ;==================================================================== ; subroutine CONV816 ; 8-bit Signed number to 16-Bit Signed number conversion ; ; input: r0 = X ; ; output: r1, r0 = X with sign extended to 16 bits ; ; alters: acc ;==================================================================== CONV816: mov A, r0 jnb acc.7, Pos mov r1, #0FFH ret Pos: mov r1, #0 ret ;==================================================================== ; subroutine ADD16 ; 16-Bit Signed (2's Complement) Addition ; ; input: r1, r0 = X ; r3, r2 = Y ; ; output: r1, r0 = signed sum S = X + Y ; Carry C is set if the result (S) is out of range ; ; alters: acc, C, OV ;==================================================================== ADD16: anl PSW, #0E7H ; Register Bank 0 mov a, r0 ; load X low byte into acc add a, r2 ; add Y low byte mov r0, a ; put result in Z low byte mov a, r1 ; load X high byte into acc addc a, r3 ; add Y high byte with carry mov r1, a ; save result in Z high byte mov C, OV ret ;==================================================================== ; subroutine ADD32 ; 32-Bit Signed (2's Complement) Addition ; ; input: r3, r2, r1, r0 = X ; r7, r6, r5, r4 = Y ; ; output: r3, r2, r1, r0 = signed sum S = X + Y ; Carry C is set if the result (S) is out of range ; ; alters: acc, C, OV ;==================================================================== ADD32: anl PSW, #0E7H ; Register Bank 0 mov a, r0 ; load X low byte into acc add a, r4 ; add Y low byte mov r0, a ; save result mov a, r1 ; load X next byte into acc addc a, r5 ; add Y next byte with carry mov r1, a ; save result mov a, r2 ; load X next byte into acc addc a, r6 ; add Y next byte mov r2, a ; save result mov a, r3 ; load X high byte into acc addc a, r7 ; add Y high byte with carry mov r3, a mov C, OV ret ;==================================================================== ; subroutine SUB16 ; 16-Bit Signed (2's Complement) Subtraction ; ; input: r1, r0 = X ; r3, r2 = Y ; ; output: r1, r0 = signed difference D = X - Y ; Carry C is set if the result (D) is out of range. ; ; alters: acc, C, OV ;==================================================================== SUB16: anl PSW, #0E7H ; Register Bank 0 mov a, r0 ; load X low byte into acc clr C ; clear carry flag subb a, r2 ; subract Y low byte mov r0, a ; put result in Z low byte mov a, r1 ; load X high into accumulator subb a, r3 ; subtract Y high with borrow mov r1, a ; save result in Z high byte mov C, OV ret ;==================================================================== ; subroutine SUB32 ; 32-Bit Signed (2's Complement) subtraction ; ; input: r3, r2, r1, r0 = X ; r7, r6, r5, r4 = Y ; ; output: r3, r2, r1, r0 = signed difference D = X - Y ; Carry C is set if the result (D) is out of range. ; ; alters: acc, C, OV ;==================================================================== SUB32: anl PSW, #0E7H ; Register Bank 0 mov a, r0 ; load X low byte into acc clr C ; clear carry flag subb a, r4 ; subract Y low byte mov r0, a ; put result in Z low byte mov a, r1 ; repeat with other bytes... subb a, r5 mov r1, a mov a, r2 subb a, r6 mov r2, a mov a, r3 subb a, r7 mov r3, a mov C, OV ; set C if external borrow ret ;================================================================== ; subroutine MUL8 ; 8-Bit x 8-Bit to 16-Bit Product Signed Multiply ; 2's Complement format ; ; input: r0 = multiplicand X ; r1 = multiplier Y ; ; output: r1, r0 = product P = X x Y. ; ; calls: UMUL8, Cr0, Cr1, Mr0r1 ; ; alters: acc, C, Bits 21H & 22H ;================================================================== MUL8: anl PSW, #0E7H ; Register Bank 0 acall Cr0 ; 2's comp -> Mag/Sign acall Cr1 ; 2's comp -> Mag/Sign acall UMUL8 acall Mr0r1 ; Mag/Sign -> 2's Comp ret ;================================================================== ; subroutine UMUL8 ; 8-Bit x 8-Bit to 16-Bit Product Unsigned Multiply ; ; input: r0 = multiplicand X ; r1 = multiplier Y ; ; output: r1, r0 = product P = X x Y. ; ; alters: acc ;================================================================== UMUL8: push b mov a, r0 ; read X and ... mov b, r1 ; ... Y mul ab ; multiply X and Y mov r1, b ; save result high ... mov r0, a ; ... and low pop b ret ;==================================================================== ; subroutine MUL816 ; 8-Bit x 16-Bit to 32-Bit Product signed Multiply ; 2's Complement format ; ; input: r0 = multiplicand X ; r3, r2 = multiplier Y ; ; output: r3, r2, r1, r0 = product P = X x Y (r3 = sign extension) ; ; calls: Cr0, Cr2r3, Mr0r3 ; ; alters: acc, C, Bits 21H & 22H ;==================================================================== MUL816: push b anl PSW, #0E7H ; Register Bank 0 acall Cr0 ; 2's comp -> Mag/Sign acall Cr2r3 ; 2's comp -> Mag/Sign mov a, r0 ; load X low byte into acc mov b, r2 ; load Y low byte into B mul ab ; multiply push acc ; stack result low byte push b ; stack result high byte mov a, r0 ; load X into acc again mov b, r3 ; load Y high byte into B mul ab ; multiply pop 00H ; recall X*YL high byte add a, r0 ; add X*YL high and X*YH low mov r1, a ; save result clr a ; clear accumulator addc a, b ; a = b + carry flag mov r2, a ; save result pop 00H ; get low result mov r3, #0 acall Mr0r3 ; Mag/Sign -> 2's Comp pop b ret ;==================================================================== ; subroutine MUL16 ; 16-Bit x 16-Bit to 32-Bit Product Signed Multiply ; 2's Complement format ; ; input: r1, r0 = multiplicand X ; r3, r2 = multiplier Y ; ; output: r3, r2, r1, r0 = product P = X x Y ; ; calls: UMUL16, Cr0r1, Cr2r3, Mr0r3 ; ; alters: acc, C, Bits 21H & 22H ;==================================================================== MUL16: anl PSW, #0E7H ; Register Bank 0 acall Cr0r1 ; 2's comp -> Mag/Sign acall Cr2r3 ; 2's comp -> Mag/Sign acall UMUL16 acall Mr0r3 ; Mag/Sign -> 2's Comp ret ;==================================================================== ; subroutine UMUL16 ; 16-Bit x 16-Bit to 32-Bit Product Unsigned Multiply ; ; input: r1, r0 = multiplicand X ; r3, r2 = multiplier Y ; ; output: r3, r2, r1, r0 = product P = X x Y ; ; alters: acc, C ;==================================================================== UMUL16: push B push dpl mov a, r0 mov b, r2 mul ab ; multiply XL x YL push acc ; stack result low byte push b ; stack result high byte mov a, r0 mov b, r3 mul ab ; multiply XL x YH pop 00H add a, r0 mov r0, a clr a addc a, b mov dpl, a mov a, r2 mov b, r1 mul ab ; multiply XH x YL add a, r0 mov