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