| 1,9 → 1,9 |
|---|
| CCS PCH C Compiler, Version 4.090, 47914 15-V-10 23:31 |
| CCS PCH C Compiler, Version 4.090, 47914 15-V-10 23:52 |
| |
| Filename: D:\svnKaklik\programy\C\PIC_C\mereni\inertial\main.lst |
| |
| ROM used: 9690 bytes (30%) |
| Largest free fragment is 23074 |
| ROM used: 9694 bytes (30%) |
| Largest free fragment is 23070 |
| RAM used: 1650 (81%) at main() level |
| 1869 (91%) worst case |
| Stack: 17 worst case (8 in main + 9 for interrupts) |
| 11123,582 → 11123,585 |
|---|
| 1FEA: CLRF 1B |
| 1FEC: CLRF 1A |
| 1FEE: CLRF 19 |
| .................... set_timer0(0); |
| 1FF0: CLRF FD7 |
| 1FF2: CLRF FD6 |
| .................... printf(usb_cdc_putc,"time[s] X Xerr Y Yerr Z Zerr \n\r"); |
| 1FF0: MOVLB 3 |
| 1FF2: CLRF xB1 |
| 1FF4: MOVF xB1,W |
| 1FF6: MOVLB 0 |
| 1FF8: CALL 021E |
| 1FFC: MOVLB 3 |
| 1FFE: INCF xB1,F |
| 2000: MOVWF 00 |
| 2002: MOVFF FE8,6DB |
| 2006: MOVLB 0 |
| 2008: CALL 13D4 |
| 200C: MOVLW 25 |
| 200E: MOVLB 3 |
| 2010: SUBWF xB1,W |
| 2012: BNZ 1FF4 |
| 1FF4: MOVLB 3 |
| 1FF6: CLRF xB1 |
| 1FF8: MOVF xB1,W |
| 1FFA: MOVLB 0 |
| 1FFC: CALL 021E |
| 2000: MOVLB 3 |
| 2002: INCF xB1,F |
| 2004: MOVWF 00 |
| 2006: MOVFF FE8,6DB |
| 200A: MOVLB 0 |
| 200C: CALL 13D4 |
| 2010: MOVLW 25 |
| 2012: MOVLB 3 |
| 2014: SUBWF xB1,W |
| 2016: BNZ 1FF8 |
| .................... |
| .................... while(usb_cdc_connected()) // pockej nez se pripoji seriovy port PC |
| .................... { |
| 2014: MOVLB 0 |
| 2016: BTFSS x80.0 |
| 2018: BRA 25DA |
| 2018: MOVLB 0 |
| 201A: BTFSS x80.0 |
| 201C: BRA 25DE |
| .................... for(i=0; i <BUFLEN; i++) |
| 201A: MOVLB 3 |
| 201C: CLRF xB0 |
| 201E: MOVF xB0,W |
| 2020: SUBLW 63 |
| 2022: BTFSS FD8.0 |
| 2024: BRA 22FC |
| 201E: MOVLB 3 |
| 2020: CLRF xB0 |
| 2022: MOVF xB0,W |
| 2024: SUBLW 63 |
| 2026: BTFSS FD8.0 |
| 2028: BRA 2300 |
| .................... { |
| .................... set_adc_channel(0); |
| 2026: MOVLW 00 |
| 2028: MOVWF 01 |
| 202A: MOVF FC2,W |
| 202C: ANDLW C3 |
| 202E: IORWF 01,W |
| 2030: MOVWF FC2 |
| 202A: MOVLW 00 |
| 202C: MOVWF 01 |
| 202E: MOVF FC2,W |
| 2030: ANDLW C3 |
| 2032: IORWF 01,W |
| 2034: MOVWF FC2 |
| .................... delay_us(10); |
| 2032: MOVLW 13 |
| 2034: MOVWF 00 |
| 2036: DECFSZ 00,F |
| 2038: BRA 2036 |
| 203A: BRA 203C |
| 203C: CLRF 18 |
| 203E: BTFSC FF2.7 |
| 2040: BSF 18.7 |
| 2042: BCF FF2.7 |
| 2036: MOVLW 13 |
| 2038: MOVWF 00 |
| 203A: DECFSZ 00,F |
| 203C: BRA 203A |
| 203E: BRA 2040 |
| 2040: CLRF 18 |
| 2042: BTFSC FF2.7 |
| 2044: BSF 18.7 |
| 2046: BCF FF2.7 |
| .................... x[i]=read_adc(); |
| 2044: MOVLB 7 |
| 2046: CLRF x49 |
| 2048: MOVFF 3B0,748 |
| 204C: CLRF x4B |
| 204E: MOVLW 04 |
| 2050: MOVWF x4A |
| 2052: MOVLB 0 |
| 2054: CALL 02BA |
| 2058: BTFSC 18.7 |
| 205A: BSF FF2.7 |
| 205C: MOVFF 02,03 |
| 2060: MOVF 01,W |
| 2062: ADDLW 84 |
| 2064: MOVWF FE9 |
| 2066: MOVLW 00 |
| 2068: ADDWFC 02,W |
| 206A: MOVWF FEA |
| 206C: BSF FC2.1 |
| 206E: BTFSC FC2.1 |
| 2070: BRA 206E |
| 2072: MOVFF FC4,6D9 |
| 2076: MOVFF FC3,6D8 |
| 207A: MOVLB 0 |
| 207C: CALL 140C |
| 2080: MOVFF 00,FEF |
| 2084: MOVFF 01,FEC |
| 2088: MOVFF 02,FEC |
| 208C: MOVFF 03,FEC |
| 2090: CLRF 18 |
| 2092: BTFSC FF2.7 |
| 2094: BSF 18.7 |
| 2096: BCF FF2.7 |
| 2048: MOVLB 7 |
| 204A: CLRF x49 |
| 204C: MOVFF 3B0,748 |
| 2050: CLRF x4B |
| 2052: MOVLW 04 |
| 2054: MOVWF x4A |
| 2056: MOVLB 0 |
| 2058: CALL 02BA |
| 205C: BTFSC 18.7 |
| 205E: BSF FF2.7 |
| 2060: MOVFF 02,03 |
| 2064: MOVF 01,W |
| 2066: ADDLW 84 |
| 2068: MOVWF FE9 |
| 206A: MOVLW 00 |
| 206C: ADDWFC 02,W |
| 206E: MOVWF FEA |
| 2070: BSF FC2.1 |
| 2072: BTFSC FC2.1 |
| 2074: BRA 2072 |
| 2076: MOVFF FC4,6D9 |
| 207A: MOVFF FC3,6D8 |
| 207E: MOVLB 0 |
| 2080: CALL 140C |
| 2084: MOVFF 00,FEF |
| 2088: MOVFF 01,FEC |
| 208C: MOVFF 02,FEC |
| 2090: MOVFF 03,FEC |
| 2094: CLRF 18 |
| 2096: BTFSC FF2.7 |
| 2098: BSF 18.7 |
| 209A: BCF FF2.7 |
| .................... xavg+=x[i]; |
| 2098: MOVLB 7 |
| 209A: CLRF x49 |
| 209C: MOVFF 3B0,748 |
| 20A0: CLRF x4B |
| 20A2: MOVLW 04 |
| 20A4: MOVWF x4A |
| 20A6: MOVLB 0 |
| 20A8: CALL 02BA |
| 20AC: BTFSC 18.7 |
| 20AE: BSF FF2.7 |
| 20B0: MOVFF 02,03 |
| 20B4: MOVF 01,W |
| 20B6: ADDLW 84 |
| 20B8: MOVWF FE9 |
| 20BA: MOVLW 00 |
| 20BC: ADDWFC 02,W |
| 20BE: MOVWF FEA |
| 20C0: MOVFF FEF,00 |
| 20C4: MOVFF FEC,01 |
| 20C8: MOVFF FEC,02 |
| 20CC: MOVFF FEC,03 |
| 20D0: MOVFF FEA,3B2 |
| 20D4: MOVFF FE9,3B1 |
| 20D8: BCF FD8.1 |
| 20DA: MOVFF 3A7,6ED |
| 20DE: MOVFF 3A6,6EC |
| 20E2: MOVFF 3A5,6EB |
| 20E6: MOVFF 3A4,6EA |
| 20EA: MOVFF 03,6F1 |
| 20EE: MOVFF 02,6F0 |
| 20F2: MOVFF 01,6EF |
| 20F6: MOVFF 00,6EE |
| 20FA: CALL 1442 |
| 20FE: MOVFF 3B2,FEA |
| 2102: MOVFF 3B1,FE9 |
| 2106: MOVFF 03,3A7 |
| 210A: MOVFF 02,3A6 |
| 210E: MOVFF 01,3A5 |
| 2112: MOVFF 00,3A4 |
| 209C: MOVLB 7 |
| 209E: CLRF x49 |
| 20A0: MOVFF 3B0,748 |
| 20A4: CLRF x4B |
| 20A6: MOVLW 04 |
| 20A8: MOVWF x4A |
| 20AA: MOVLB 0 |
| 20AC: CALL 02BA |
| 20B0: BTFSC 18.7 |
| 20B2: BSF FF2.7 |
| 20B4: MOVFF 02,03 |
| 20B8: MOVF 01,W |
| 20BA: ADDLW 84 |
| 20BC: MOVWF FE9 |
| 20BE: MOVLW 00 |
| 20C0: ADDWFC 02,W |
| 20C2: MOVWF FEA |
| 20C4: MOVFF FEF,00 |
| 20C8: MOVFF FEC,01 |
| 20CC: MOVFF FEC,02 |
| 20D0: MOVFF FEC,03 |
| 20D4: MOVFF FEA,3B2 |
| 20D8: MOVFF FE9,3B1 |
| 20DC: BCF FD8.1 |
| 20DE: MOVFF 3A7,6ED |
| 20E2: MOVFF 3A6,6EC |
| 20E6: MOVFF 3A5,6EB |
| 20EA: MOVFF 3A4,6EA |
| 20EE: MOVFF 03,6F1 |
| 20F2: MOVFF 02,6F0 |
| 20F6: MOVFF 01,6EF |
| 20FA: MOVFF 00,6EE |
| 20FE: CALL 1442 |
| 2102: MOVFF 3B2,FEA |
| 2106: MOVFF 3B1,FE9 |
| 210A: MOVFF 03,3A7 |
| 210E: MOVFF 02,3A6 |
| 2112: MOVFF 01,3A5 |
| 2116: MOVFF 00,3A4 |
| .................... |
| .................... set_adc_channel(1); |
| 2116: MOVLW 04 |
| 2118: MOVWF 01 |
| 211A: MOVF FC2,W |
| 211C: ANDLW C3 |
| 211E: IORWF 01,W |
| 2120: MOVWF FC2 |
| 211A: MOVLW 04 |
| 211C: MOVWF 01 |
| 211E: MOVF FC2,W |
| 2120: ANDLW C3 |
| 2122: IORWF 01,W |
| 2124: MOVWF FC2 |
| .................... delay_us(10); |
| 2122: MOVLW 13 |
| 2124: MOVWF 00 |
| 2126: DECFSZ 00,F |
| 2128: BRA 2126 |
| 212A: BRA 212C |
| 212C: CLRF 18 |
| 212E: BTFSC FF2.7 |
| 2130: BSF 18.7 |
| 2132: BCF FF2.7 |
| 2126: MOVLW 13 |
| 2128: MOVWF 00 |
| 212A: DECFSZ 00,F |
| 212C: BRA 212A |
| 212E: BRA 2130 |
| 2130: CLRF 18 |
| 2132: BTFSC FF2.7 |
| 2134: BSF 18.7 |
| 2136: BCF FF2.7 |
| .................... y[i]=read_adc(); |
| 2134: MOVLB 7 |
| 2136: CLRF x49 |
| 2138: MOVFF 3B0,748 |
| 213C: CLRF x4B |
| 213E: MOVLW 04 |
| 2140: MOVWF x4A |
| 2142: MOVLB 0 |
| 2144: CALL 02BA |
| 2148: BTFSC 18.7 |
| 214A: BSF FF2.7 |
| 214C: MOVFF 02,03 |
| 2150: MOVF 01,W |
| 2152: ADDLW 14 |
| 2154: MOVWF FE9 |
| 2156: MOVLW 02 |
| 2158: ADDWFC 02,W |
| 215A: MOVWF FEA |
| 215C: BSF FC2.1 |
| 215E: BTFSC FC2.1 |
| 2160: BRA 215E |
| 2162: MOVFF FC4,6D9 |
| 2166: MOVFF FC3,6D8 |
| 216A: MOVLB 0 |
| 216C: CALL 140C |
| 2170: MOVFF 00,FEF |
| 2174: MOVFF 01,FEC |
| 2178: MOVFF 02,FEC |
| 217C: MOVFF 03,FEC |
| 2180: CLRF 18 |
| 2182: BTFSC FF2.7 |
| 2184: BSF 18.7 |
| 2186: BCF FF2.7 |
| 2138: MOVLB 7 |
| 213A: CLRF x49 |
| 213C: MOVFF 3B0,748 |
| 2140: CLRF x4B |
| 2142: MOVLW 04 |
| 2144: MOVWF x4A |
| 2146: MOVLB 0 |
| 2148: CALL 02BA |
| 214C: BTFSC 18.7 |
| 214E: BSF FF2.7 |
| 2150: MOVFF 02,03 |
| 2154: MOVF 01,W |
| 2156: ADDLW 14 |
| 2158: MOVWF FE9 |
| 215A: MOVLW 02 |
| 215C: ADDWFC 02,W |
| 215E: MOVWF FEA |
| 2160: BSF FC2.1 |
| 2162: BTFSC FC2.1 |
| 2164: BRA 2162 |
| 2166: MOVFF FC4,6D9 |
| 216A: MOVFF FC3,6D8 |
| 216E: MOVLB 0 |
| 2170: CALL 140C |
| 2174: MOVFF 00,FEF |
| 2178: MOVFF 01,FEC |
| 217C: MOVFF 02,FEC |
| 2180: MOVFF 03,FEC |
| 2184: CLRF 18 |
| 2186: BTFSC FF2.7 |
| 2188: BSF 18.7 |
| 218A: BCF FF2.7 |
| .................... yavg+=y[i]; |
| 2188: MOVLB 7 |
| 218A: CLRF x49 |
| 218C: MOVFF 3B0,748 |
| 2190: CLRF x4B |
| 2192: MOVLW 04 |
| 2194: MOVWF x4A |
| 2196: MOVLB 0 |
| 2198: CALL 02BA |
| 219C: BTFSC 18.7 |
| 219E: BSF FF2.7 |
| 21A0: MOVFF 02,03 |
| 21A4: MOVF 01,W |
| 21A6: ADDLW 14 |
| 21A8: MOVWF FE9 |
| 21AA: MOVLW 02 |
| 21AC: ADDWFC 02,W |
| 21AE: MOVWF FEA |
| 21B0: MOVFF FEF,00 |
| 21B4: MOVFF FEC,01 |
| 21B8: MOVFF FEC,02 |
| 21BC: MOVFF FEC,03 |
| 21C0: MOVFF FEA,3B2 |
| 21C4: MOVFF FE9,3B1 |
| 21C8: BCF FD8.1 |
| 21CA: MOVFF 3AB,6ED |
| 21CE: MOVFF 3AA,6EC |
| 21D2: MOVFF 3A9,6EB |
| 21D6: MOVFF 3A8,6EA |
| 21DA: MOVFF 03,6F1 |
| 21DE: MOVFF 02,6F0 |
| 21E2: MOVFF 01,6EF |
| 21E6: MOVFF 00,6EE |
| 21EA: CALL 1442 |
| 21EE: MOVFF 3B2,FEA |
| 21F2: MOVFF 3B1,FE9 |
| 21F6: MOVFF 03,3AB |
| 21FA: MOVFF 02,3AA |
| 21FE: MOVFF 01,3A9 |
| 2202: MOVFF 00,3A8 |
| 218C: MOVLB 7 |
| 218E: CLRF x49 |
| 2190: MOVFF 3B0,748 |
| 2194: CLRF x4B |
| 2196: MOVLW 04 |
| 2198: MOVWF x4A |
| 219A: MOVLB 0 |
| 219C: CALL 02BA |
| 21A0: BTFSC 18.7 |
| 21A2: BSF FF2.7 |
| 21A4: MOVFF 02,03 |
| 21A8: MOVF 01,W |
| 21AA: ADDLW 14 |
| 21AC: MOVWF FE9 |
| 21AE: MOVLW 02 |
| 21B0: ADDWFC 02,W |
| 21B2: MOVWF FEA |
| 21B4: MOVFF FEF,00 |
| 21B8: MOVFF FEC,01 |
| 21BC: MOVFF FEC,02 |
| 21C0: MOVFF FEC,03 |
| 21C4: MOVFF FEA,3B2 |
| 21C8: MOVFF FE9,3B1 |
| 21CC: BCF FD8.1 |
| 21CE: MOVFF 3AB,6ED |
| 21D2: MOVFF 3AA,6EC |
| 21D6: MOVFF 3A9,6EB |
| 21DA: MOVFF 3A8,6EA |
| 21DE: MOVFF 03,6F1 |
| 21E2: MOVFF 02,6F0 |
| 21E6: MOVFF 01,6EF |
| 21EA: MOVFF 00,6EE |
| 21EE: CALL 1442 |
| 21F2: MOVFF 3B2,FEA |
| 21F6: MOVFF 3B1,FE9 |
| 21FA: MOVFF 03,3AB |
| 21FE: MOVFF 02,3AA |
| 2202: MOVFF 01,3A9 |
| 2206: MOVFF 00,3A8 |
| .................... |
| .................... set_adc_channel(2); |
| 2206: MOVLW 08 |
| 2208: MOVWF 01 |
| 220A: MOVF FC2,W |
| 220C: ANDLW C3 |
| 220E: IORWF 01,W |
| 2210: MOVWF FC2 |
| 220A: MOVLW 08 |
| 220C: MOVWF 01 |
| 220E: MOVF FC2,W |
| 2210: ANDLW C3 |
| 2212: IORWF 01,W |
| 2214: MOVWF FC2 |
| .................... delay_us(10); |
| 2212: MOVLW 13 |
| 2214: MOVWF 00 |
| 2216: DECFSZ 00,F |
| 2218: BRA 2216 |
| 221A: BRA 221C |
| 221C: CLRF 18 |
| 221E: BTFSC FF2.7 |
| 2220: BSF 18.7 |
| 2222: BCF FF2.7 |
| 2216: MOVLW 13 |
| 2218: MOVWF 00 |
| 221A: DECFSZ 00,F |
| 221C: BRA 221A |
| 221E: BRA 2220 |
| 2220: CLRF 18 |
| 2222: BTFSC FF2.7 |
| 2224: BSF 18.7 |
| 2226: BCF FF2.7 |
| .................... z[i]=read_adc(); |
| 2224: MOVLB 7 |
| 2226: CLRF x49 |
| 2228: MOVFF 3B0,748 |
| 222C: CLRF x4B |
| 222E: MOVLW 04 |
| 2230: MOVWF x4A |
| 2232: MOVLB 0 |
| 2234: CALL 02BA |
| 2238: BTFSC 18.7 |
| 223A: BSF FF2.7 |
| 223C: MOVFF 02,03 |
| 2240: MOVF 01,W |
| 2242: ADDLW 20 |
| 2244: MOVWF FE9 |
| 2246: MOVLW 05 |
| 2248: ADDWFC 02,W |
| 224A: MOVWF FEA |
| 224C: BSF FC2.1 |
| 224E: BTFSC FC2.1 |
| 2250: BRA 224E |
| 2252: MOVFF FC4,6D9 |
| 2256: MOVFF FC3,6D8 |
| 225A: MOVLB 0 |
| 225C: CALL 140C |
| 2260: MOVFF 00,FEF |
| 2264: MOVFF 01,FEC |
| 2268: MOVFF 02,FEC |
| 226C: MOVFF 03,FEC |
| 2270: CLRF 18 |
| 2272: BTFSC FF2.7 |
| 2274: BSF 18.7 |
| 2276: BCF FF2.7 |
| 2228: MOVLB 7 |
| 222A: CLRF x49 |
| 222C: MOVFF 3B0,748 |
| 2230: CLRF x4B |
| 2232: MOVLW 04 |
| 2234: MOVWF x4A |
| 2236: MOVLB 0 |
| 2238: CALL 02BA |
| 223C: BTFSC 18.7 |
| 223E: BSF FF2.7 |
| 2240: MOVFF 02,03 |
| 2244: MOVF 01,W |
| 2246: ADDLW 20 |
| 2248: MOVWF FE9 |
| 224A: MOVLW 05 |
| 224C: ADDWFC 02,W |
| 224E: MOVWF FEA |
| 2250: BSF FC2.1 |
| 2252: BTFSC FC2.1 |
| 2254: BRA 2252 |
| 2256: MOVFF FC4,6D9 |
| 225A: MOVFF FC3,6D8 |
| 225E: MOVLB 0 |
| 2260: CALL 140C |
| 2264: MOVFF 00,FEF |
| 2268: MOVFF 01,FEC |
| 226C: MOVFF 02,FEC |
| 2270: MOVFF 03,FEC |
| 2274: CLRF 18 |
| 2276: BTFSC FF2.7 |
| 2278: BSF 18.7 |
| 227A: BCF FF2.7 |
| .................... zavg+=z[i]; |
| 2278: MOVLB 7 |
| 227A: CLRF x49 |
| 227C: MOVFF 3B0,748 |
| 2280: CLRF x4B |
| 2282: MOVLW 04 |
| 2284: MOVWF x4A |
| 2286: MOVLB 0 |
| 2288: CALL 02BA |
| 228C: BTFSC 18.7 |
| 228E: BSF FF2.7 |
| 2290: MOVFF 02,03 |
| 2294: MOVF 01,W |
| 2296: ADDLW 20 |
| 2298: MOVWF FE9 |
| 229A: MOVLW 05 |
| 229C: ADDWFC 02,W |
| 229E: MOVWF FEA |
| 22A0: MOVFF FEF,00 |
| 22A4: MOVFF FEC,01 |
| 22A8: MOVFF FEC,02 |
| 22AC: MOVFF FEC,03 |
| 22B0: MOVFF FEA,3B2 |
| 22B4: MOVFF FE9,3B1 |
| 22B8: BCF FD8.1 |
| 22BA: MOVFF 3AF,6ED |
| 22BE: MOVFF 3AE,6EC |
| 22C2: MOVFF 3AD,6EB |
| 22C6: MOVFF 3AC,6EA |
| 22CA: MOVFF 03,6F1 |
| 22CE: MOVFF 02,6F0 |
| 22D2: MOVFF 01,6EF |
| 22D6: MOVFF 00,6EE |
| 22DA: CALL 1442 |
| 22DE: MOVFF 3B2,FEA |
| 22E2: MOVFF 3B1,FE9 |
| 22E6: MOVFF 03,3AF |
| 22EA: MOVFF 02,3AE |
| 22EE: MOVFF 01,3AD |
| 22F2: MOVFF 00,3AC |
| 227C: MOVLB 7 |
| 227E: CLRF x49 |
| 2280: MOVFF 3B0,748 |
| 2284: CLRF x4B |
| 2286: MOVLW 04 |
| 2288: MOVWF x4A |
| 228A: MOVLB 0 |
| 228C: CALL 02BA |
| 2290: BTFSC 18.7 |
| 2292: BSF FF2.7 |
| 2294: MOVFF 02,03 |
| 2298: MOVF 01,W |
| 229A: ADDLW 20 |
| 229C: MOVWF FE9 |
| 229E: MOVLW 05 |
| 22A0: ADDWFC 02,W |
| 22A2: MOVWF FEA |
| 22A4: MOVFF FEF,00 |
| 22A8: MOVFF FEC,01 |
| 22AC: MOVFF FEC,02 |
| 22B0: MOVFF FEC,03 |
| 22B4: MOVFF FEA,3B2 |
| 22B8: MOVFF FE9,3B1 |
| 22BC: BCF FD8.1 |
| 22BE: MOVFF 3AF,6ED |
| 22C2: MOVFF 3AE,6EC |
| 22C6: MOVFF 3AD,6EB |
| 22CA: MOVFF 3AC,6EA |
| 22CE: MOVFF 03,6F1 |
| 22D2: MOVFF 02,6F0 |
| 22D6: MOVFF 01,6EF |
| 22DA: MOVFF 00,6EE |
| 22DE: CALL 1442 |
| 22E2: MOVFF 3B2,FEA |
| 22E6: MOVFF 3B1,FE9 |
| 22EA: MOVFF 03,3AF |
| 22EE: MOVFF 02,3AE |
| 22F2: MOVFF 01,3AD |
| 22F6: MOVFF 00,3AC |
| .................... } |
| 22F6: MOVLB 3 |
| 22F8: INCF xB0,F |
| 22FA: BRA 201E |
| 22FA: MOVLB 3 |
| 22FC: INCF xB0,F |
| 22FE: BRA 2022 |
| .................... |
| .................... xavg=xavg/BUFLEN; |
| 22FC: MOVFF 3A7,6ED |
| 2300: MOVFF 3A6,6EC |
| 2304: MOVFF 3A5,6EB |
| 2308: MOVFF 3A4,6EA |
| 230C: MOVLB 6 |
| 230E: CLRF xF1 |
| 2310: CLRF xF0 |
| 2312: MOVLW 48 |
| 2314: MOVWF xEF |
| 2316: MOVLW 85 |
| 2318: MOVWF xEE |
| 231A: MOVLB 0 |
| 231C: CALL 16BA |
| 2320: MOVFF 03,3A7 |
| 2324: MOVFF 02,3A6 |
| 2328: MOVFF 01,3A5 |
| 232C: MOVFF 00,3A4 |
| 2300: MOVFF 3A7,6ED |
| 2304: MOVFF 3A6,6EC |
| 2308: MOVFF 3A5,6EB |
| 230C: MOVFF 3A4,6EA |
| 2310: MOVLB 6 |
| 2312: CLRF xF1 |
| 2314: CLRF xF0 |
| 2316: MOVLW 48 |
| 2318: MOVWF xEF |
| 231A: MOVLW 85 |
| 231C: MOVWF xEE |
| 231E: MOVLB 0 |
| 2320: CALL 16BA |
| 2324: MOVFF 03,3A7 |
| 2328: MOVFF 02,3A6 |
| 232C: MOVFF 01,3A5 |
| 2330: MOVFF 00,3A4 |
| .................... yavg=yavg/BUFLEN; |
| 2330: MOVFF 3AB,6ED |
| 2334: MOVFF 3AA,6EC |
| 2338: MOVFF 3A9,6EB |
| 233C: MOVFF 3A8,6EA |
| 2340: MOVLB 6 |
| 2342: CLRF xF1 |
| 2344: CLRF xF0 |
| 2346: MOVLW 48 |
| 2348: MOVWF xEF |
| 234A: MOVLW 85 |
| 234C: MOVWF xEE |
| 234E: MOVLB 0 |
| 2350: CALL 16BA |
| 2354: MOVFF 03,3AB |
| 2358: MOVFF 02,3AA |
| 235C: MOVFF 01,3A9 |
| 2360: MOVFF 00,3A8 |
| 2334: MOVFF 3AB,6ED |
| 2338: MOVFF 3AA,6EC |
| 233C: MOVFF 3A9,6EB |
| 2340: MOVFF 3A8,6EA |
| 2344: MOVLB 6 |
| 2346: CLRF xF1 |
| 2348: CLRF xF0 |
| 234A: MOVLW 48 |
| 234C: MOVWF xEF |
| 234E: MOVLW 85 |
| 2350: MOVWF xEE |
| 2352: MOVLB 0 |
| 2354: CALL 16BA |
| 2358: MOVFF 03,3AB |
| 235C: MOVFF 02,3AA |
| 2360: MOVFF 01,3A9 |
| 2364: MOVFF 00,3A8 |
| .................... zavg=zavg/BUFLEN; |
| 2364: MOVFF 3AF,6ED |
| 2368: MOVFF 3AE,6EC |
| 236C: MOVFF 3AD,6EB |
| 2370: MOVFF 3AC,6EA |
| 2374: MOVLB 6 |
| 2376: CLRF xF1 |
| 2378: CLRF xF0 |
| 237A: MOVLW 48 |
| 237C: MOVWF xEF |
| 237E: MOVLW 85 |
| 2380: MOVWF xEE |
| 2382: MOVLB 0 |
| 2384: CALL 16BA |
| 2388: MOVFF 03,3AF |
| 238C: MOVFF 02,3AE |
| 2390: MOVFF 01,3AD |
| 2394: MOVFF 00,3AC |
| 2368: MOVFF 3AF,6ED |
| 236C: MOVFF 3AE,6EC |
| 2370: MOVFF 3AD,6EB |
| 2374: MOVFF 3AC,6EA |
| 2378: MOVLB 6 |
| 237A: CLRF xF1 |
| 237C: CLRF xF0 |
| 237E: MOVLW 48 |
| 2380: MOVWF xEF |
| 2382: MOVLW 85 |
| 2384: MOVWF xEE |
| 2386: MOVLB 0 |
| 2388: CALL 16BA |
| 238C: MOVFF 03,3AF |
| 2390: MOVFF 02,3AE |
| 2394: MOVFF 01,3AD |
| 2398: MOVFF 00,3AC |
| .................... |
| .................... // odesli namerene hodnoty |
| .................... printf(usb_cdc_putc, "%7.3f %4.3f %4.3f %4.3f %4.3f %4.3f %4.3f \n\r",((time << 16) + get_timer0())/15625.0, xavg, quadraticerror(xavg,x,BUFLEN), yavg, quadraticerror(yavg,y,BUFLEN), zavg, quadraticerror(zavg,z,BUFLEN)); //konstanta k je kvuli prevodu do rozzumnych jednotek [s] |
| 2398: MOVFF 1A,3B5 |
| 239C: MOVFF 19,3B4 |
| 23A0: MOVLB 3 |
| 23A2: CLRF xB2 |
| 23A4: CLRF xB3 |
| 23A6: MOVF FD6,W |
| 23A8: MOVFF FD7,03 |
| 23AC: ADDWF xB2,F |
| 23AE: MOVF FD7,W |
| 23B0: ADDWFC xB3,F |
| 23B2: MOVLW 00 |
| 23B4: ADDWFC xB4,F |
| 23B6: ADDWFC xB5,F |
| 23B8: MOVFF 3B5,6C5 |
| 23BC: MOVFF 3B4,6C4 |
| 23C0: MOVFF 3B3,6C3 |
| 23C4: MOVFF 3B2,6C2 |
| 23C8: MOVLB 0 |
| 23CA: GOTO 1818 |
| 23CE: MOVFF 03,6ED |
| 23D2: MOVFF 02,6EC |
| 23D6: MOVFF 01,6EB |
| 23DA: MOVFF 00,6EA |
| 23DE: MOVLB 6 |
| 23E0: CLRF xF1 |
| 23E2: MOVLW 24 |
| 23E4: MOVWF xF0 |
| 23E6: MOVLW 74 |
| 23E8: MOVWF xEF |
| 23EA: MOVLW 8C |
| 23EC: MOVWF xEE |
| 23EE: MOVLB 0 |
| 23F0: CALL 16BA |
| 23F4: MOVFF 00,3B2 |
| 23F8: MOVFF 01,3B3 |
| 23FC: MOVFF 02,3B4 |
| 2400: MOVFF 03,3B5 |
| 2404: MOVFF 3A7,6CD |
| 2408: MOVFF 3A6,6CC |
| 240C: MOVFF 3A5,6CB |
| 2410: MOVFF 3A4,6CA |
| 2414: MOVLB 6 |
| 2416: CLRF xCF |
| 2418: MOVLW 84 |
| 241A: MOVWF xCE |
| 241C: CLRF xD1 |
| 241E: MOVLW 64 |
| 2420: MOVWF xD0 |
| 2422: MOVLB 0 |
| 2424: CALL 1AE2 |
| 2428: MOVFF 00,3B6 |
| 242C: MOVFF 01,3B7 |
| 2430: MOVFF 02,3B8 |
| 2434: MOVFF 03,3B9 |
| 2438: MOVFF 3AB,6CD |
| 243C: MOVFF 3AA,6CC |
| 2440: MOVFF 3A9,6CB |
| 2444: MOVFF 3A8,6CA |
| 2448: MOVLW 02 |
| 244A: MOVLB 6 |
| 244C: MOVWF xCF |
| 244E: MOVLW 14 |
| 2450: MOVWF xCE |
| 2452: CLRF xD1 |
| 2454: MOVLW 64 |
| 2456: MOVWF xD0 |
| 2458: MOVLB 0 |
| 245A: CALL 1AE2 |
| 245E: MOVFF 00,3BA |
| 2462: MOVFF 01,3BB |
| 2466: MOVFF 02,3BC |
| 246A: MOVFF 03,3BD |
| 246E: MOVFF 3AF,6CD |
| 2472: MOVFF 3AE,6CC |
| 2476: MOVFF 3AD,6CB |
| 247A: MOVFF 3AC,6CA |
| 247E: MOVLW 05 |
| 2480: MOVLB 6 |
| 2482: MOVWF xCF |
| 2484: MOVLW 20 |
| 2486: MOVWF xCE |
| 2488: CLRF xD1 |
| 248A: MOVLW 64 |
| 248C: MOVWF xD0 |
| 248E: MOVLB 0 |
| 2490: CALL 1AE2 |
| 2494: MOVFF 00,3BE |
| 2498: MOVFF 01,3BF |
| 249C: MOVFF 02,3C0 |
| 24A0: MOVFF 03,3C1 |
| 24A4: MOVLW 06 |
| 24A6: MOVWF FE9 |
| 24A8: MOVFF 3B5,6D1 |
| 24AC: MOVFF 3B4,6D0 |
| 24B0: MOVFF 3B3,6CF |
| 24B4: MOVFF 3B2,6CE |
| 24B8: MOVLW 03 |
| 24BA: MOVLB 6 |
| 24BC: MOVWF xD2 |
| 24BE: MOVLB 0 |
| 24C0: RCALL 1DB0 |
| 24C2: MOVLW 20 |
| 24C4: MOVLB 6 |
| 24C6: MOVWF xDB |
| 24C8: MOVLB 0 |
| 24CA: CALL 13D4 |
| 24CE: MOVLW 03 |
| 24D0: MOVWF FE9 |
| 24D2: MOVFF 3A7,6D1 |
| 24D6: MOVFF 3A6,6D0 |
| 24DA: MOVFF 3A5,6CF |
| 24DE: MOVFF 3A4,6CE |
| 24E2: MOVLB 6 |
| 24E4: MOVWF xD2 |
| 24E6: MOVLB 0 |
| 24E8: RCALL 1DB0 |
| 24EA: MOVLW 20 |
| 24EC: MOVLB 6 |
| 24EE: MOVWF xDB |
| 24F0: MOVLB 0 |
| 24F2: CALL 13D4 |
| 24F6: MOVLW 03 |
| 24F8: MOVWF FE9 |
| 24FA: MOVFF 3B9,6D1 |
| 24FE: MOVFF 3B8,6D0 |
| 2502: MOVFF 3B7,6CF |
| 2506: MOVFF 3B6,6CE |
| 250A: MOVLB 6 |
| 250C: MOVWF xD2 |
| 250E: MOVLB 0 |
| 2510: RCALL 1DB0 |
| 2512: MOVLW 20 |
| 2514: MOVLB 6 |
| 2516: MOVWF xDB |
| 2518: MOVLB 0 |
| 251A: CALL 13D4 |
| 251E: MOVLW 03 |
| 2520: MOVWF FE9 |
| 2522: MOVFF 3AB,6D1 |
| 2526: MOVFF 3AA,6D0 |
| 252A: MOVFF 3A9,6CF |
| 252E: MOVFF 3A8,6CE |
| 2532: MOVLB 6 |
| 2534: MOVWF xD2 |
| 2536: MOVLB 0 |
| 2538: RCALL 1DB0 |
| 253A: MOVLW 20 |
| 253C: MOVLB 6 |
| 253E: MOVWF xDB |
| 2540: MOVLB 0 |
| 2542: CALL 13D4 |
| 2546: MOVLW 03 |
| 2548: MOVWF FE9 |
| 254A: MOVFF 3BD,6D1 |
| 254E: MOVFF 3BC,6D0 |
| 2552: MOVFF 3BB,6CF |
| 2556: MOVFF 3BA,6CE |
| 255A: MOVLB 6 |
| 255C: MOVWF xD2 |
| 255E: MOVLB 0 |
| 2560: RCALL 1DB0 |
| 2562: MOVLW 20 |
| 2564: MOVLB 6 |
| 2566: MOVWF xDB |
| 2568: MOVLB 0 |
| 256A: CALL 13D4 |
| 256E: MOVLW 03 |
| 2570: MOVWF FE9 |
| 2572: MOVFF 3AF,6D1 |
| 2576: MOVFF 3AE,6D0 |
| 257A: MOVFF 3AD,6CF |
| 257E: MOVFF 3AC,6CE |
| 2582: MOVLB 6 |
| 2584: MOVWF xD2 |
| 2586: MOVLB 0 |
| 2588: RCALL 1DB0 |
| 258A: MOVLW 20 |
| 258C: MOVLB 6 |
| 258E: MOVWF xDB |
| 2590: MOVLB 0 |
| 2592: CALL 13D4 |
| 2596: MOVLW 03 |
| 2598: MOVWF FE9 |
| 259A: MOVFF 3C1,6D1 |
| 259E: MOVFF 3C0,6D0 |
| 25A2: MOVFF 3BF,6CF |
| 25A6: MOVFF 3BE,6CE |
| 25AA: MOVLB 6 |
| 25AC: MOVWF xD2 |
| 25AE: MOVLB 0 |
| 25B0: CALL 1DB0 |
| 25B4: MOVLW 20 |
| 25B6: MOVLB 6 |
| 25B8: MOVWF xDB |
| 25BA: MOVLB 0 |
| 25BC: CALL 13D4 |
| 25C0: MOVLW 0A |
| 25C2: MOVLB 6 |
| 25C4: MOVWF xDB |
| 25C6: MOVLB 0 |
| 25C8: CALL 13D4 |
| 25CC: MOVLW 0D |
| 25CE: MOVLB 6 |
| 25D0: MOVWF xDB |
| 25D2: MOVLB 0 |
| 25D4: CALL 13D4 |
| 239C: MOVFF 1A,3B5 |
| 23A0: MOVFF 19,3B4 |
| 23A4: MOVLB 3 |
| 23A6: CLRF xB2 |
| 23A8: CLRF xB3 |
| 23AA: MOVF FD6,W |
| 23AC: MOVFF FD7,03 |
| 23B0: ADDWF xB2,F |
| 23B2: MOVF FD7,W |
| 23B4: ADDWFC xB3,F |
| 23B6: MOVLW 00 |
| 23B8: ADDWFC xB4,F |
| 23BA: ADDWFC xB5,F |
| 23BC: MOVFF 3B5,6C5 |
| 23C0: MOVFF 3B4,6C4 |
| 23C4: MOVFF 3B3,6C3 |
| 23C8: MOVFF 3B2,6C2 |
| 23CC: MOVLB 0 |
| 23CE: GOTO 1818 |
| 23D2: MOVFF 03,6ED |
| 23D6: MOVFF 02,6EC |
| 23DA: MOVFF 01,6EB |
| 23DE: MOVFF 00,6EA |
| 23E2: MOVLB 6 |
| 23E4: CLRF xF1 |
| 23E6: MOVLW 24 |
| 23E8: MOVWF xF0 |
| 23EA: MOVLW 74 |
| 23EC: MOVWF xEF |
| 23EE: MOVLW 8C |
| 23F0: MOVWF xEE |
| 23F2: MOVLB 0 |
| 23F4: CALL 16BA |
| 23F8: MOVFF 00,3B2 |
| 23FC: MOVFF 01,3B3 |
| 2400: MOVFF 02,3B4 |
| 2404: MOVFF 03,3B5 |
| 2408: MOVFF 3A7,6CD |
| 240C: MOVFF 3A6,6CC |
| 2410: MOVFF 3A5,6CB |
| 2414: MOVFF 3A4,6CA |
| 2418: MOVLB 6 |
| 241A: CLRF xCF |
| 241C: MOVLW 84 |
| 241E: MOVWF xCE |
| 2420: CLRF xD1 |
| 2422: MOVLW 64 |
| 2424: MOVWF xD0 |
| 2426: MOVLB 0 |
| 2428: CALL 1AE2 |
| 242C: MOVFF 00,3B6 |
| 2430: MOVFF 01,3B7 |
| 2434: MOVFF 02,3B8 |
| 2438: MOVFF 03,3B9 |
| 243C: MOVFF 3AB,6CD |
| 2440: MOVFF 3AA,6CC |
| 2444: MOVFF 3A9,6CB |
| 2448: MOVFF 3A8,6CA |
| 244C: MOVLW 02 |
| 244E: MOVLB 6 |
| 2450: MOVWF xCF |
| 2452: MOVLW 14 |
| 2454: MOVWF xCE |
| 2456: CLRF xD1 |
| 2458: MOVLW 64 |
| 245A: MOVWF xD0 |
| 245C: MOVLB 0 |
| 245E: CALL 1AE2 |
| 2462: MOVFF 00,3BA |
| 2466: MOVFF 01,3BB |
| 246A: MOVFF 02,3BC |
| 246E: MOVFF 03,3BD |
| 2472: MOVFF 3AF,6CD |
| 2476: MOVFF 3AE,6CC |
| 247A: MOVFF 3AD,6CB |
| 247E: MOVFF 3AC,6CA |
| 2482: MOVLW 05 |
| 2484: MOVLB 6 |
| 2486: MOVWF xCF |
| 2488: MOVLW 20 |
| 248A: MOVWF xCE |
| 248C: CLRF xD1 |
| 248E: MOVLW 64 |
| 2490: MOVWF xD0 |
| 2492: MOVLB 0 |
| 2494: CALL 1AE2 |
| 2498: MOVFF 00,3BE |
| 249C: MOVFF 01,3BF |
| 24A0: MOVFF 02,3C0 |
| 24A4: MOVFF 03,3C1 |
| 24A8: MOVLW 06 |
| 24AA: MOVWF FE9 |
| 24AC: MOVFF 3B5,6D1 |
| 24B0: MOVFF 3B4,6D0 |
| 24B4: MOVFF 3B3,6CF |
| 24B8: MOVFF 3B2,6CE |
| 24BC: MOVLW 03 |
| 24BE: MOVLB 6 |
| 24C0: MOVWF xD2 |
| 24C2: MOVLB 0 |
| 24C4: RCALL 1DB0 |
| 24C6: MOVLW 20 |
| 24C8: MOVLB 6 |
| 24CA: MOVWF xDB |
| 24CC: MOVLB 0 |
| 24CE: CALL 13D4 |
| 24D2: MOVLW 03 |
| 24D4: MOVWF FE9 |
| 24D6: MOVFF 3A7,6D1 |
| 24DA: MOVFF 3A6,6D0 |
| 24DE: MOVFF 3A5,6CF |
| 24E2: MOVFF 3A4,6CE |
| 24E6: MOVLB 6 |
| 24E8: MOVWF xD2 |
| 24EA: MOVLB 0 |
| 24EC: RCALL 1DB0 |
| 24EE: MOVLW 20 |
| 24F0: MOVLB 6 |
| 24F2: MOVWF xDB |
| 24F4: MOVLB 0 |
| 24F6: CALL 13D4 |
| 24FA: MOVLW 03 |
| 24FC: MOVWF FE9 |
| 24FE: MOVFF 3B9,6D1 |
| 2502: MOVFF 3B8,6D0 |
| 2506: MOVFF 3B7,6CF |
| 250A: MOVFF 3B6,6CE |
| 250E: MOVLB 6 |
| 2510: MOVWF xD2 |
| 2512: MOVLB 0 |
| 2514: RCALL 1DB0 |
| 2516: MOVLW 20 |
| 2518: MOVLB 6 |
| 251A: MOVWF xDB |
| 251C: MOVLB 0 |
| 251E: CALL 13D4 |
| 2522: MOVLW 03 |
| 2524: MOVWF FE9 |
| 2526: MOVFF 3AB,6D1 |
| 252A: MOVFF 3AA,6D0 |
| 252E: MOVFF 3A9,6CF |
| 2532: MOVFF 3A8,6CE |
| 2536: MOVLB 6 |
| 2538: MOVWF xD2 |
| 253A: MOVLB 0 |
| 253C: RCALL 1DB0 |
| 253E: MOVLW 20 |
| 2540: MOVLB 6 |
| 2542: MOVWF xDB |
| 2544: MOVLB 0 |
| 2546: CALL 13D4 |
| 254A: MOVLW 03 |
| 254C: MOVWF FE9 |
| 254E: MOVFF 3BD,6D1 |
| 2552: MOVFF 3BC,6D0 |
| 2556: MOVFF 3BB,6CF |
| 255A: MOVFF 3BA,6CE |
| 255E: MOVLB 6 |
| 2560: MOVWF xD2 |
| 2562: MOVLB 0 |
| 2564: RCALL 1DB0 |
| 2566: MOVLW 20 |
| 2568: MOVLB 6 |
| 256A: MOVWF xDB |
| 256C: MOVLB 0 |
| 256E: CALL 13D4 |
| 2572: MOVLW 03 |
| 2574: MOVWF FE9 |
| 2576: MOVFF 3AF,6D1 |
| 257A: MOVFF 3AE,6D0 |
| 257E: MOVFF 3AD,6CF |
| 2582: MOVFF 3AC,6CE |
| 2586: MOVLB 6 |
| 2588: MOVWF xD2 |
| 258A: MOVLB 0 |
| 258C: RCALL 1DB0 |
| 258E: MOVLW 20 |
| 2590: MOVLB 6 |
| 2592: MOVWF xDB |
| 2594: MOVLB 0 |
| 2596: CALL 13D4 |
| 259A: MOVLW 03 |
| 259C: MOVWF FE9 |
| 259E: MOVFF 3C1,6D1 |
| 25A2: MOVFF 3C0,6D0 |
| 25A6: MOVFF 3BF,6CF |
| 25AA: MOVFF 3BE,6CE |
| 25AE: MOVLB 6 |
| 25B0: MOVWF xD2 |
| 25B2: MOVLB 0 |
| 25B4: CALL 1DB0 |
| 25B8: MOVLW 20 |
| 25BA: MOVLB 6 |
| 25BC: MOVWF xDB |
| 25BE: MOVLB 0 |
| 25C0: CALL 13D4 |
| 25C4: MOVLW 0A |
| 25C6: MOVLB 6 |
| 25C8: MOVWF xDB |
| 25CA: MOVLB 0 |
| 25CC: CALL 13D4 |
| 25D0: MOVLW 0D |
| 25D2: MOVLB 6 |
| 25D4: MOVWF xDB |
| 25D6: MOVLB 0 |
| 25D8: CALL 13D4 |
| .................... } |
| 25D8: BRA 2016 |
| 25DC: BRA 201A |
| .................... } |
| 25DA: BRA 1FE4 |
| 25DE: BRA 1FE4 |
| .................... } |
| 25DC: SLEEP |
| 25E0: SLEEP |
| |
| Configuration Fuses: |
| Word 1: CE3C IESO FCMEN HSPLL PLL5 CPUDIV4 USBDIV |