Details | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 2248 | - | 1 | 1 .file "twimaster.c" |
| 2 | 2 .arch atmega644 |
||
| 3 | 3 __SREG__ = 0x3f |
||
| 4 | 4 __SP_H__ = 0x3e |
||
| 5 | 5 __SP_L__ = 0x3d |
||
| 6 | 6 __tmp_reg__ = 0 |
||
| 7 | 7 __zero_reg__ = 1 |
||
| 8 | 8 .global __do_copy_data |
||
| 9 | 9 .global __do_clear_bss |
||
| 10 | 10 .global I2CError |
||
| 11 | 11 .global I2CError |
||
| 12 | 12 .section .bss |
||
| 13 | 15 I2CError: |
||
| 14 | 16 0000 0000 .skip 2,0 |
||
| 15 | 17 .global MissingMotor |
||
| 16 | 18 .global MissingMotor |
||
| 17 | 21 MissingMotor: |
||
| 18 | 22 0002 00 .skip 1,0 |
||
| 19 | 23 .global motorread |
||
| 20 | 24 .global motorread |
||
| 21 | 27 motorread: |
||
| 22 | 28 0003 00 .skip 1,0 |
||
| 23 | 29 .global motor |
||
| 24 | 30 .global motor |
||
| 25 | 33 motor: |
||
| 26 | 34 0004 00 .skip 1,0 |
||
| 27 | 35 .global twi_state |
||
| 28 | 36 .global twi_state |
||
| 29 | 39 twi_state: |
||
| 30 | 40 0005 00 .skip 1,0 |
||
| 31 | 41 .text |
||
| 32 | 42 .global i2c_init |
||
| 33 | 44 i2c_init: |
||
| 34 | 45 /* prologue: frame size=0 */ |
||
| 35 | 46 /* prologue end (size=0) */ |
||
| 36 | 47 0000 1092 B900 sts 185,__zero_reg__ |
||
| 37 | 48 0004 8AE2 ldi r24,lo8(42) |
||
| 38 | 49 0006 8093 B800 sts 184,r24 |
||
| 39 | 50 /* epilogue: frame size=0 */ |
||
| 40 | 51 000a 0895 ret |
||
| 41 | 52 /* epilogue end (size=1) */ |
||
| 42 | 53 /* function i2c_init size 6 (5) */ |
||
| 43 | 55 .global i2c_start |
||
| 44 | 57 i2c_start: |
||
| 45 | 58 /* prologue: frame size=0 */ |
||
| 46 | 59 /* prologue end (size=0) */ |
||
| 47 | 60 000c 85EA ldi r24,lo8(-91) |
||
| 48 | 61 000e 8093 BC00 sts 188,r24 |
||
| 49 | 62 /* epilogue: frame size=0 */ |
||
| 50 | 63 0012 0895 ret |
||
| 51 | 64 /* epilogue end (size=1) */ |
||
| 52 | 65 /* function i2c_start size 4 (3) */ |
||
| 53 | 67 .global i2c_stop |
||
| 54 | 69 i2c_stop: |
||
| 55 | 70 /* prologue: frame size=0 */ |
||
| 56 | 71 /* prologue end (size=0) */ |
||
| 57 | 72 0014 84E9 ldi r24,lo8(-108) |
||
| 58 | 73 0016 8093 BC00 sts 188,r24 |
||
| 59 | 74 /* epilogue: frame size=0 */ |
||
| 60 | 75 001a 0895 ret |
||
| 61 | 76 /* epilogue end (size=1) */ |
||
| 62 | 77 /* function i2c_stop size 4 (3) */ |
||
| 63 | 79 .global i2c_write_byte |
||
| 64 | 81 i2c_write_byte: |
||
| 65 | 82 /* prologue: frame size=0 */ |
||
| 66 | 83 /* prologue end (size=0) */ |
||
| 67 | 84 001c 1092 B900 sts 185,__zero_reg__ |
||
| 68 | 85 0020 8093 BB00 sts 187,r24 |
||
| 69 | 86 0024 85E8 ldi r24,lo8(-123) |
||
| 70 | 87 0026 8093 BC00 sts 188,r24 |
||
| 71 | 88 /* epilogue: frame size=0 */ |
||
| 72 | 89 002a 0895 ret |
||
| 73 | 90 /* epilogue end (size=1) */ |
||
| 74 | 91 /* function i2c_write_byte size 8 (7) */ |
||
| 75 | 93 .global i2c_reset |
||
| 76 | 95 i2c_reset: |
||
| 77 | 96 /* prologue: frame size=0 */ |
||
| 78 | 97 /* prologue end (size=0) */ |
||
| 79 | 98 002c 0E94 0000 call i2c_stop |
||
| 80 | 99 0030 1092 0000 sts twi_state,__zero_reg__ |
||
| 81 | 100 0034 8091 BB00 lds r24,187 |
||
| 82 | 101 0038 1092 0000 sts motor,__zero_reg__ |
||
| 83 | 102 003c 80E8 ldi r24,lo8(-128) |
||
| 84 | 103 003e 8093 BC00 sts 188,r24 |
||
| 85 | 104 0042 1092 BD00 sts 189,__zero_reg__ |
||
| 86 | 105 0046 1092 BA00 sts 186,__zero_reg__ |
||
| 87 | 106 004a 1092 BB00 sts 187,__zero_reg__ |
||
| 88 | 107 004e 1092 B900 sts 185,__zero_reg__ |
||
| 89 | 108 0052 1092 B800 sts 184,__zero_reg__ |
||
| 90 | 109 0056 0E94 0000 call i2c_init |
||
| 91 | 110 005a 0E94 0000 call i2c_start |
||
| 92 | 111 005e 80E0 ldi r24,lo8(0) |
||
| 93 | 112 0060 0E94 0000 call i2c_write_byte |
||
| 94 | 113 /* epilogue: frame size=0 */ |
||
| 95 | 114 0064 0895 ret |
||
| 96 | 115 /* epilogue end (size=1) */ |
||
| 97 | 116 /* function i2c_reset size 29 (28) */ |
||
| 98 | 118 .global I2C_WriteByte |
||
| 99 | 120 I2C_WriteByte: |
||
| 100 | 121 /* prologue: frame size=0 */ |
||
| 101 | 122 /* prologue end (size=0) */ |
||
| 102 | 123 0066 8093 BB00 sts 187,r24 |
||
| 103 | 124 006a 85E8 ldi r24,lo8(-123) |
||
| 104 | 125 006c 8093 BC00 sts 188,r24 |
||
| 105 | 126 /* epilogue: frame size=0 */ |
||
| 106 | 127 0070 0895 ret |
||
| 107 | 128 /* epilogue end (size=1) */ |
||
| 108 | 129 /* function I2C_WriteByte size 6 (5) */ |
||
| 109 | 131 .global I2C_ReceiveByte |
||
| 110 | 133 I2C_ReceiveByte: |
||
| 111 | 134 /* prologue: frame size=0 */ |
||
| 112 | 135 /* prologue end (size=0) */ |
||
| 113 | 136 0072 85EC ldi r24,lo8(-59) |
||
| 114 | 137 0074 8093 BC00 sts 188,r24 |
||
| 115 | 138 /* epilogue: frame size=0 */ |
||
| 116 | 139 0078 0895 ret |
||
| 117 | 140 /* epilogue end (size=1) */ |
||
| 118 | 141 /* function I2C_ReceiveByte size 4 (3) */ |
||
| 119 | 143 .global I2C_ReceiveLastByte |
||
| 120 | 145 I2C_ReceiveLastByte: |
||
| 121 | 146 /* prologue: frame size=0 */ |
||
| 122 | 147 /* prologue end (size=0) */ |
||
| 123 | 148 007a 85E8 ldi r24,lo8(-123) |
||
| 124 | 149 007c 8093 BC00 sts 188,r24 |
||
| 125 | 150 /* epilogue: frame size=0 */ |
||
| 126 | 151 0080 0895 ret |
||
| 127 | 152 /* epilogue end (size=1) */ |
||
| 128 | 153 /* function I2C_ReceiveLastByte size 4 (3) */ |
||
| 129 | 155 .lcomm missing_motor.0,1 |
||
| 130 | 156 .global __vector_26 |
||
| 131 | 158 __vector_26: |
||
| 132 | 159 /* prologue: frame size=0 */ |
||
| 133 | 160 0082 1F92 push __zero_reg__ |
||
| 134 | 161 0084 0F92 push __tmp_reg__ |
||
| 135 | 162 0086 0FB6 in __tmp_reg__,__SREG__ |
||
| 136 | 163 0088 0F92 push __tmp_reg__ |
||
| 137 | 164 008a 1124 clr __zero_reg__ |
||
| 138 | 165 008c 2F93 push r18 |
||
| 139 | 166 008e 3F93 push r19 |
||
| 140 | 167 0090 4F93 push r20 |
||
| 141 | 168 0092 5F93 push r21 |
||
| 142 | 169 0094 6F93 push r22 |
||
| 143 | 170 0096 7F93 push r23 |
||
| 144 | 171 0098 8F93 push r24 |
||
| 145 | 172 009a 9F93 push r25 |
||
| 146 | 173 009c AF93 push r26 |
||
| 147 | 174 009e BF93 push r27 |
||
| 148 | 175 00a0 EF93 push r30 |
||
| 149 | 176 00a2 FF93 push r31 |
||
| 150 | 177 /* prologue end (size=17) */ |
||
| 151 | 178 00a4 8091 0000 lds r24,twi_state |
||
| 152 | 179 00a8 282F mov r18,r24 |
||
| 153 | 180 00aa 3327 clr r19 |
||
| 154 | 181 00ac 4427 clr r20 |
||
| 155 | 182 00ae 5527 clr r21 |
||
| 156 | 183 00b0 8F5F subi r24,lo8(-(1)) |
||
| 157 | 184 00b2 8093 0000 sts twi_state,r24 |
||
| 158 | 185 00b6 F901 movw r30,r18 |
||
| 159 | 186 00b8 2731 cpi r18,23 |
||
| 160 | 187 00ba 3105 cpc r19,__zero_reg__ |
||
| 161 | 188 00bc 00F4 brsh .L48 |
||
| 162 | 189 00be E050 subi r30,lo8(-(pm(.L49))) |
||
| 163 | 190 00c0 F040 sbci r31,hi8(-(pm(.L49))) |
||
| 164 | 191 00c2 0C94 0000 jmp __tablejump2__ |
||
| 165 | 192 .data |
||
| 166 | 193 .section .progmem.gcc_sw_table, "a", @progbits |
||
| 167 | 194 .p2align 1 |
||
| 168 | 195 .L49: |
||
| 169 | 196 0000 0000 .word pm(.L11) |
||
| 170 | 197 0002 0000 .word pm(.L21) |
||
| 171 | 198 0004 0000 .word pm(.L22) |
||
| 172 | 199 0006 0000 .word pm(.L26) |
||
| 173 | 200 0008 0000 .word pm(.L30) |
||
| 174 | 201 000a 0000 .word pm(.L31) |
||
| 175 | 202 000c 0000 .word pm(.L48) |
||
| 176 | 203 000e 0000 .word pm(.L48) |
||
| 177 | 204 0010 0000 .word pm(.L43) |
||
| 178 | 205 0012 0000 .word pm(.L34) |
||
| 179 | 206 0014 0000 .word pm(.L35) |
||
| 180 | 207 0016 0000 .word pm(.L46) |
||
| 181 | 208 0018 0000 .word pm(.L42) |
||
| 182 | 209 001a 0000 .word pm(.L43) |
||
| 183 | 210 001c 0000 .word pm(.L39) |
||
| 184 | 211 001e 0000 .word pm(.L40) |
||
| 185 | 212 0020 0000 .word pm(.L46) |
||
| 186 | 213 0022 0000 .word pm(.L42) |
||
| 187 | 214 0024 0000 .word pm(.L43) |
||
| 188 | 215 0026 0000 .word pm(.L44) |
||
| 189 | 216 0028 0000 .word pm(.L45) |
||
| 190 | 217 002a 0000 .word pm(.L46) |
||
| 191 | 218 002c 0000 .word pm(.L47) |
||
| 192 | 219 .text |
||
| 193 | 220 .L31: |
||
| 194 | 221 00c6 8091 0000 lds r24,motorread |
||
| 195 | 222 00ca E82F mov r30,r24 |
||
| 196 | 223 00cc FF27 clr r31 |
||
| 197 | 224 00ce E050 subi r30,lo8(-(motor_rx2)) |
||
| 198 | 225 00d0 F040 sbci r31,hi8(-(motor_rx2)) |
||
| 199 | 226 00d2 9091 BB00 lds r25,187 |
||
| 200 | 227 00d6 9083 st Z,r25 |
||
| 201 | 228 00d8 8F5F subi r24,lo8(-(1)) |
||
| 202 | 229 00da 8230 cpi r24,lo8(2) |
||
| 203 | 230 00dc 00F4 brsh .+2 |
||
| 204 | 231 00de 00C0 rjmp .L55 |
||
| 205 | 232 00e0 1092 0000 sts motorread,__zero_reg__ |
||
| 206 | 233 00e4 0E94 0000 call i2c_stop |
||
| 207 | 234 .L48: |
||
| 208 | 235 00e8 1092 0000 sts twi_state,__zero_reg__ |
||
| 209 | 236 00ec 00C0 rjmp .L10 |
||
| 210 | 237 .L46: |
||
| 211 | 238 00ee 80E8 ldi r24,lo8(-128) |
||
| 212 | 239 00f0 0E94 0000 call i2c_write_byte |
||
| 213 | 240 00f4 00C0 rjmp .L10 |
||
| 214 | 241 .L43: |
||
| 215 | 242 00f6 88E9 ldi r24,lo8(-104) |
||
| 216 | 243 00f8 0E94 0000 call i2c_write_byte |
||
| 217 | 244 00fc 00C0 rjmp .L10 |
||
| 218 | 245 .L42: |
||
| 219 | 246 00fe 0E94 0000 call i2c_stop |
||
| 220 | 247 0102 8AE0 ldi r24,lo8(10) |
||
| 221 | 248 0104 90E0 ldi r25,hi8(10) |
||
| 222 | 249 0106 9093 0000 sts (I2CTimeout)+1,r25 |
||
| 223 | 250 010a 8093 0000 sts I2CTimeout,r24 |
||
| 224 | 251 010e 0E94 0000 call i2c_start |
||
| 225 | 252 0112 00C0 rjmp .L10 |
||
| 226 | 253 .L44: |
||
| 227 | 254 0114 84E1 ldi r24,lo8(20) |
||
| 228 | 255 0116 0E94 0000 call i2c_write_byte |
||
| 229 | 256 011a 00C0 rjmp .L10 |
||
| 230 | 257 .L39: |
||
| 231 | 258 011c 82E1 ldi r24,lo8(18) |
||
| 232 | 259 011e 0E94 0000 call i2c_write_byte |
||
| 233 | 260 0122 00C0 rjmp .L10 |
||
| 234 | 261 .L35: |
||
| 235 | 262 0124 8091 0000 lds r24,AnalogOffsetNick |
||
| 236 | 263 0128 0E94 0000 call i2c_write_byte |
||
| 237 | 264 012c 00C0 rjmp .L10 |
||
| 238 | 265 .L34: |
||
| 239 | 266 012e 80E1 ldi r24,lo8(16) |
||
| 240 | 267 0130 0E94 0000 call i2c_write_byte |
||
| 241 | 268 0134 00C0 rjmp .L10 |
||
| 242 | 269 .L40: |
||
| 243 | 270 0136 8091 0000 lds r24,AnalogOffsetRoll |
||
| 244 | 271 013a 0E94 0000 call i2c_write_byte |
||
| 245 | 272 013e 00C0 rjmp .L10 |
||
| 246 | 273 .L45: |
||
| 247 | 274 0140 8091 0000 lds r24,AnalogOffsetGier |
||
| 248 | 275 0144 0E94 0000 call i2c_write_byte |
||
| 249 | 276 0148 00C0 rjmp .L10 |
||
| 250 | 277 .L21: |
||
| 251 | 278 014a 8091 0000 lds r24,motor |
||
| 252 | 279 014e E82F mov r30,r24 |
||
| 253 | 280 0150 FF27 clr r31 |
||
| 254 | 281 0152 E050 subi r30,lo8(-(Motor)) |
||
| 255 | 282 0154 F040 sbci r31,hi8(-(Motor)) |
||
| 256 | 283 0156 8F5F subi r24,lo8(-(1)) |
||
| 257 | 284 0158 8093 0000 sts motor,r24 |
||
| 258 | 285 015c 8081 ld r24,Z |
||
| 259 | 286 015e 0E94 0000 call i2c_write_byte |
||
| 260 | 287 0162 00C0 rjmp .L10 |
||
| 261 | 288 .L11: |
||
| 262 | 289 0164 9091 0000 lds r25,motor |
||
| 263 | 290 0168 292F mov r18,r25 |
||
| 264 | 291 016a E92F mov r30,r25 |
||
| 265 | 292 016c FF27 clr r31 |
||
| 266 | 293 016e EE0F lsl r30 |
||
| 267 | 294 0170 FF1F rol r31 |
||
| 268 | 295 0172 EE0F lsl r30 |
||
| 269 | 296 0174 FF1F rol r31 |
||
| 270 | 297 0176 E050 subi r30,lo8(-(Mixer)) |
||
| 271 | 298 0178 F040 sbci r31,hi8(-(Mixer)) |
||
| 272 | 299 017a 8585 ldd r24,Z+13 |
||
| 273 | 300 017c 1816 cp __zero_reg__,r24 |
||
| 274 | 301 017e 04F0 brlt .+2 |
||
| 275 | 302 0180 00C0 rjmp .L59 |
||
| 276 | 303 .L13: |
||
| 277 | 304 0182 9230 cpi r25,lo8(2) |
||
| 278 | 305 0184 01F4 brne .+2 |
||
| 279 | 306 0186 00C0 rjmp .L60 |
||
| 280 | 307 0188 9923 tst r25 |
||
| 281 | 308 018a 01F4 brne .+2 |
||
| 282 | 309 018c 00C0 rjmp .L61 |
||
| 283 | 310 .L19: |
||
| 284 | 311 018e 9130 cpi r25,lo8(1) |
||
| 285 | 312 0190 01F0 breq .+2 |
||
| 286 | 313 0192 00C0 rjmp .L10 |
||
| 287 | 314 0194 86E5 ldi r24,lo8(86) |
||
| 288 | 315 0196 0E94 0000 call i2c_write_byte |
||
| 289 | 316 019a 00C0 rjmp .L10 |
||
| 290 | 317 .L30: |
||
| 291 | 318 019c 8091 0000 lds r24,motorread |
||
| 292 | 319 01a0 E82F mov r30,r24 |
||
| 293 | 320 01a2 FF27 clr r31 |
||
| 294 | 321 01a4 E050 subi r30,lo8(-(motor_rx)) |
||
| 295 | 322 01a6 F040 sbci r31,hi8(-(motor_rx)) |
||
| 296 | 323 01a8 8091 BB00 lds r24,187 |
||
| 297 | 324 01ac 8083 st Z,r24 |
||
| 298 | 325 01ae 0E94 0000 call I2C_ReceiveLastByte |
||
| 299 | 326 01b2 00C0 rjmp .L10 |
||
| 300 | 327 .L26: |
||
| 301 | 328 01b4 8091 B900 lds r24,185 |
||
| 302 | 329 01b8 8034 cpi r24,lo8(64) |
||
| 303 | 330 01ba 01F4 brne .+2 |
||
| 304 | 331 01bc 00C0 rjmp .L27 |
||
| 305 | 332 01be 8091 0000 lds r24,motorread |
||
| 306 | 333 01c2 E82F mov r30,r24 |
||
| 307 | 334 01c4 FF27 clr r31 |
||
| 308 | 335 01c6 E050 subi r30,lo8(-(MotorPresent)) |
||
| 309 | 336 01c8 F040 sbci r31,hi8(-(MotorPresent)) |
||
| 310 | 337 01ca 1082 st Z,__zero_reg__ |
||
| 311 | 338 01cc 8F5F subi r24,lo8(-(1)) |
||
| 312 | 339 01ce 8230 cpi r24,lo8(2) |
||
| 313 | 340 01d0 00F0 brlo .L54 |
||
| 314 | 341 01d2 1092 0000 sts motorread,__zero_reg__ |
||
| 315 | 342 .L28: |
||
| 316 | 343 01d6 0E94 0000 call i2c_stop |
||
| 317 | 344 01da 1092 0000 sts twi_state,__zero_reg__ |
||
| 318 | 345 .L29: |
||
| 319 | 346 01de 1092 0000 sts MissingMotor,__zero_reg__ |
||
| 320 | 347 01e2 1092 0000 sts missing_motor.0,__zero_reg__ |
||
| 321 | 348 01e6 00C0 rjmp .L10 |
||
| 322 | 349 .L22: |
||
| 323 | 350 01e8 8091 B900 lds r24,185 |
||
| 324 | 351 01ec 8033 cpi r24,lo8(48) |
||
| 325 | 352 01ee 01F4 brne .+2 |
||
| 326 | 353 01f0 00C0 rjmp .L62 |
||
| 327 | 354 .L23: |
||
| 328 | 355 01f2 0E94 0000 call i2c_stop |
||
| 329 | 356 01f6 8AE0 ldi r24,lo8(10) |
||
| 330 | 357 01f8 90E0 ldi r25,hi8(10) |
||
| 331 | 358 01fa 9093 0000 sts (I2CTimeout)+1,r25 |
||
| 332 | 359 01fe 8093 0000 sts I2CTimeout,r24 |
||
| 333 | 360 0202 1092 0000 sts twi_state,__zero_reg__ |
||
| 334 | 361 0206 0E94 0000 call i2c_start |
||
| 335 | 362 020a 00C0 rjmp .L10 |
||
| 336 | 363 .L47: |
||
| 337 | 364 020c 0E94 0000 call i2c_stop |
||
| 338 | 365 0210 8AE0 ldi r24,lo8(10) |
||
| 339 | 366 0212 90E0 ldi r25,hi8(10) |
||
| 340 | 367 0214 9093 0000 sts (I2CTimeout)+1,r25 |
||
| 341 | 368 0218 8093 0000 sts I2CTimeout,r24 |
||
| 342 | 369 021c 00C0 rjmp .L48 |
||
| 343 | 370 .L55: |
||
| 344 | 371 021e 8093 0000 sts motorread,r24 |
||
| 345 | 372 0222 0E94 0000 call i2c_stop |
||
| 346 | 373 0226 00C0 rjmp .L48 |
||
| 347 | 374 .L54: |
||
| 348 | 375 0228 8093 0000 sts motorread,r24 |
||
| 349 | 376 022c 00C0 rjmp .L28 |
||
| 350 | 377 .L59: |
||
| 351 | 378 022e 9230 cpi r25,lo8(2) |
||
| 352 | 379 0230 00F0 brlo .+2 |
||
| 353 | 380 0232 00C0 rjmp .L13 |
||
| 354 | 381 .L14: |
||
| 355 | 382 0234 922F mov r25,r18 |
||
| 356 | 383 0236 9F5F subi r25,lo8(-(1)) |
||
| 357 | 384 0238 E92F mov r30,r25 |
||
| 358 | 385 023a FF27 clr r31 |
||
| 359 | 386 023c EE0F lsl r30 |
||
| 360 | 387 023e FF1F rol r31 |
||
| 361 | 388 0240 EE0F lsl r30 |
||
| 362 | 389 0242 FF1F rol r31 |
||
| 363 | 390 0244 E050 subi r30,lo8(-(Mixer)) |
||
| 364 | 391 0246 F040 sbci r31,hi8(-(Mixer)) |
||
| 365 | 392 0248 8585 ldd r24,Z+13 |
||
| 366 | 393 024a 1816 cp __zero_reg__,r24 |
||
| 367 | 394 024c 04F0 brlt .L51 |
||
| 368 | 395 024e 292F mov r18,r25 |
||
| 369 | 396 0250 9230 cpi r25,lo8(2) |
||
| 370 | 397 0252 00F0 brlo .L14 |
||
| 371 | 398 .L51: |
||
| 372 | 399 0254 9093 0000 sts motor,r25 |
||
| 373 | 400 0258 00C0 rjmp .L13 |
||
| 374 | 401 .L60: |
||
| 375 | 402 025a 1092 0000 sts motor,__zero_reg__ |
||
| 376 | 403 025e 83E0 ldi r24,lo8(3) |
||
| 377 | 404 0260 8093 0000 sts twi_state,r24 |
||
| 378 | 405 0264 8091 0000 lds r24,motorread |
||
| 379 | 406 0268 8823 tst r24 |
||
| 380 | 407 026a 01F0 breq .L63 |
||
| 381 | 408 .L16: |
||
| 382 | 409 026c 8130 cpi r24,lo8(1) |
||
| 383 | 410 026e 01F4 brne .L10 |
||
| 384 | 411 0270 87E5 ldi r24,lo8(87) |
||
| 385 | 412 0272 0E94 0000 call i2c_write_byte |
||
| 386 | 413 0276 00C0 rjmp .L10 |
||
| 387 | 414 .L62: |
||
| 388 | 415 0278 8091 0000 lds r24,missing_motor.0 |
||
| 389 | 416 027c 8823 tst r24 |
||
| 390 | 417 027e 01F4 brne .L52 |
||
| 391 | 418 0280 9091 0000 lds r25,motor |
||
| 392 | 419 0284 9093 0000 sts missing_motor.0,r25 |
||
| 393 | 420 .L24: |
||
| 394 | 421 0288 E92F mov r30,r25 |
||
| 395 | 422 028a FF27 clr r31 |
||
| 396 | 423 028c E050 subi r30,lo8(-(MotorError-1)) |
||
| 397 | 424 028e F040 sbci r31,hi8(-(MotorError-1)) |
||
| 398 | 425 0290 8081 ld r24,Z |
||
| 399 | 426 0292 8F5F subi r24,lo8(-(1)) |
||
| 400 | 427 0294 01F4 brne .L53 |
||
| 401 | 428 0296 8FEF ldi r24,lo8(-1) |
||
| 402 | 429 .L53: |
||
| 403 | 430 0298 8083 st Z,r24 |
||
| 404 | 431 029a 00C0 rjmp .L23 |
||
| 405 | 432 .L61: |
||
| 406 | 433 029c 82E5 ldi r24,lo8(82) |
||
| 407 | 434 029e 0E94 0000 call i2c_write_byte |
||
| 408 | 435 02a2 9091 0000 lds r25,motor |
||
| 409 | 436 02a6 00C0 rjmp .L19 |
||
| 410 | 437 .L27: |
||
| 411 | 438 02a8 8091 0000 lds r24,motorread |
||
| 412 | 439 02ac E82F mov r30,r24 |
||
| 413 | 440 02ae FF27 clr r31 |
||
| 414 | 441 02b0 E050 subi r30,lo8(-(MotorPresent)) |
||
| 415 | 442 02b2 F040 sbci r31,hi8(-(MotorPresent)) |
||
| 416 | 443 02b4 8C5F subi r24,lo8(-(4)) |
||
| 417 | 444 02b6 8083 st Z,r24 |
||
| 418 | 445 02b8 0E94 0000 call I2C_ReceiveByte |
||
| 419 | 446 02bc 00C0 rjmp .L29 |
||
| 420 | 447 .L52: |
||
| 421 | 448 02be 9091 0000 lds r25,motor |
||
| 422 | 449 02c2 00C0 rjmp .L24 |
||
| 423 | 450 .L63: |
||
| 424 | 451 02c4 83E5 ldi r24,lo8(83) |
||
| 425 | 452 02c6 0E94 0000 call i2c_write_byte |
||
| 426 | 453 02ca 8091 0000 lds r24,motorread |
||
| 427 | 454 02ce 00C0 rjmp .L16 |
||
| 428 | 455 .L10: |
||
| 429 | 456 02d0 8091 BC00 lds r24,188 |
||
| 430 | 457 02d4 8068 ori r24,lo8(-128) |
||
| 431 | 458 02d6 8093 BC00 sts 188,r24 |
||
| 432 | 459 /* epilogue: frame size=0 */ |
||
| 433 | 460 02da FF91 pop r31 |
||
| 434 | 461 02dc EF91 pop r30 |
||
| 435 | 462 02de BF91 pop r27 |
||
| 436 | 463 02e0 AF91 pop r26 |
||
| 437 | 464 02e2 9F91 pop r25 |
||
| 438 | 465 02e4 8F91 pop r24 |
||
| 439 | 466 02e6 7F91 pop r23 |
||
| 440 | 467 02e8 6F91 pop r22 |
||
| 441 | 468 02ea 5F91 pop r21 |
||
| 442 | 469 02ec 4F91 pop r20 |
||
| 443 | 470 02ee 3F91 pop r19 |
||
| 444 | 471 02f0 2F91 pop r18 |
||
| 445 | 472 02f2 0F90 pop __tmp_reg__ |
||
| 446 | 473 02f4 0FBE out __SREG__,__tmp_reg__ |
||
| 447 | 474 02f6 0F90 pop __tmp_reg__ |
||
| 448 | 475 02f8 1F90 pop __zero_reg__ |
||
| 449 | 476 02fa 1895 reti |
||
| 450 | 477 /* epilogue end (size=17) */ |
||
| 451 | 478 /* function __vector_26 size 342 (308) */ |
||
| 452 | 480 .comm motor_rx,16,1 |
||
| 453 | 481 .comm MotorPresent,2,1 |
||
| 454 | 482 .comm MotorError,2,1 |
||
| 455 | 483 .comm Mixer,77,1 |
||
| 456 | 484 .comm motor_rx2,16,1 |
||
| 457 | 485 /* File "twimaster.c": code 407 = 0x0197 ( 365), prologues 17, epilogues 25 */ |
||
| 458 | DEFINED SYMBOLS |
||
| 459 | *ABS*:00000000 twimaster.c |
||
| 460 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:3 *ABS*:0000003f __SREG__ |
||
| 461 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:4 *ABS*:0000003e __SP_H__ |
||
| 462 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:5 *ABS*:0000003d __SP_L__ |
||
| 463 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:6 *ABS*:00000000 __tmp_reg__ |
||
| 464 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:7 *ABS*:00000001 __zero_reg__ |
||
| 465 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:15 .bss:00000000 I2CError |
||
| 466 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:21 .bss:00000002 MissingMotor |
||
| 467 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:27 .bss:00000003 motorread |
||
| 468 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:33 .bss:00000004 motor |
||
| 469 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:39 .bss:00000005 twi_state |
||
| 470 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:44 .text:00000000 i2c_init |
||
| 471 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:57 .text:0000000c i2c_start |
||
| 472 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:69 .text:00000014 i2c_stop |
||
| 473 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:81 .text:0000001c i2c_write_byte |
||
| 474 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:95 .text:0000002c i2c_reset |
||
| 475 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:120 .text:00000066 I2C_WriteByte |
||
| 476 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:133 .text:00000072 I2C_ReceiveByte |
||
| 477 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:145 .text:0000007a I2C_ReceiveLastByte |
||
| 478 | .bss:00000006 missing_motor.0 |
||
| 479 | C:\Users\Bernd\AppData\Local\Temp/ccqYbtJB.s:158 .text:00000082 __vector_26 |
||
| 480 | *COM*:00000010 motor_rx2 |
||
| 481 | *COM*:0000004d Mixer |
||
| 482 | *COM*:00000010 motor_rx |
||
| 483 | *COM*:00000002 MotorPresent |
||
| 484 | *COM*:00000002 MotorError |
||
| 485 | |||
| 486 | UNDEFINED SYMBOLS |
||
| 487 | __do_copy_data |
||
| 488 | __do_clear_bss |
||
| 489 | __tablejump2__ |
||
| 490 | I2CTimeout |
||
| 491 | AnalogOffsetNick |
||
| 492 | AnalogOffsetRoll |
||
| 493 | AnalogOffsetGier |
||
| 494 | Motor |