Blame | Last modification | View Log | RSS feed
1 # 1 "isqrt.S"1 ;-----------------------------------------------------------------------------;002 ;-----------------------------------------------------------------------------;3 ; Fast integer squareroot routines for avr-gcc project (C)ChaN, 20084 ; http://elm-chan.org/docs/avrlib/sqrt32.S5 ;-----------------------------------------------------------------------------;6 ; uint16_t isqrt32 (uint32_t n);7 ; uint8_t isqrt16 (uint16_t n);8 ; uint16_t ihypot (int16_t x, int16_t y);910 ;-----------------------------------------------------------------------------:11 ; 32bit integer squareroot12 ;-----------------------------------------------------------------------------;13 ; uint16_t isqrt32 (14 ; uint32_t n15 ; );16 ;17 ; Return Value:18 ; Squareroot of n.19 ;20 ; Size = 53 words21 ; Clock = 532..548 cycles22 ; Stack = 0 byte2324 .global isqrt3225 .func isqrt322627:isqrt.S **** isqrt32:28:isqrt.S **** clr r029:isqrt.S **** clr r1830:isqrt.S **** clr r1931:isqrt.S **** clr r2032:isqrt.S **** ldi r21, 133:isqrt.S **** clr r2734:isqrt.S **** clr r3035:isqrt.S **** clr r3136:isqrt.S **** ldi r26, 1637:isqrt.S **** 1: lsl r2238:isqrt.S **** rol r2339:isqrt.S **** rol r2440:isqrt.S **** rol r2541:isqrt.S **** rol r042:isqrt.S **** rol r1843:isqrt.S **** rol r1944:isqrt.S **** rol r2045:isqrt.S **** lsl r2246:isqrt.S **** rol r2347:isqrt.S **** rol r2448:isqrt.S **** rol r2549:isqrt.S **** rol r050:isqrt.S **** rol r1851:isqrt.S **** rol r1952:isqrt.S **** rol r2053:isqrt.S **** brpl 2f54:isqrt.S **** add r0, r2155:isqrt.S **** adc r18, r2756:isqrt.S **** adc r19, r3057:isqrt.S **** adc r20, r3158:isqrt.S **** rjmp 3f59:isqrt.S **** 2: sub r0, r2160:isqrt.S **** sbc r18, r2761:isqrt.S **** sbc r19, r3062:isqrt.S **** sbc r20, r3163:isqrt.S **** 3: lsl r2164:isqrt.S **** rol r2765:isqrt.S **** rol r3066:isqrt.S **** andi r21, 0b1111100067:isqrt.S **** ori r21, 0b0000010168:isqrt.S **** sbrc r20, 769:isqrt.S **** subi r21, 270:isqrt.S **** dec r2671:isqrt.S **** brne 1b72:isqrt.S **** lsr r3073:isqrt.S **** ror r2774:isqrt.S **** ror r2175:isqrt.S **** lsr r3076:isqrt.S **** ror r2777:isqrt.S **** ror r2178:isqrt.S **** mov r24, r2179:isqrt.S **** mov r25, r2780 ret81 .endfunc82838485 ;-----------------------------------------------------------------------------:86 ; 16bit integer squareroot87 ;-----------------------------------------------------------------------------;88 ; uint8_t isqrt16 ( uint16_t n );89 ;90 ; Return Value:91 ; Squareroot of n.92 ;93 ; Size = 33 words94 ; Clock = 181..189 cycles95 ; Stack = 0 byte9697 .global isqrt1698 .func isqrt1699100:isqrt.S **** isqrt16:101:isqrt.S **** clr r18102:isqrt.S **** clr r19103:isqrt.S **** ldi r20, 1104:isqrt.S **** clr r21105:isqrt.S **** ldi r22, 8106:isqrt.S **** 1: lsl r24107:isqrt.S **** rol r25108:isqrt.S **** rol r18109:isqrt.S **** rol r19110:isqrt.S **** lsl r24111:isqrt.S **** rol r25112:isqrt.S **** rol r18113:isqrt.S **** rol r19114:isqrt.S **** brpl 2f115:isqrt.S **** add r18, r20116:isqrt.S **** adc r19, r21117:isqrt.S **** rjmp 3f118:isqrt.S **** 2: sub r18, r20119:isqrt.S **** sbc r19, r21120:isqrt.S **** 3: lsl r20121:isqrt.S **** rol r21122:isqrt.S **** andi r20, 0b11111000123:isqrt.S **** ori r20, 0b00000101124:isqrt.S **** sbrc r19, 7125:isqrt.S **** subi r20, 2126:isqrt.S **** dec r22127:isqrt.S **** brne 1b128:isqrt.S **** lsr r21129:isqrt.S **** ror r20130:isqrt.S **** lsr r21131:isqrt.S **** ror r20132:isqrt.S **** mov r24, r20133 ret134 .endfunc135136137138 ;-----------------------------------------------------------------------------:139 ; 16bit integer hypot (megaAVR is required)140 ;-----------------------------------------------------------------------------;141 ; uint16_t ihypot (142 ; int16_t x,143 ; int16_t y144 ; );145 ;146 ; Return Value:147 ; Squareroot of (x*x + y*y)148 ;149 ; Size = 42 words150 ; Clock = 581..597 cycles151 ; Stack = 0 byte152153 .global ihypot154 .func ihypot155156:isqrt.S **** ihypot:157:isqrt.S **** clr r26158:isqrt.S **** sbrs r25, 7159:isqrt.S **** rjmp 1f160:isqrt.S **** com r24161:isqrt.S **** com r25162:isqrt.S **** adc r24, r26163:isqrt.S **** adc r25, r26164:isqrt.S **** 1: sbrs r23, 7165:isqrt.S **** rjmp 2f166:isqrt.S **** com r22167:isqrt.S **** com r23168:isqrt.S **** adc r22, r26169:isqrt.S **** adc r23, r26170:isqrt.S **** 2: mul r22, r22171:isqrt.S **** movw r18, r0172:isqrt.S **** mul r23, r23173:isqrt.S **** movw r20, r0174:isqrt.S **** mul r22, r23175:isqrt.S **** add r19, r0176:isqrt.S **** adc r20, r1177:isqrt.S **** adc r21, r26178:isqrt.S **** add r19, r0179:isqrt.S **** adc r20, r1180:isqrt.S **** adc r21, r26181:isqrt.S **** mul r24, r24182:isqrt.S **** movw r30, r0183:isqrt.S **** mul r25, r25184:isqrt.S **** add r18, r30185:isqrt.S **** adc r19, r31186:isqrt.S **** adc r20, r0187:isqrt.S **** adc r21, r1188:isqrt.S **** mul r24, r25189:isqrt.S **** add r19, r0190:isqrt.S **** adc r20, r1191:isqrt.S **** adc r21, r26192:isqrt.S **** add r19, r0193:isqrt.S **** adc r20, r1194:isqrt.S **** adc r21, r26195:isqrt.S **** movw r24, r20196:isqrt.S **** movw r22, r18197:isqrt.S **** clr r1198 rjmp isqrt32DEFINED SYMBOLSisqrt.S:26 .text:00000000 isqrt32isqrt.S:99 .text:0000006a isqrt16isqrt.S:155 .text:000000ac ihypotNO UNDEFINED SYMBOLS