AVR 系列单片机汇编 数值运算子程序

showmaker

;***************************************************************************
6 K$ l( M) `0 {;*
;* "mpy16u" - 16x16 Bit Unsigned Multiplication
;*
" q6 y# u7 {3 Z% g* o;* This subroutine multiplies the two 16-bit register variables
0 _  f1 Y# L1 D/ D- Z1 M& x2 U;* mp16uH:mp16uL and mc16uH:mc16uL.
7 T- k' @; L$ m: ]/ {, j;* The result is placed in m16u3:m16u2:m16u1:m16u0.
8 P+ j& F$ Q% y' ]% s/ R/ t6 \;*
- ^, L3 Q8 C0 Z; B+ h;* Number of words        :14 + return
4 J% H! Y* t0 C; c7 i7 k. {5 B;* Number of cycles        :153 + return
3 k* k3 [7 p% u' }8 I  u& Q0 T;* Low registers used        :None
;* High registers used  :7 (mp16uL,mp16uH,mc16uL/m16u0,mc16uH/m16u1,m16u2,
3 k  S& f; B' C: P0 h1 d3 M2 Y5 ];*                          m16u3,mcnt16u)
;*
;***************************************************************************
7 m( n5 ?( E9 M# ]
;***** Subroutine Register Variables

.def        mc16uL        =r16                ;multiplicand low byte
.def        mc16uH        =r17                ;multiplicand high byte
.def        mp16uL        =r18                ;multiplier low byte
.def        mp16uH        =r19                ;multiplier high byte
.def        m16u0        =r18                ;result byte 0 (LSB)
! e. m0 K; X/ Y8 j* d.def        m16u1        =r19                ;result byte 1
8 A: Y1 u- ~, S, {  W9 r8 t+ a.def        m16u2        =r20                ;result byte 2
.def        m16u3        =r21                ;result byte 3 (MSB)
.def        mcnt16u        =r22                ;loop counter

1 i1 W+ n  `5 K& T# C;***** Code
0 x1 p/ n( h: W' J/ c  ?2 T) g
+ f- x" P' A1 r0 vmpy16u:        clr        m16u3                ;clear 2 highest bytes of result
        clr        m16u2
        ldi        mcnt16u,16        ;init loop counter
& @" W! ?4 b7 F7 n( j6 x3 [        lsr        mp16uH
! A1 a. n, ?6 H& V6 l: J' W        ror        mp16uL
/ {: c1 U# b! ^/ F; @" v. d+ S
& l6 Q7 m' \0 q3 X2 H9 ~m16u_1:        brcc        noad8                ;if bit 0 of multiplier set
) x0 l0 b0 H2 ]7 t        add        m16u2,mc16uL        ;add multiplicand Low to byte 2 of res
2 B2 ^1 i2 C+ V( M) a+ z        adc        m16u3,mc16uH        ;add multiplicand high to byte 3 of res
noad8:        ror        m16u3                ;shift right result byte 3
  U+ A1 k5 K9 O3 x, U6 w7 o1 Z        ror        m16u2                ;rotate right result byte 2
        ror        m16u1                ;rotate result byte 1 and multiplier High
. m( J! B' k3 o        ror        m16u0                ;rotate result byte 0 and multiplier Low
        dec        mcnt16u                ;decrement loop counter
  H+ M4 g. O1 ^        brne        m16u_1                ;if not done, loop more
8 @/ ]4 A! }8 D3 k0 _5 n# Z        ret




: t& M; s+ V/ K' `3 `+ N# q;......................

;被除数：R19（HIGH）R18 R17 R16（LOW）
7 V1 d9 U  _/ n( R$ g( {
7 ?( s1 ^2 X3 @+ P; a0 u1 @. Z;除数：R21（HIGH）R20

6 P0 C9 Q* r9 @) o' V;结果：R17（HIGH）R16
8 X* _  w9 g! m* S+ U  V- S;余数：R19（HIGH）R18
;计数器，R22
4 @: K) o; v# C. q6 }1 k+ @9 J2 a, \/ w9 u
/ C2 Q% S% n$ R- d;...................................................
) Q/ x+ p. e0 V; L, {+ S& zd32v16u:                   ; 32位/16位无符号除法
, O- x! F3 U! E        cp r18,r20         ;被除数高16位 > 除数
        cpc r19,r21        ;结果溢出
        brcc        cc            
8 E$ k2 w' W9 o; Y+ h        ldi r22,$10        ;初始化循环计数器
1 u' g. F* g( |        rol r16            ;左移被除数
; V  z2 _3 `2 z  A- M# x        rol r17
aa:
/ W9 c9 _# F. B7 N5 G        rol r18            ;左移余数（被除数移到除数）
- V$ C0 P9 A( ^$ c+ J( z8 d: \        bst r19,7
9 f% x4 m! l) X6 y5 t9 P1 z' m        rol r19
8 q' O8 N9 r9 G+ |$ j7 P        sub r18,r20        ;余数－除数
6 [) \7 e! X" z' l6 F4 t1 a        sbc r19,r21
        brts         loop       ;够减，跳至 loop
        brcc         loop
        add r18,r20        ;不够减，再加除数
        adc r19,r21
        clc                ;清进位位
        rjmp         loop1
loop:
        sec                ;置进位位
loop1:
6 p% c0 x; m3 u        rol r16            ;左移结果
5 ]& g( Q2 D% B: W& R        rol r17
  F4 Y9 g; Z8 p  J; u" ~$ b        dec r22            ;计数器减 1
        brne        aa         ;不为 0，再循环
        clt                ;清 t 标志
  ]( m9 y# A" H* V        ret
+ t0 B) W2 b. G9 t9 ucc:
        set                ;置 t 标志
        ret

;...................................
6 n6 n  ~6 e, U; c5 Z

# I; n& O. x; @

& E* j+ r+ `! K/ z
# R. J: a' r! d5 Q+ ?
3 q. p6 f6 T, g/ o* b" [5 X7 i

1 S' q% h6 g! V3 R# P
; b0 o- y0 G( C
3 ?" |1 L% V0 D  {" z4 ?3 X9 S: d
4 {6 u# I6 B/ B2 R4 |;......................

+ C8 w; g! ]; {;被除数：R17（HIGH） R16（LOW）

$ G. y4 _6 j8 c0 I* J;除数：R21（HIGH）R20
% H' R$ K) `  _0 u7 C, q
;结果：R17（HIGH）R16
! \8 _4 }7 h2 i& W;余数：R19（HIGH）R18
2 L5 ]% v) V  B$ n% ?5 P;计数器，R22

;...................................................
% t8 U. z9 H* X; P% |: X' A, {2 ud16v16u:                   ; 32位/16位无符号除法
;        cp r18,r20         ;被除数高16位 > 除数
;        cpc r19,r21        ;结果溢出
;        brcc        cc            
      
        clr r19
. ~4 G/ h7 L5 \6 d, N, b+ `* L        clr r18
      
        ldi r22,$10        ;初始化循环计数器
        rol r16            ;左移被除数
1 W8 o" I1 h; O+ i, l) h        rol r17
7 L; L" \* ?1 C3 Nvaa:
        rol r18            ;左移余数（被除数移到除数）
7 b5 B( E) L8 [! }9 \        bst r19,7
4 }: K2 T8 t- j- r: p, @  n, F        rol r19
        sub r18,r20        ;余数－除数
; A# K9 _5 ^7 N9 a/ `. Y0 i        sbc r19,r21
" U% a6 j* T! f* X8 `, s. B) l6 s        brts         vloop       ;够减，跳至 loop
        brcc         vloop
$ D9 ]9 L$ d6 y$ v/ f        add r18,r20        ;不够减，再加除数
. T" s# z* A+ _' I        adc r19,r21
+ A2 ~7 u1 R# Y% P7 }( I        clc                ;清进位位
        rjmp         vloop1
vloop:
        sec                ;置进位位
vloop1:
        rol r16            ;左移结果
2 Q6 [7 [0 ]% R: g; J        rol r17
        dec r22            ;计数器减 1
- N) R5 b: Y* Z+ e6 d# P) P1 S        brne        vaa         ;不为 0，再循环
& Z. m2 t, r' j+ Q( f5 _  A9 K5 z        clt                ;清 t 标志
9 a3 t' X& H% S7 N! S% i+ o# A  ]$ }        ret
* z; y% j# A1 n7 A;cc:
;       set                ;置 t 标志
# `' q  N5 z  W3 q;        ret
0 N4 {$ ]8 }4 B  K" N1 z  }4 g

;..............................




; r6 p. i! @$ r
3 n) H# n0 Z/ x( G" q9 q
  r% x3 e/ }7 }( |" h% W& M
, `( `) n7 u! t1 Z) R6 M/ l. e
% ?0 |6 D7 b3 u+ c

;...r17:r16(hex)--->r20(万位）:r19（千位）:r18（百位）:r17（十位）:r16(bcd)
                   ; 结果值在每字节里只存一位，即在每字节的低半字节里      
;.....................;调用16位二进制转5位十进制子程
b16td5:
8 c1 O* {+ i9 m4 g( s; c        ser r20              ;r20先送－1
. S* ~0 n6 j1 t" E* \b16td5_1:  
8 P& D8 p; n( n" _  j        inc r20              ;r20增1
. {  r/ c; u2 B4 @5 A8 p    subi r16,low(10000)  ;（r17：r16）－10000
$ P" s& s  Y4 p0 G4 c. W        sbci r17,high(10000)
        brcc         b16td5_1     ;够减则返回b16td5_1
        subi r16,low(-10000) ;不够减+10000，恢复余数
        sbci r17,high(-10000)
2 U# v( W" k. q( {        ser r19              ;r19先送－1
3 ]2 M7 ~/ |/ q& y* `9 G( Db16td5_2:
' T8 F# Z  Y# n% T        inc r19              ;r19增1   
        subi r16,low(1000)   ;（r17：r16）－1000
8 k  k- T% x% b/ R- u        sbci r17,high(1000)            
        brcc         b16td5_2     ;够减则返回b16td5_2
$ K! @9 r/ f- P        subi r16,low(-1000)  ;不够减+1000，恢复余数
        sbci r17,high(-1000)
: p( _$ x6 i, b2 p8 n        ser r18              ;r18先送－1
b16td5_3:
1 V5 C3 C7 F+ ?" t) K% c: @- p9 x        inc r18              ;r18增1   
subi r16,low(100)            ;（r17：r16）－100
        sbci r17,high(100)            
        brcc         b16td5_3     ;够减则返回b16td5_3
        subi r16,low(-100)   ;不够减+100，恢复余数
" [! [' X, j+ w, {: `        sbci r17,high(-100)
+ O' |* H% X/ V# w* Z( q8 R        ser r17              ;r17先送－1
( r4 C( E9 \) S5 yb16td5_4:
8 p- _; V7 a: m- P2 R$ r+ ^        inc r17              ;r17增1
        subi r16,10          ;（r17：r16）－10         
7 k) p& b7 d: L4 r' K' l        brcc         b16td5_4     ;够减则返回b16td5_4               
( O% j  G8 o' A0 U& `        subi r16,-10         ;不够减+10，恢复余数
    ret
;...........................................


( f0 ^& X; M6 o9 ^
  j$ O. N' Z+ P6 J6 O* P0 j
9 O. m- M. X$ z

& D0 \2 _) D' j) a
;...............;r16(high)r19(low)/r17 =r16(结果)+r19(余数)

d16v8u:                 ;16/8无符号除法
        cp r16,r17      ;被除数高字节 > 除数   
        brcc   ddd      ;结果溢出
6 C, ]0 ]3 s. V; T, }' G% w        ldi r18,8       ;初始化循环计数器
2 b5 a" q2 @+ }# T# t" J        rol r19         ;左移余数（被除数低字节）
$ V: w: g! E9 {$ [7 Saaa:
  {/ O# ~- M. A2 O        bst r16,7
        rol r16         ;左移被除数高字节
        sub r16,r17     ;r16减r17
7 b) J' _$ E, K/ P7 |        brts        bbb
4 F' s' s  k" v9 g7 j        brcc        bbb
, @( N- e$ A' q6 }5 Z' |. ]        add r16,r17     ;结果为负，则r16加r17
        clc             ;清进位位
        rjmp        ccc
bbb:
' C. X6 N. G' L1 k2 h2 E3 X+ \# i        sec             ;够减，置进位位
ccc:
        rol r19         ;左移余数
( a: c8 {4 B  r1 @        dec r18         ;减计数器
        brne        aaa     ;没完成再循环
$ m7 O0 m$ c) E. m' [( R" r        clc
        mov r17,r16        
        mov r16,r19     ;r16存放结果
        mov r19,r17     ;r19存放余数
! F4 m! \! \  j        ret
, n% ]- T, O9 J) ^$ t$ zddd:
        set
9 R) g5 b+ b: Q% D8 A. o/ R        ret
2 J4 U* y: N  ]* q$ {( x. n, E) H
2 v- _/ r# v0 z;..................................
; ]. c) h% A! E0 e; M

xiaoming11

学习了  感谢分享

grand

代码感觉很有条理