Details | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 1131 | krheinwald | 1 | 1 .file "pitch_md.c" |
| 2 | 2 __SREG__ = 0x3f |
||
| 3 | 3 __SP_H__ = 0x3e |
||
| 4 | 4 __SP_L__ = 0x3d |
||
| 5 | 5 __CCP__ = 0x34 |
||
| 6 | 6 __tmp_reg__ = 0 |
||
| 7 | 7 __zero_reg__ = 1 |
||
| 8 | 8 .global __do_copy_data |
||
| 9 | 9 .global __do_clear_bss |
||
| 10 | 10 .text |
||
| 11 | 11 .global pitch_md_value |
||
| 12 | 13 pitch_md_value: |
||
| 13 | 14 0000 0F93 push r16 |
||
| 14 | 15 0002 1F93 push r17 |
||
| 15 | 16 0004 CF93 push r28 |
||
| 16 | 17 0006 DF93 push r29 |
||
| 17 | 18 /* prologue: function */ |
||
| 18 | 19 /* frame size = 0 */ |
||
| 19 | 20 0008 8091 0000 lds r24,EE_Parameter+2 |
||
| 20 | 21 000c C82F mov r28,r24 |
||
| 21 | 22 000e D0E0 ldi r29,lo8(0) |
||
| 22 | 23 0010 FE01 movw r30,r28 |
||
| 23 | 24 0012 EE0F lsl r30 |
||
| 24 | 25 0014 FF1F rol r31 |
||
| 25 | 26 0016 E050 subi r30,lo8(-(PPM_in)) |
||
| 26 | 27 0018 F040 sbci r31,hi8(-(PPM_in)) |
||
| 27 | 28 001a 0190 ld __tmp_reg__,Z+ |
||
| 28 | 29 001c F081 ld r31,Z |
||
| 29 | 30 001e E02D mov r30,__tmp_reg__ |
||
| 30 | 31 0020 8091 0000 lds r24,MotorenEin |
||
| 31 | 32 0024 8823 tst r24 |
||
| 32 | 33 0026 01F4 brne .+2 |
||
| 33 | 34 0028 00C0 rjmp .L2 |
||
| 34 | 35 002a 0091 0000 lds r16,stickValue |
||
| 35 | 36 002e 1091 0000 lds r17,(stickValue)+1 |
||
| 36 | 37 0032 1093 0000 sts (lastStickValue)+1,r17 |
||
| 37 | 38 0036 0093 0000 sts lastStickValue,r16 |
||
| 38 | 39 003a EE9F mul r30,r30 |
||
| 39 | 40 003c C001 movw r24,r0 |
||
| 40 | 41 003e EF9F mul r30,r31 |
||
| 41 | 42 0040 900D add r25,r0 |
||
| 42 | 43 0042 FE9F mul r31,r30 |
||
| 43 | 44 0044 900D add r25,r0 |
||
| 44 | 45 0046 1124 clr r1 |
||
| 45 | 46 0048 1E16 cp __zero_reg__,r30 |
||
| 46 | 47 004a 1F06 cpc __zero_reg__,r31 |
||
| 47 | 48 004c 04F4 brge .L3 |
||
| 48 | 49 004e 66E9 ldi r22,lo8(150) |
||
| 49 | 50 0050 70E0 ldi r23,hi8(150) |
||
| 50 | 51 0052 00C0 rjmp .L32 |
||
| 51 | 52 .L3: |
||
| 52 | 53 0054 6AE6 ldi r22,lo8(-150) |
||
| 53 | 54 0056 7FEF ldi r23,hi8(-150) |
||
| 54 | 55 .L32: |
||
| 55 | 56 0058 0E94 0000 call __divmodhi4 |
||
| 56 | 57 005c 6E0F add r22,r30 |
||
| 57 | 58 005e 7F1F adc r23,r31 |
||
| 58 | 59 0060 7093 0000 sts (temp)+1,r23 |
||
| 59 | 60 0064 6093 0000 sts temp,r22 |
||
| 60 | 61 0068 4091 0000 lds r20,temp |
||
| 61 | 62 006c 5091 0000 lds r21,(temp)+1 |
||
| 62 | 63 0070 5093 0000 sts (stickValue)+1,r21 |
||
| 63 | 64 0074 4093 0000 sts stickValue,r20 |
||
| 64 | 65 0078 6091 0000 lds r22,pitchOffset |
||
| 65 | 66 007c 7091 0000 lds r23,(pitchOffset)+1 |
||
| 66 | 67 0080 9B01 movw r18,r22 |
||
| 67 | 68 0082 240F add r18,r20 |
||
| 68 | 69 0084 351F adc r19,r21 |
||
| 69 | 70 0086 3093 0000 sts (targetPitchCount)+1,r19 |
||
| 70 | 71 008a 2093 0000 sts targetPitchCount,r18 |
||
| 71 | 72 008e 8091 0000 lds r24,state |
||
| 72 | 73 0092 8430 cpi r24,lo8(4) |
||
| 73 | 74 0094 01F4 brne .+2 |
||
| 74 | 75 0096 00C0 rjmp .L9 |
||
| 75 | 76 0098 8530 cpi r24,lo8(5) |
||
| 76 | 77 009a 00F4 brsh .L14 |
||
| 77 | 78 009c 8230 cpi r24,lo8(2) |
||
| 78 | 79 009e 01F0 breq .L7 |
||
| 79 | 80 00a0 8330 cpi r24,lo8(3) |
||
| 80 | 81 00a2 00F0 brlo .+2 |
||
| 81 | 82 00a4 00C0 rjmp .L8 |
||
| 82 | 83 00a6 8130 cpi r24,lo8(1) |
||
| 83 | 84 00a8 01F0 breq .+2 |
||
| 84 | 85 00aa 00C0 rjmp .L5 |
||
| 85 | 86 00ac 00C0 rjmp .L35 |
||
| 86 | 87 .L14: |
||
| 87 | 88 00ae 8630 cpi r24,lo8(6) |
||
| 88 | 89 00b0 01F4 brne .+2 |
||
| 89 | 90 00b2 00C0 rjmp .L11 |
||
| 90 | 91 00b4 8630 cpi r24,lo8(6) |
||
| 91 | 92 00b6 00F4 brsh .+2 |
||
| 92 | 93 00b8 00C0 rjmp .L10 |
||
| 93 | 94 00ba 8730 cpi r24,lo8(7) |
||
| 94 | 95 00bc 01F4 brne .+2 |
||
| 95 | 96 00be 00C0 rjmp .L12 |
||
| 96 | 97 00c0 8830 cpi r24,lo8(8) |
||
| 97 | 98 00c2 01F0 breq .+2 |
||
| 98 | 99 00c4 00C0 rjmp .L5 |
||
| 99 | 100 00c6 00C0 rjmp .L36 |
||
| 100 | 101 .L35: |
||
| 101 | 102 00c8 E091 0000 lds r30,EE_Parameter+1 |
||
| 102 | 103 00cc F0E0 ldi r31,lo8(0) |
||
| 103 | 104 00ce EE0F lsl r30 |
||
| 104 | 105 00d0 FF1F rol r31 |
||
| 105 | 106 00d2 E050 subi r30,lo8(-(PPM_in)) |
||
| 106 | 107 00d4 F040 sbci r31,hi8(-(PPM_in)) |
||
| 107 | 108 00d6 0190 ld __tmp_reg__,Z+ |
||
| 108 | 109 00d8 F081 ld r31,Z |
||
| 109 | 110 00da E02D mov r30,__tmp_reg__ |
||
| 110 | 111 00dc F7FF sbrs r31,7 |
||
| 111 | 112 00de 00C0 rjmp .L16 |
||
| 112 | 113 00e0 F095 com r31 |
||
| 113 | 114 00e2 E195 neg r30 |
||
| 114 | 115 00e4 FF4F sbci r31,lo8(-1) |
||
| 115 | 116 .L16: |
||
| 116 | 117 00e6 E734 cpi r30,71 |
||
| 117 | 118 00e8 F105 cpc r31,__zero_reg__ |
||
| 118 | 119 00ea 04F0 brlt .L15 |
||
| 119 | 120 00ec 82E0 ldi r24,lo8(2) |
||
| 120 | 121 00ee 00C0 rjmp .L33 |
||
| 121 | 122 .L15: |
||
| 122 | 123 00f0 83E0 ldi r24,lo8(3) |
||
| 123 | 124 00f2 00C0 rjmp .L33 |
||
| 124 | 125 .L7: |
||
| 125 | 126 00f4 3093 0000 sts (actualPitchCount)+1,r19 |
||
| 126 | 127 00f8 2093 0000 sts actualPitchCount,r18 |
||
| 127 | 128 00fc 7497 sbiw r30,20 |
||
| 128 | 129 00fe 04F0 brlt .L17 |
||
| 129 | 130 0100 4017 cp r20,r16 |
||
| 130 | 131 0102 5107 cpc r21,r17 |
||
| 131 | 132 0104 01F0 breq .L18 |
||
| 132 | 133 .L17: |
||
| 133 | 134 0106 84E6 ldi r24,lo8(100) |
||
| 134 | 135 0108 90E0 ldi r25,hi8(100) |
||
| 135 | 136 010a 9093 0000 sts (timer)+1,r25 |
||
| 136 | 137 010e 8093 0000 sts timer,r24 |
||
| 137 | 138 0112 00C0 rjmp .L5 |
||
| 138 | 139 .L18: |
||
| 139 | 140 0114 8091 0000 lds r24,timer |
||
| 140 | 141 0118 9091 0000 lds r25,(timer)+1 |
||
| 141 | 142 011c 0197 sbiw r24,1 |
||
| 142 | 143 011e 9093 0000 sts (timer)+1,r25 |
||
| 143 | 144 0122 8093 0000 sts timer,r24 |
||
| 144 | 145 0126 892B or r24,r25 |
||
| 145 | 146 0128 01F0 breq .+2 |
||
| 146 | 147 012a 00C0 rjmp .L5 |
||
| 147 | 148 012c 8091 0000 lds r24,EE_Parameter+29 |
||
| 148 | 149 0130 90E0 ldi r25,lo8(0) |
||
| 149 | 150 0132 8217 cp r24,r18 |
||
| 150 | 151 0134 9307 cpc r25,r19 |
||
| 151 | 152 0136 01F4 brne .+2 |
||
| 152 | 153 0138 00C0 rjmp .L5 |
||
| 153 | 154 013a 2093 0000 sts EE_Parameter+29,r18 |
||
| 154 | 155 013e 0E94 0000 call GetActiveParamSetNumber |
||
| 155 | 156 0142 60E0 ldi r22,lo8(EE_Parameter) |
||
| 156 | 157 0144 70E0 ldi r23,hi8(EE_Parameter) |
||
| 157 | 158 0146 46E5 ldi r20,lo8(86) |
||
| 158 | 159 0148 0E94 0000 call WriteParameterSet |
||
| 159 | 160 014c 84EF ldi r24,lo8(500) |
||
| 160 | 161 014e 91E0 ldi r25,hi8(500) |
||
| 161 | 162 0150 9093 0000 sts (beeptime)+1,r25 |
||
| 162 | 163 0154 8093 0000 sts beeptime,r24 |
||
| 163 | 164 0158 00C0 rjmp .L5 |
||
| 164 | 165 .L8: |
||
| 165 | 166 015a 85E0 ldi r24,lo8(5) |
||
| 166 | 167 015c 90E0 ldi r25,hi8(5) |
||
| 167 | 168 015e 9093 0000 sts (delay)+1,r25 |
||
| 168 | 169 0162 8093 0000 sts delay,r24 |
||
| 169 | 170 0166 3697 sbiw r30,6 |
||
| 170 | 171 0168 04F0 brlt .L19 |
||
| 171 | 172 016a 8091 0000 lds r24,EE_Parameter+29 |
||
| 172 | 173 016e 8093 0000 sts pitchOffset,r24 |
||
| 173 | 174 0172 1092 0000 sts pitchOffset+1,__zero_reg__ |
||
| 174 | 175 0176 00C0 rjmp .L5 |
||
| 175 | 176 .L19: |
||
| 176 | 177 0178 8091 0000 lds r24,EE_Parameter+29 |
||
| 177 | 178 017c 90E0 ldi r25,lo8(0) |
||
| 178 | 179 017e 6817 cp r22,r24 |
||
| 179 | 180 0180 7907 cpc r23,r25 |
||
| 180 | 181 0182 01F0 breq .+2 |
||
| 181 | 182 0184 00C0 rjmp .L5 |
||
| 182 | 183 0186 84E0 ldi r24,lo8(4) |
||
| 183 | 184 0188 00C0 rjmp .L33 |
||
| 184 | 185 .L9: |
||
| 185 | 186 018a CF01 movw r24,r30 |
||
| 186 | 187 018c F7FF sbrs r31,7 |
||
| 187 | 188 018e 00C0 rjmp .L20 |
||
| 188 | 189 0190 8827 clr r24 |
||
| 189 | 190 0192 9927 clr r25 |
||
| 190 | 191 0194 8E1B sub r24,r30 |
||
| 191 | 192 0196 9F0B sbc r25,r31 |
||
| 192 | 193 .L20: |
||
| 193 | 194 0198 0B97 sbiw r24,11 |
||
| 194 | 195 019a 04F4 brge .+2 |
||
| 195 | 196 019c 00C0 rjmp .L5 |
||
| 196 | 197 019e 1092 0000 sts (delay)+1,__zero_reg__ |
||
| 197 | 198 01a2 1092 0000 sts delay,__zero_reg__ |
||
| 198 | 199 01a6 1E16 cp __zero_reg__,r30 |
||
| 199 | 200 01a8 1F06 cpc __zero_reg__,r31 |
||
| 200 | 201 01aa 04F4 brge .+2 |
||
| 201 | 202 01ac 00C0 rjmp .L34 |
||
| 202 | 203 01ae 00C0 rjmp .L5 |
||
| 203 | 204 .L10: |
||
| 204 | 205 01b0 8091 0000 lds r24,EE_Parameter+51 |
||
| 205 | 206 01b4 84FF sbrs r24,4 |
||
| 206 | 207 01b6 00C0 rjmp .L21 |
||
| 207 | 208 01b8 CC0F lsl r28 |
||
| 208 | 209 01ba DD1F rol r29 |
||
| 209 | 210 01bc C050 subi r28,lo8(-(PPM_in)) |
||
| 210 | 211 01be D040 sbci r29,hi8(-(PPM_in)) |
||
| 211 | 212 01c0 8881 ld r24,Y |
||
| 212 | 213 01c2 9981 ldd r25,Y+1 |
||
| 213 | 214 01c4 8C5A subi r24,lo8(-84) |
||
| 214 | 215 01c6 9F4F sbci r25,hi8(-84) |
||
| 215 | 216 01c8 04F0 brlt .L22 |
||
| 216 | 217 01ca 84E6 ldi r24,lo8(100) |
||
| 217 | 218 01cc 90E0 ldi r25,hi8(100) |
||
| 218 | 219 01ce 9093 0000 sts (timer)+1,r25 |
||
| 219 | 220 01d2 8093 0000 sts timer,r24 |
||
| 220 | 221 01d6 00C0 rjmp .L21 |
||
| 221 | 222 .L22: |
||
| 222 | 223 01d8 8091 0000 lds r24,timer |
||
| 223 | 224 01dc 9091 0000 lds r25,(timer)+1 |
||
| 224 | 225 01e0 0197 sbiw r24,1 |
||
| 225 | 226 01e2 9093 0000 sts (timer)+1,r25 |
||
| 226 | 227 01e6 8093 0000 sts timer,r24 |
||
| 227 | 228 01ea 892B or r24,r25 |
||
| 228 | 229 01ec 01F4 brne .L21 |
||
| 229 | 230 01ee 83E0 ldi r24,lo8(3) |
||
| 230 | 231 01f0 8093 0000 sts state,r24 |
||
| 231 | 232 01f4 1092 0000 sts (pitchOffset)+1,__zero_reg__ |
||
| 232 | 233 01f8 1092 0000 sts pitchOffset,__zero_reg__ |
||
| 233 | 234 01fc 1092 0000 sts (targetPitchCount)+1,__zero_reg__ |
||
| 234 | 235 0200 1092 0000 sts targetPitchCount,__zero_reg__ |
||
| 235 | 236 0204 1092 0000 sts (actualPitchCount)+1,__zero_reg__ |
||
| 236 | 237 0208 1092 0000 sts actualPitchCount,__zero_reg__ |
||
| 237 | 238 020c 84EF ldi r24,lo8(500) |
||
| 238 | 239 020e 91E0 ldi r25,hi8(500) |
||
| 239 | 240 0210 9093 0000 sts (beeptime)+1,r25 |
||
| 240 | 241 0214 8093 0000 sts beeptime,r24 |
||
| 241 | 242 .L21: |
||
| 242 | 243 0218 8091 0000 lds r24,EE_Parameter+30 |
||
| 243 | 244 021c 282F mov r18,r24 |
||
| 244 | 245 021e 30E0 ldi r19,lo8(0) |
||
| 245 | 246 0220 8091 0000 lds r24,targetPitchCount |
||
| 246 | 247 0224 9091 0000 lds r25,(targetPitchCount)+1 |
||
| 247 | 248 0228 8217 cp r24,r18 |
||
| 248 | 249 022a 9307 cpc r25,r19 |
||
| 249 | 250 022c 04F4 brge .L23 |
||
| 250 | 251 022e 3093 0000 sts (targetPitchCount)+1,r19 |
||
| 251 | 252 0232 2093 0000 sts targetPitchCount,r18 |
||
| 252 | 253 .L23: |
||
| 253 | 254 0236 4C5F subi r20,lo8(-(4)) |
||
| 254 | 255 0238 5F4F sbci r21,hi8(-(4)) |
||
| 255 | 256 023a 4930 cpi r20,9 |
||
| 256 | 257 023c 5105 cpc r21,__zero_reg__ |
||
| 257 | 258 023e 00F0 brlo .+2 |
||
| 258 | 259 0240 00C0 rjmp .L5 |
||
| 259 | 260 0242 0E94 0000 call altcon_lock |
||
| 260 | 261 0246 89E1 ldi r24,lo8(25) |
||
| 261 | 262 0248 90E0 ldi r25,hi8(25) |
||
| 262 | 263 024a 9093 0000 sts (timer)+1,r25 |
||
| 263 | 264 024e 8093 0000 sts timer,r24 |
||
| 264 | 265 0252 86E0 ldi r24,lo8(6) |
||
| 265 | 266 0254 00C0 rjmp .L33 |
||
| 266 | 267 .L11: |
||
| 267 | 268 0256 3496 adiw r30,4 |
||
| 268 | 269 0258 3997 sbiw r30,9 |
||
| 269 | 270 025a 00F4 brsh .L34 |
||
| 270 | 271 025c 0417 cp r16,r20 |
||
| 271 | 272 025e 1507 cpc r17,r21 |
||
| 272 | 273 0260 01F4 brne .L34 |
||
| 273 | 274 0262 8091 0000 lds r24,timer |
||
| 274 | 275 0266 9091 0000 lds r25,(timer)+1 |
||
| 275 | 276 026a 0197 sbiw r24,1 |
||
| 276 | 277 026c 9093 0000 sts (timer)+1,r25 |
||
| 277 | 278 0270 8093 0000 sts timer,r24 |
||
| 278 | 279 0274 892B or r24,r25 |
||
| 279 | 280 0276 01F0 breq .+2 |
||
| 280 | 281 0278 00C0 rjmp .L5 |
||
| 281 | 282 027a 87E0 ldi r24,lo8(7) |
||
| 282 | 283 027c 00C0 rjmp .L33 |
||
| 283 | 284 .L12: |
||
| 284 | 285 027e 0E94 0000 call altcon_start |
||
| 285 | 286 0282 88E0 ldi r24,lo8(8) |
||
| 286 | 287 0284 00C0 rjmp .L33 |
||
| 287 | 288 .L36: |
||
| 288 | 289 0286 F7FF sbrs r31,7 |
||
| 289 | 290 0288 00C0 rjmp .L25 |
||
| 290 | 291 028a F095 com r31 |
||
| 291 | 292 028c E195 neg r30 |
||
| 292 | 293 028e FF4F sbci r31,lo8(-1) |
||
| 293 | 294 .L25: |
||
| 294 | 295 0290 3697 sbiw r30,6 |
||
| 295 | 296 0292 04F0 brlt .L5 |
||
| 296 | 297 0294 0E94 0000 call altcon_stop |
||
| 297 | 298 0298 8091 0000 lds r24,averageN |
||
| 298 | 299 029c 9091 0000 lds r25,(averageN)+1 |
||
| 299 | 300 02a0 64E0 ldi r22,lo8(4) |
||
| 300 | 301 02a2 70E0 ldi r23,hi8(4) |
||
| 301 | 302 02a4 0E94 0000 call __divmodhi4 |
||
| 302 | 303 02a8 8091 0000 lds r24,pitchOffset |
||
| 303 | 304 02ac 9091 0000 lds r25,(pitchOffset)+1 |
||
| 304 | 305 02b0 861B sub r24,r22 |
||
| 305 | 306 02b2 970B sbc r25,r23 |
||
| 306 | 307 02b4 9093 0000 sts (pitchOffset)+1,r25 |
||
| 307 | 308 02b8 8093 0000 sts pitchOffset,r24 |
||
| 308 | 309 02bc 2091 0000 lds r18,stickValue |
||
| 309 | 310 02c0 3091 0000 lds r19,(stickValue)+1 |
||
| 310 | 311 02c4 820F add r24,r18 |
||
| 311 | 312 02c6 931F adc r25,r19 |
||
| 312 | 313 02c8 9093 0000 sts (targetPitchCount)+1,r25 |
||
| 313 | 314 02cc 8093 0000 sts targetPitchCount,r24 |
||
| 314 | 315 .L34: |
||
| 315 | 316 02d0 85E0 ldi r24,lo8(5) |
||
| 316 | 317 02d2 00C0 rjmp .L33 |
||
| 317 | 318 .L2: |
||
| 318 | 319 02d4 1092 0000 sts (actualPitchCount)+1,__zero_reg__ |
||
| 319 | 320 02d8 1092 0000 sts actualPitchCount,__zero_reg__ |
||
| 320 | 321 02dc 1092 0000 sts (targetPitchCount)+1,__zero_reg__ |
||
| 321 | 322 02e0 1092 0000 sts targetPitchCount,__zero_reg__ |
||
| 322 | 323 02e4 1092 0000 sts (pitchOffset)+1,__zero_reg__ |
||
| 323 | 324 02e8 1092 0000 sts pitchOffset,__zero_reg__ |
||
| 324 | 325 02ec 1092 0000 sts (stickValue)+1,__zero_reg__ |
||
| 325 | 326 02f0 1092 0000 sts stickValue,__zero_reg__ |
||
| 326 | 327 02f4 81E0 ldi r24,lo8(1) |
||
| 327 | 328 .L33: |
||
| 328 | 329 02f6 8093 0000 sts state,r24 |
||
| 329 | 330 .L5: |
||
| 330 | 331 02fa 8091 0000 lds r24,pitchOffset |
||
| 331 | 332 02fe 9091 0000 lds r25,(pitchOffset)+1 |
||
| 332 | 333 0302 97FF sbrs r25,7 |
||
| 333 | 334 0304 00C0 rjmp .L26 |
||
| 334 | 335 0306 1092 0000 sts (pitchOffset)+1,__zero_reg__ |
||
| 335 | 336 030a 1092 0000 sts pitchOffset,__zero_reg__ |
||
| 336 | 337 .L26: |
||
| 337 | 338 030e 8091 0000 lds r24,delayCounter |
||
| 338 | 339 0312 9091 0000 lds r25,(delayCounter)+1 |
||
| 339 | 340 0316 892B or r24,r25 |
||
| 340 | 341 0318 01F4 brne .L27 |
||
| 341 | 342 031a 2091 0000 lds r18,actualPitchCount |
||
| 342 | 343 031e 3091 0000 lds r19,(actualPitchCount)+1 |
||
| 343 | 344 0322 8091 0000 lds r24,targetPitchCount |
||
| 344 | 345 0326 9091 0000 lds r25,(targetPitchCount)+1 |
||
| 345 | 346 032a 821B sub r24,r18 |
||
| 346 | 347 032c 930B sbc r25,r19 |
||
| 347 | 348 032e 8430 cpi r24,4 |
||
| 348 | 349 0330 9105 cpc r25,__zero_reg__ |
||
| 349 | 350 0332 04F0 brlt .L28 |
||
| 350 | 351 0334 83E0 ldi r24,lo8(3) |
||
| 351 | 352 0336 90E0 ldi r25,hi8(3) |
||
| 352 | 353 0338 00C0 rjmp .L29 |
||
| 353 | 354 .L28: |
||
| 354 | 355 033a 4FEF ldi r20,hi8(-3) |
||
| 355 | 356 033c 8D3F cpi r24,lo8(-3) |
||
| 356 | 357 033e 9407 cpc r25,r20 |
||
| 357 | 358 0340 04F4 brge .L29 |
||
| 358 | 359 0342 8DEF ldi r24,lo8(-3) |
||
| 359 | 360 0344 9FEF ldi r25,hi8(-3) |
||
| 360 | 361 .L29: |
||
| 361 | 362 0346 820F add r24,r18 |
||
| 362 | 363 0348 931F adc r25,r19 |
||
| 363 | 364 034a 9093 0000 sts (actualPitchCount)+1,r25 |
||
| 364 | 365 034e 8093 0000 sts actualPitchCount,r24 |
||
| 365 | 366 0352 8091 0000 lds r24,delay |
||
| 366 | 367 0356 9091 0000 lds r25,(delay)+1 |
||
| 367 | 368 035a 0196 adiw r24,1 |
||
| 368 | 369 035c 9093 0000 sts (delayCounter)+1,r25 |
||
| 369 | 370 0360 8093 0000 sts delayCounter,r24 |
||
| 370 | 371 .L27: |
||
| 371 | 372 0364 8091 0000 lds r24,delayCounter |
||
| 372 | 373 0368 9091 0000 lds r25,(delayCounter)+1 |
||
| 373 | 374 036c 0197 sbiw r24,1 |
||
| 374 | 375 036e 9093 0000 sts (delayCounter)+1,r25 |
||
| 375 | 376 0372 8093 0000 sts delayCounter,r24 |
||
| 376 | 377 0376 8091 0000 lds r24,actualPitchCount |
||
| 377 | 378 037a 9091 0000 lds r25,(actualPitchCount)+1 |
||
| 378 | 379 037e 97FF sbrs r25,7 |
||
| 379 | 380 0380 00C0 rjmp .L30 |
||
| 380 | 381 0382 1092 0000 sts (actualPitchCount)+1,__zero_reg__ |
||
| 381 | 382 0386 1092 0000 sts actualPitchCount,__zero_reg__ |
||
| 382 | 383 .L30: |
||
| 383 | 384 038a 8091 0000 lds r24,stickValue |
||
| 384 | 385 038e 9091 0000 lds r25,(stickValue)+1 |
||
| 385 | 386 0392 9093 0000 sts (DebugOut+54)+1,r25 |
||
| 386 | 387 0396 8093 0000 sts DebugOut+54,r24 |
||
| 387 | 388 039a 8091 0000 lds r24,actualPitchCount |
||
| 388 | 389 039e 9091 0000 lds r25,actualPitchCount+1 |
||
| 389 | 390 03a2 8093 0000 sts DebugOut+58,r24 |
||
| 390 | 391 03a6 9093 0000 sts DebugOut+59,r25 |
||
| 391 | 392 03aa 2091 0000 lds r18,pitchOffset |
||
| 392 | 393 03ae 3091 0000 lds r19,(pitchOffset)+1 |
||
| 393 | 394 03b2 3093 0000 sts (DebugOut+60)+1,r19 |
||
| 394 | 395 03b6 2093 0000 sts DebugOut+60,r18 |
||
| 395 | 396 /* epilogue start */ |
||
| 396 | 397 03ba DF91 pop r29 |
||
| 397 | 398 03bc CF91 pop r28 |
||
| 398 | 399 03be 1F91 pop r17 |
||
| 399 | 400 03c0 0F91 pop r16 |
||
| 400 | 401 03c2 0895 ret |
||
| 401 | 403 .global stickValue |
||
| 402 | 404 .global stickValue |
||
| 403 | 405 .section .bss |
||
| 404 | 408 stickValue: |
||
| 405 | 409 0000 0000 .skip 2,0 |
||
| 406 | 410 .global lastStickValue |
||
| 407 | 411 .global lastStickValue |
||
| 408 | 414 lastStickValue: |
||
| 409 | 415 0002 0000 .skip 2,0 |
||
| 410 | 416 .global delay |
||
| 411 | 417 .global delay |
||
| 412 | 420 delay: |
||
| 413 | 421 0004 0000 .skip 2,0 |
||
| 414 | 422 .global delayCounter |
||
| 415 | 423 .global delayCounter |
||
| 416 | 426 delayCounter: |
||
| 417 | 427 0006 0000 .skip 2,0 |
||
| 418 | 428 .comm actualPitchCount,2,1 |
||
| 419 | 429 .comm targetPitchCount,2,1 |
||
| 420 | 430 .comm pitchOffset,2,1 |
||
| 421 | 431 .comm state,1,1 |
||
| 422 | 432 .comm timer,2,1 |
||
| 423 | 433 .comm temp,2,1 |
||
| 424 | DEFINED SYMBOLS |
||
| 425 | *ABS*:00000000 pitch_md.c |
||
| 426 | c:\TEMP/ccyyuOZC.s:2 *ABS*:0000003f __SREG__ |
||
| 427 | c:\TEMP/ccyyuOZC.s:3 *ABS*:0000003e __SP_H__ |
||
| 428 | c:\TEMP/ccyyuOZC.s:4 *ABS*:0000003d __SP_L__ |
||
| 429 | c:\TEMP/ccyyuOZC.s:5 *ABS*:00000034 __CCP__ |
||
| 430 | c:\TEMP/ccyyuOZC.s:6 *ABS*:00000000 __tmp_reg__ |
||
| 431 | c:\TEMP/ccyyuOZC.s:7 *ABS*:00000001 __zero_reg__ |
||
| 432 | c:\TEMP/ccyyuOZC.s:13 .text:00000000 pitch_md_value |
||
| 433 | c:\TEMP/ccyyuOZC.s:408 .bss:00000000 stickValue |
||
| 434 | c:\TEMP/ccyyuOZC.s:414 .bss:00000002 lastStickValue |
||
| 435 | *COM*:00000002 temp |
||
| 436 | *COM*:00000002 pitchOffset |
||
| 437 | *COM*:00000002 targetPitchCount |
||
| 438 | *COM*:00000001 state |
||
| 439 | *COM*:00000002 actualPitchCount |
||
| 440 | *COM*:00000002 timer |
||
| 441 | c:\TEMP/ccyyuOZC.s:420 .bss:00000004 delay |
||
| 442 | c:\TEMP/ccyyuOZC.s:426 .bss:00000006 delayCounter |
||
| 443 | |||
| 444 | UNDEFINED SYMBOLS |
||
| 445 | __do_copy_data |
||
| 446 | __do_clear_bss |
||
| 447 | EE_Parameter |
||
| 448 | PPM_in |
||
| 449 | MotorenEin |
||
| 450 | __divmodhi4 |
||
| 451 | GetActiveParamSetNumber |
||
| 452 | WriteParameterSet |
||
| 453 | beeptime |
||
| 454 | altcon_lock |
||
| 455 | altcon_start |
||
| 456 | altcon_stop |
||
| 457 | averageN |
||
| 458 | DebugOut |