Blame | Last modification | View Log | Download
CCS PCW C Compiler, Version 3.110, 15448Filename: d:\@kaklik\programy\pic_c\prenos\letadlo\prijimac\main.LSTROM used: 687 (67%)Largest free fragment is 337RAM used: 12 (18%) at main() level24 (35%) worst caseStack: 5 locations*0000: MOVLW 000001: MOVWF 0A0002: GOTO 1CE0003: NOP.................... // Prijimac........................................ #DEFINE DEBUG PIN_A2 // ladici pomocne synchronizacni impulzy........................................ #include "main.h".................... #include <16F84.h>.................... //////// Standard Header file for the PIC16F84 device ////////////////.................... #device PIC16F84.................... #list........................................ #use delay(clock=4000000)*0015: MOVLW 1B0016: MOVWF 040017: MOVF 00,W0018: BTFSC 03.20019: GOTO 029001A: MOVLW 01001B: MOVWF 0D001C: CLRF 0C001D: DECFSZ 0C,F001E: GOTO 01D001F: DECFSZ 0D,F0020: GOTO 01C0021: MOVLW 4A0022: MOVWF 0C0023: DECFSZ 0C,F0024: GOTO 0230025: NOP0026: NOP0027: DECFSZ 00,F0028: GOTO 01A0029: RETLW 00.................... #fuses XT,NOWDT,PUT............................................................ #include "..\common.h".................... #DEFINE OSA_X 1 // adresy os.................... #DEFINE OSA_Y 2.................... #DEFINE TLs 3.................... #DEFINE IMPULS 250 // sirka impulsu.................... #DEFINE SYNC_NIBBLE 0b1111 // magiske cislo sync niblu............................................................ #DEFINE LCD_RS PIN_B1 // rizeni registru LCD displeje.................... #DEFINE LCD_E PIN_B0 // enable LCD displeje.................... #DEFINE LCD_DATA_LSB PIN_B2 // pripojeni LSB bitu datoveho portu LCD displeje (celkem 4 bity vzestupne za sebou).................... #INCLUDE "MYLCD.C".................... // LCD modul pro ovladani dvouradkoveho LCD modulu se standardnim Hitachi radicem.................... // (c)miho 2002.................... //.................... // Historie:.................... //.................... // 0.0 Uvodni verze se snadnou definici portu LCD displeje.................... //.................... //.................... // Funkce:.................... //.................... // lcd_init() inicializuje LCD displej a porty, nutno volat jako prvni.................... //.................... // lcd_putc(c) zapis snaku do lcd displeje, zpracovava nasledujici ridici znaky.................... // \f = \x0C - nova stranka - smazani displeje.................... // \n = \x0A - odradkovani (prechod na druhou radku).................... // \b = \x08 - backspace - posunuti kurzoru o 1 pozici zpet.................... // \r = \x0D - goto home to position 1,1.................... // \0 .. \7 - definovatelne znaky v pozicich 0 az 7 v CGRAM.................... // \20 .. \27 - alternativne zapsane znaky (oktalove) v pozicich 0 az 7 CGRAM.................... // Pozor na to, ze funkce printf konci tisk pokud narazi na \0 (konec retezce).................... //.................... // lcd_gotoxy(x,y) presune kurzor na uvedenou adresu.................... // nekontroluje parametry.................... //.................... // lcd_cursor_on zapne kurzor.................... // lcd_cursor_off vypne kurzor.................... //.................... // lcd_define_char(Index, Def) Makro, ktere definuje znaky od pozice Index obsahem definicniho.................... // retezce Def. Kazdych 8 znaku retezce Def definuje dalsi znak v CGRAM..................... // Kapacita CGRAM je celkem 8 znaku s indexem 0 az 7..................... // Na konci se provede lcd_gotoxy(1,1)..................... // Na konci teto knihovny je priklad pouziti definovanych znaku.................... //.................... // Definice portu:.................... //.................... // #DEFINE LCD_RS PIN_B2 // rizeni registru LCD displeje.................... // #DEFINE LCD_E PIN_B1 // enable LCD displeje.................... // #DEFINE LCD_DATA_LSB PIN_C2 // pripojeni LSB bitu datoveho portu LCD displeje (celkem 4 bity vzestupne za sebou).................................................................................................... // Privatni sekce, cist jen v pripade, ze neco nefunguje.................................................................................................... // Generovane defince portu pro ucely teto knihovny aby kod generoval spravne IO operace a soucasne.................... // bylo mozne jednoduse deklarovat pripojene piny LCD displeje pri pouziti teto knihovny. Problem spociva.................... // v tom, ze se musi spravne ridit smery portu a soucasne datovy port zabira jen 4 bity ze zadaneho portu.................... //.................... #DEFINE LCD_SHIFT (LCD_DATA_LSB&7) // pocet bitu posuvu dataoveho kanalu v datovem portu.................... #DEFINE LCD_PORT (LCD_DATA_LSB>>3) // adresa LCD datoveho portu.................... #DEFINE LCD_TRIS (LCD_PORT+0x80) // adresa prislusneho TRIS registru.................... #DEFINE LCD_MASK (0xF<<LCD_SHIFT) // maska platnych bitu.................... //.................... #IF LCD_SHIFT>4 // kontrola mezi.................... #ERROR LCD data port LSB bit not in range 0..4.................... #ENDIF............................................................ // Definice konstant pro LCD display.................... //.................... #define LCD_CURSOR_ON_ 0x0E // kurzor jako blikajici radka pod znakem.................... #define LCD_CURSOR_OFF_ 0x0C // zadny kurzor.................... #define LCD_LINE_2 0x40 // adresa 1. znaku 2. radky............................................................ // Definice rezimu LCD displeje.................... //.................... BYTE const LCD_INIT_STRING[4] =.................... {.................... 0x28, // intrfejs 4 bity, 2 radky, font 5x7.................... LCD_CURSOR_OFF_, // display on, kurzor off,.................... 0x01, // clear displeje.................... 0x06 // inkrement pozice kurzoru (posun kurzoru doprava).................... };*0004: BCF 0A.00005: BCF 0A.10006: BCF 0A.20007: ADDWF 02,F0008: RETLW 280009: RETLW 0C000A: RETLW 01000B: RETLW 06............................................................ // Odesle nibble do displeje (posle data a klikne signalem e).................... //.................... void lcd_send_nibble( BYTE n ).................... {.................... *LCD_PORT = (*LCD_PORT & ~LCD_MASK) | ((n << LCD_SHIFT) & LCD_MASK); // nastav datove bity portu a ostatni zachovej*002A: MOVF 06,W002B: ANDLW C3002C: MOVWF 22002D: RLF 21,W002E: MOVWF 0C002F: RLF 0C,F0030: MOVLW FC0031: ANDWF 0C,F0032: MOVF 0C,W0033: ANDLW 3C0034: IORWF 22,W0035: MOVWF 06.................... output_bit(LCD_E,1); // vzestupna hrana0036: BSF 06.00037: BSF 03.50038: BCF 06.0.................... delay_us(1); // pockej alespon 450ns od e nebo alespon 195ns od dat0039: NOP.................... output_bit(LCD_E,0); // sestupna hrana (minimalni perioda e je 1us)003A: BCF 03.5003B: BCF 06.0003C: BSF 03.5003D: BCF 06.0003E: BCF 03.5003F: RETLW 00.................... }............................................................ // Odesle bajt do registru LCD.................... //.................... // Pokud je Adr=0 .. instrukcni registr.................... // Pokud je Adr=1 .. datovy registr.................... //.................... void lcd_send_byte( BOOLEAN Adr, BYTE n ).................... {.................... output_bit(LCD_RS,Adr); // vyber registr0040: MOVF 1F,F0041: BTFSS 03.20042: GOTO 0450043: BCF 06.10044: GOTO 0460045: BSF 06.10046: BSF 03.50047: BCF 06.1.................... swap(n);0048: BCF 03.50049: SWAPF 20,F.................... lcd_send_nibble(n); // posli horni pulku bajtu004A: MOVF 20,W004B: MOVWF 21004C: CALL 02A.................... swap(n);004D: SWAPF 20,F.................... lcd_send_nibble(n); // posli spodni pulku bajtu004E: MOVF 20,W004F: MOVWF 210050: CALL 02A.................... delay_us(40); // minimalni doba na provedeni prikazu0051: MOVLW 0D0052: MOVWF 0C0053: DECFSZ 0C,F0054: GOTO 0530055: RETLW 00.................... }............................................................ // Provede inicializaci LCD displeje, smaze obsah a nastavi mod displeje.................... //.................... // Tato procedura se musi volat pred pouzitim ostatnich lcd_ procedur.................... //.................... void lcd_init().................... {........................................ int i; // pocitadlo cyklu........................................ delay_ms(20); // spozdeni pro provedeni startu displeje po zapnuti napajeni0056: MOVLW 140057: MOVWF 1B0058: CALL 015........................................ *LCD_TRIS = *LCD_TRIS & ~LCD_MASK; // nuluj odpovidajici bity tris registru datoveho portu LCD0059: MOVLW C3005A: BSF 03.5005B: ANDWF 06,F........................................ output_bit(LCD_RS,0); // nastav jako vystup a nastav klidovy stav005C: BCF 03.5005D: BCF 06.1005E: BSF 03.5005F: BCF 06.1.................... output_bit(LCD_E,0); // nastav jako vystup a nastav klidovy stav0060: BCF 03.50061: BCF 06.00062: BSF 03.50063: BCF 06.0........................................ for (i=0; i<3; i++) // nastav lcd do rezimu 8 bitu sbernice0064: BCF 03.50065: CLRF 180066: MOVF 18,W0067: SUBLW 020068: BTFSS 03.00069: GOTO 072.................... {.................... delay_ms(2); // muze byt rozdelany prenos dat (2x 4 bity) nebo pomaly povel006A: MOVLW 02006B: MOVWF 1B006C: CALL 015.................... lcd_send_nibble(3); // rezim 8 bitu006D: MOVLW 03006E: MOVWF 21006F: CALL 02A.................... }0070: INCF 18,F0071: GOTO 066........................................ delay_us(40); // cas na zpracovani0072: MOVLW 0D0073: MOVWF 0C0074: DECFSZ 0C,F0075: GOTO 074.................... lcd_send_nibble(2); // nastav rezim 4 bitu (plati od nasledujiciho prenosu)0076: MOVLW 020077: MOVWF 210078: CALL 02A.................... delay_us(40); // cas na zpracovani0079: MOVLW 0D007A: MOVWF 0C007B: DECFSZ 0C,F007C: GOTO 07B........................................ for (i=0;i<3;i++) // proved inicializaci (nastaveni modu, smazani apod)007D: CLRF 18007E: MOVF 18,W007F: SUBLW 020080: BTFSS 03.00081: GOTO 08E.................... {.................... lcd_send_byte(0,LCD_INIT_STRING[i]);0082: MOVF 18,W0083: CALL 0040084: MOVWF 190085: CLRF 1F0086: MOVF 19,W0087: MOVWF 200088: CALL 040.................... delay_ms(2);0089: MOVLW 02008A: MOVWF 1B008B: CALL 015.................... }008C: INCF 18,F008D: GOTO 07E008E: GOTO 1D2 (RETURN).................... }............................................................ // Proved presun kurzoru.................... //.................... // Pozice 1.1 je domu.................... //.................... void lcd_gotoxy( BYTE x, BYTE y).................... {........................................ BYTE Adr;........................................ Adr=x-1;008F: MOVLW 010090: SUBWF 1B,W0091: MOVWF 1D.................... if(y==2)0092: MOVF 1C,W0093: SUBLW 020094: BTFSS 03.20095: GOTO 098.................... Adr+=LCD_LINE_2;0096: MOVLW 400097: ADDWF 1D,F........................................ lcd_send_byte(0,0x80|Adr);0098: MOVF 1D,W0099: IORLW 80009A: MOVWF 1E009B: CLRF 1F009C: MOVF 1E,W009D: MOVWF 20009E: CALL 040009F: RETLW 00.................... }............................................................ // Zapis znaku na displej, zpracovani ridicich znaku.................... //.................... void lcd_putc( char c).................... {........................................ switch (c)00A0: MOVF 1A,W00A1: MOVWF 0C00A2: MOVLW 0C00A3: SUBWF 0C,W00A4: BTFSC 03.200A5: GOTO 0B300A6: MOVLW 0A00A7: SUBWF 0C,W00A8: BTFSC 03.200A9: GOTO 0BB00AA: MOVLW 0D00AB: SUBWF 0C,W00AC: BTFSC 03.200AD: GOTO 0C100AE: MOVLW 0800AF: SUBWF 0C,W00B0: BTFSC 03.200B1: GOTO 0C600B2: GOTO 0CB.................... {.................... case '\f' : lcd_send_byte(0,1); // smaz displej00B3: CLRF 1F00B4: MOVLW 0100B5: MOVWF 2000B6: CALL 040.................... delay_ms(2);00B7: MOVLW 0200B8: MOVWF 1B00B9: CALL 015.................... break;00BA: GOTO 0D7.................... case '\n' : lcd_gotoxy(1,2); break; // presun se na 1. znak 2. radky00BB: MOVLW 0100BC: MOVWF 1B00BD: MOVLW 0200BE: MOVWF 1C00BF: CALL 08F00C0: GOTO 0D7.................... case '\r' : lcd_gotoxy(1,1); break; // presun home00C1: MOVLW 0100C2: MOVWF 1B00C3: MOVWF 1C00C4: CALL 08F00C5: GOTO 0D7.................... case '\b' : lcd_send_byte(0,0x10); break; // posun kurzor o 1 zpet00C6: CLRF 1F00C7: MOVLW 1000C8: MOVWF 2000C9: CALL 04000CA: GOTO 0D7.................... default : if (c<0x20) c&=0x7; // preklopeni definovatelnych znaku na rozsah 0 az 0x1F00CB: MOVF 1A,W00CC: SUBLW 1F00CD: BTFSS 03.000CE: GOTO 0D100CF: MOVLW 0700D0: ANDWF 1A,F.................... lcd_send_byte(1,c); break; // zapis znak00D1: MOVLW 0100D2: MOVWF 1F00D3: MOVF 1A,W00D4: MOVWF 2000D5: CALL 04000D6: GOTO 0D7.................... }00D7: RETLW 00.................... }............................................................ // Zapni kurzor.................... //.................... void lcd_cursor_on().................... {.................... lcd_send_byte(0,LCD_CURSOR_ON_);.................... }............................................................ // Vypni kurzor.................... //.................... void lcd_cursor_off().................... {.................... lcd_send_byte(0,LCD_CURSOR_OFF_);.................... }............................................................ // Definice vlastnich fontu.................... //.................... // Vlastnich definic muze byt jen 8 do pozic 0 az 7 pameti CGRAM radice lcd displeje.................... // Pro snadne definovani jsou pripraveny nasledujici definice a na konci souboru je uveden.................... // priklad pouziti definovanych znaku............................................................. // Pomocna procedura pro posilani ridicich dat do radice displeje.................... //.................... void lcd_putc2(int Data).................... {.................... lcd_send_byte(1,Data);.................... }............................................................ // Pomocne definice pro programovani obsahu CGRAM.................... //.................... #DEFINE lcd_define_start(Code) lcd_send_byte(0,0x40+(Code<<3)); delay_ms(2).................... #DEFINE lcd_define_def(String) printf(lcd_putc2,String);.................... #DEFINE lcd_define_end() lcd_send_byte(0,3); delay_ms(2)............................................................ // Vlastni vykonne makro pro definovani fontu do pozice Index CGRAM s definicnim retezcem Def.................... //.................... #DEFINE lcd_define_char(Index, Def) lcd_define_start(Index); lcd_define_def(Def); lcd_define_end();............................................................ // Pripravene definice fontu vybranych znaku.................... // V tabulce nesmi byt 00 (konec retezce v printf()), misto toho davame 80.................... //.................... #DEFINE LCD_CHAR_BAT100 "\x0E\x1F\x1F\x1F\x1F\x1F\x1F\x1F" /* symbol plne baterie */.................... #DEFINE LCD_CHAR_BAT50 "\x0E\x1F\x11\x11\x13\x17\x1F\x1F" /* symbol polovicni baterie */.................... #DEFINE LCD_CHAR_BAT0 "\x0E\x1F\x11\x11\x11\x11\x11\x1F" /* symbol vybite baterie */.................... #DEFINE LCD_CHAR_LUA "\x04\x0E\x11\x11\x1F\x11\x11\x80" /* A s carkou */.................... #DEFINE LCD_CHAR_LLA "\x01\x02\x0E\x01\x1F\x11\x0F\x80" /* a s carkou */.................... #DEFINE LCD_CHAR_HUC "\x0A\x0E\x11\x10\x10\x11\x0E\x80" /* C s hackem */.................... #DEFINE LCD_CHAR_HLC "\x0A\x04\x0E\x10\x10\x11\x0E\x80" /* c s hackem */.................... #DEFINE LCD_CHAR_HUD "\x0A\x1C\x12\x11\x11\x12\x1C\x80" /* D s hackem */.................... #DEFINE LCD_CHAR_HLD "\x05\x03\x0D\x13\x11\x11\x0F\x80" /* d s hackem */.................... #DEFINE LCD_CHAR_LUE "\x04\x1F\x10\x10\x1E\x10\x1F\x80" /* E s carkou */.................... #DEFINE LCD_CHAR_LLE "\x01\x02\x0E\x11\x1F\x10\x0E\x80" /* e s carkou */.................... #DEFINE LCD_CHAR_HUE "\x0A\x1F\x10\x1E\x10\x10\x1F\x80" /* E s hackem */.................... #DEFINE LCD_CHAR_HLE "\x0A\x04\x0E\x11\x1F\x10\x0E\x80" /* e s hackem */.................... #DEFINE LCD_CHAR_LUI "\x04\x0E\x04\x04\x04\x04\x0E\x80" /* I s carkou */.................... #DEFINE LCD_CHAR_LLI "\x02\x04\x80\x0C\x04\x04\x0E\x80" /* i s carkou */.................... #DEFINE LCD_CHAR_HUN "\x0A\x15\x11\x19\x15\x13\x11\x80" /* N s hackem */.................... #DEFINE LCD_CHAR_HLN "\x0A\x04\x16\x19\x11\x11\x11\x80" /* n s hackem */.................... #DEFINE LCD_CHAR_LUO "\x04\x0E\x11\x11\x11\x11\x0E\x80" /* O s carkou */.................... #DEFINE LCD_CHAR_LLO "\x02\x04\x0E\x11\x11\x11\x0E\x80" /* o s carkou */.................... #DEFINE LCD_CHAR_HUR "\x0A\x1E\x11\x1E\x14\x12\x11\x80" /* R s hackem */.................... #DEFINE LCD_CHAR_HLR "\x0A\x04\x16\x19\x10\x10\x10\x80" /* r s hackem */.................... #DEFINE LCD_CHAR_HUS "\x0A\x0F\x10\x0E\x01\x01\x1E\x80" /* S s hackem */.................... #DEFINE LCD_CHAR_HLS "\x0A\x04\x0E\x10\x0E\x01\x1E\x80" /* s s hackem */.................... #DEFINE LCD_CHAR_HUT "\x0A\x1F\x04\x04\x04\x04\x04\x80" /* T s hackem */.................... #DEFINE LCD_CHAR_HLT "\x0A\x0C\x1C\x08\x08\x09\x06\x80" /* t s hackem */.................... #DEFINE LCD_CHAR_LUU "\x02\x15\x11\x11\x11\x11\x0E\x80" /* U s carkou */.................... #DEFINE LCD_CHAR_LLU "\x02\x04\x11\x11\x11\x13\x0D\x80" /* u s carkou */.................... #DEFINE LCD_CHAR_CUU "\x06\x17\x11\x11\x11\x11\x0E\x80" /* U s krouzkem */.................... #DEFINE LCD_CHAR_CLU "\x06\x06\x11\x11\x11\x11\x0E\x80" /* u s krouzkem */.................... #DEFINE LCD_CHAR_LUY "\x02\x15\x11\x0A\x04\x04\x04\x80" /* Y s carkou */.................... #DEFINE LCD_CHAR_LLY "\x02\x04\x11\x11\x0F\x01\x0E\x80" /* y s carkou */.................... #DEFINE LCD_CHAR_HUZ "\x0A\x1F\x01\x02\x04\x08\x1F\x80" /* Z s hackem */.................... #DEFINE LCD_CHAR_HLZ "\x0A\x04\x1F\x02\x04\x08\x1F\x80" /* z s hackem */............................................................ // Priklad pouziti definovanych znaku.................... //.................... //.................... //void lcd_sample().................... //{.................... // lcd_define_char(0,LCD_CHAR_BAT50); // Priklad definice znaku baterie do pozice 0.................... // lcd_define_char(2,LCD_CHAR_HLE LCD_CHAR_LUI); // Priklad definice znaku e s hackem a I s carkou od pozice 2.................... // // vsimnete si, ze neni carka mezi retezci s definici (oba retezce definuji.................... // // jediny definicni retezec).................... // printf(lcd_putc,"\fZnaky:\20\22\23"); // priklad vypisu znaku z pozice 0, 2 a 3.................... // delay_ms(1000);.................... // lcd_define_char(0,LCD_CHAR_BAT0); // Predefinovani tvaru znaku v pozici 0.................... // delay_ms(1000);.................... //}............................................................ #DEFINE PRIJIMAC PIN_A3 // pin na ktery je pripojen prijimac.................... #DEFINE SERVO_X PIN_A0 // pin na ktery je pripojeno servo.................... #DEFINE SERVO_Y PIN_A1............................................................ // Prijme datovy nibble vcetne zasynchronizovani.................... // Chybi dodelat timeout.................... int8 prijmi_nibble(int8* datovy, int8* data).................... {.................... int8 i;........................................ #IFDEF DEBUG.................... int1 tmp;.................... #ENDIF........................................ *data=0;00D8: MOVF 1D,W00D9: MOVWF 0400DA: CLRF 00........................................ // Cekam na dlouhou nulu.................... for (i=4; i>0; i--)00DB: MOVLW 0400DC: MOVWF 1E00DD: MOVF 1E,F00DE: BTFSC 03.200DF: GOTO 0EE.................... {.................... if (input(PRIJIMAC)) i=4;00E0: BSF 03.500E1: BSF 05.300E2: BCF 03.500E3: BTFSS 05.300E4: GOTO 0E700E5: MOVLW 0400E6: MOVWF 1E.................... delay_us(IMPULS/2);00E7: MOVLW 2900E8: MOVWF 0C00E9: DECFSZ 0C,F00EA: GOTO 0E900EB: NOP.................... }00EC: DECF 1E,F00ED: GOTO 0DD........................................ // Cekam na jednicku (start ramce).................... for (; !input(PRIJIMAC); )00EE: BSF 03.500EF: BSF 05.300F0: BCF 03.500F1: BTFSS 05.3.................... {.................... }00F2: GOTO 0EE........................................ // Ctu typ nibblu.................... delay_us(2*IMPULS+2*IMPULS/3);00F3: MOVLW DD00F4: MOVWF 0C00F5: DECFSZ 0C,F00F6: GOTO 0F500F7: NOP00F8: NOP.................... *datovy=input(PRIJIMAC);00F9: MOVF 1C,W00FA: MOVWF 0400FB: BSF 03.500FC: BSF 05.300FD: MOVLW 0000FE: BCF 03.500FF: BTFSC 05.30100: MOVLW 010101: MOVWF 00........................................ // Prenasim bity.................... for (i=0; i<4; i++)0102: CLRF 1E0103: MOVF 1E,W0104: SUBLW 030105: BTFSS 03.00106: GOTO 128.................... {.................... delay_us(2*IMPULS);0107: MOVLW A60108: MOVWF 0C0109: DECFSZ 0C,F010A: GOTO 109010B: NOP.................... *data >>= 1;010C: MOVF 1D,W010D: MOVWF 04010E: BCF 03.0010F: RRF 00,W0110: MOVWF 0C0111: MOVWF 00.................... if (input(PRIJIMAC)) *data +=0b1000;0112: BSF 03.50113: BSF 05.30114: BCF 03.50115: BTFSS 05.30116: GOTO 11C0117: MOVF 1D,W0118: MOVWF 040119: MOVLW 08011A: ADDWF 00,W011B: MOVWF 00........................................ #IFDEF DEBUG.................... output_bit(DEBUG,tmp);011C: BTFSC 1F.0011D: GOTO 120011E: BCF 05.2011F: GOTO 1210120: BSF 05.20121: BSF 03.50122: BCF 05.2.................... tmp=!tmp;0123: MOVLW 010124: BCF 03.50125: XORWF 1F,F.................... #ELSE.................... delay_us(20);.................... #ENDIF.................... }0126: INCF 1E,F0127: GOTO 103........................................ return FALSE;0128: MOVLW 000129: MOVWF 0D012A: RETLW 00.................... }............................................................ // Prijme datovy ramec.................... // Pokud nastane chyba vraci kod chyby.................... int8 prijmi_ramec(int8* kanal, int8* data).................... {.................... int8 datovy;.................... int8 suma;........................................ // Cekej na synchronizacni nibble.................... do.................... {.................... if (prijmi_nibble(&datovy, data)) return 1; // chyba timout012B: MOVLW 1A012C: MOVWF 1C012D: MOVF 19,W012E: MOVWF 1D012F: CALL 0D80130: MOVF 0D,F0131: BTFSC 03.20132: GOTO 1360133: MOVLW 010134: MOVWF 0D0135: GOTO 186.................... }.................... while(datovy);0136: MOVF 1A,F0137: BTFSS 03.20138: GOTO 12B........................................ // Zkontroluj magickou hodnotu.................... if (*data != SYNC_NIBBLE) return 2; // chyba magickeho kodu ramce0139: MOVF 19,W013A: MOVWF 04013B: MOVF 00,W013C: SUBLW 0F013D: BTFSC 03.2013E: GOTO 142013F: MOVLW 020140: MOVWF 0D0141: GOTO 186........................................ // Prijmi cislo kanalu.................... if (prijmi_nibble(&datovy, kanal)) return 1; // chyba timeout0142: MOVLW 1A0143: MOVWF 1C0144: MOVF 18,W0145: MOVWF 1D0146: CALL 0D80147: MOVF 0D,F0148: BTFSC 03.20149: GOTO 14D014A: MOVLW 01014B: MOVWF 0D014C: GOTO 186.................... if (!datovy) return 3; // chyba typu nibblu014D: MOVF 1A,F014E: BTFSS 03.2014F: GOTO 1530150: MOVLW 030151: MOVWF 0D0152: GOTO 186........................................ // Prijmi data.................... if (prijmi_nibble(&datovy, data)) return 1; // chyba timeout0153: MOVLW 1A0154: MOVWF 1C0155: MOVF 19,W0156: MOVWF 1D0157: CALL 0D80158: MOVF 0D,F0159: BTFSC 03.2015A: GOTO 15E015B: MOVLW 01015C: MOVWF 0D015D: GOTO 186.................... if (!datovy) return 3; // chyba typu nibblu015E: MOVF 1A,F015F: BTFSS 03.20160: GOTO 1640161: MOVLW 030162: MOVWF 0D0163: GOTO 186........................................ // Prijmi zabezpeceni.................... if (prijmi_nibble(&datovy, &suma)) return 1; // chyba timeout0164: MOVLW 1A0165: MOVWF 1C0166: MOVLW 1B0167: MOVWF 1D0168: CALL 0D80169: MOVF 0D,F016A: BTFSC 03.2016B: GOTO 16F016C: MOVLW 01016D: MOVWF 0D016E: GOTO 186.................... if (!datovy) return 3; // chyba typu nibblu016F: MOVF 1A,F0170: BTFSS 03.20171: GOTO 1750172: MOVLW 030173: MOVWF 0D0174: GOTO 186........................................ // Zkontroluj kontrolni soucet.................... if (((*kanal+*data) & 0b1111) != suma) return 3; // chyba kontrolniho souctu0175: MOVF 18,W0176: MOVWF 040177: MOVF 00,W0178: MOVWF 1C0179: MOVF 19,W017A: MOVWF 04017B: MOVF 00,W017C: ADDWF 1C,W017D: ANDLW 0F017E: SUBWF 1B,W017F: BTFSC 03.20180: GOTO 1840181: MOVLW 030182: MOVWF 0D0183: GOTO 186........................................ return 0;0184: MOVLW 000185: MOVWF 0D0186: GOTO 1FA (RETURN).................... }................................................................................ int8 x,y;.................... int8 xc,yc; // pocitadla aktualizace x a y.................... int e1,e2,e3,e4; // pocitadla chyb - ladici........................................ void main().................... {*01CE: CLRF 0401CF: MOVLW 1F01D0: ANDWF 03,F.................... lcd_init(); // zinicializuj LCD display01D1: GOTO 056.................... delay_ms(5);01D2: MOVLW 0501D3: MOVWF 1B01D4: CALL 015.................... printf(lcd_putc,"Ahoj...");*000C: BCF 0A.0000D: BCF 0A.1000E: BCF 0A.2000F: ADDWF 02,F0010: RETLW 410011: RETLW 680012: RETLW 6F0013: RETLW 6A0014: RETLW 00*01D5: CLRF 1801D6: MOVF 18,W01D7: CALL 00C01D8: INCF 18,F01D9: MOVWF 1A01DA: CALL 0A001DB: MOVLW 0401DC: SUBWF 18,W01DD: BTFSS 03.201DE: GOTO 1D601DF: MOVLW 0301E0: MOVWF 1901E1: MOVLW 2E01E2: MOVWF 1A01E3: CALL 0A001E4: DECFSZ 19,F01E5: GOTO 1E1.................... delay_ms(300);01E6: MOVLW 0201E7: MOVWF 1801E8: MOVLW 9601E9: MOVWF 1B01EA: CALL 01501EB: DECFSZ 18,F01EC: GOTO 1E8........................................ x = 0;01ED: CLRF 0E.................... y = 0;01EE: CLRF 0F.................... xc = 0;01EF: CLRF 10.................... yc = 0;01F0: CLRF 11.................... e1 = 0;01F1: CLRF 12.................... e2 = 0;01F2: CLRF 13.................... e3 = 0;01F3: CLRF 14.................... e4 = 0;01F4: CLRF 15........................................ while (true).................... {.................... int8 kanal, data;........................................ if (prijmi_ramec(&kanal,&data))01F5: MOVLW 1601F6: MOVWF 1801F7: MOVLW 1701F8: MOVWF 1901F9: GOTO 12B01FA: MOVF 0D,F01FB: BTFSC 03.201FC: GOTO 1FF.................... e1++;01FD: INCF 12,F.................... else01FE: GOTO 2A6.................... {.................... switch (kanal) // rozeskoc se podle adresy osy01FF: MOVLW 010200: SUBWF 16,W0201: ADDLW FD0202: BTFSC 03.00203: GOTO 2100204: ADDLW 030205: GOTO 2A8.................... {.................... case OSA_X:.................... {.................... x=data;0206: MOVF 17,W0207: MOVWF 0E.................... xc++;0208: INCF 10,F.................... break;0209: GOTO 210.................... };.................... case OSA_Y:.................... {.................... y=data;020A: MOVF 17,W020B: MOVWF 0F.................... yc++;020C: INCF 11,F.................... break;020D: GOTO 210.................... };.................... case TLs:.................... {.................... e4++;020E: INCF 15,F.................... break;020F: GOTO 210.................... };.................... };*02A8: BCF 0A.002A9: BSF 0A.102AA: BCF 0A.202AB: ADDWF 02,F02AC: GOTO 20602AD: GOTO 20A02AE: GOTO 20E........................................ // ladici vypisy.................... lcd_gotoxy(1,1); // vytiskni X a Y*0210: MOVLW 010211: MOVWF 1B0212: MOVWF 1C0213: CALL 08F.................... printf(lcd_putc,"X%2U %3U%3U%3U ", x, xc, e1, e2);*019C: MOVF 0D,W019D: MOVF 18,W019E: MOVWF 1A019F: MOVLW 6401A0: MOVWF 1B01A1: CALL 18701A2: MOVF 0C,W01A3: MOVWF 1801A4: MOVF 0D,W01A5: MOVLW 3001A6: BTFSS 03.201A7: GOTO 1AF01A8: BTFSC 19.001A9: BSF 19.301AA: BTFSC 19.301AB: GOTO 1B501AC: BTFSC 19.401AD: MOVLW 2001AE: GOTO 1B101AF: BCF 19.301B0: BCF 19.401B1: ADDWF 0D,F01B2: MOVF 0D,W01B3: MOVWF 1A01B4: CALL 0A001B5: MOVF 18,W01B6: MOVWF 1A01B7: MOVLW 0A01B8: MOVWF 1B01B9: CALL 18701BA: MOVF 0C,W01BB: MOVWF 1801BC: MOVF 0D,W01BD: MOVLW 3001BE: BTFSS 03.201BF: GOTO 1C401C0: BTFSC 19.301C1: GOTO 1C801C2: BTFSC 19.401C3: MOVLW 2001C4: ADDWF 0D,F01C5: MOVF 0D,W01C6: MOVWF 1A01C7: CALL 0A001C8: MOVLW 3001C9: ADDWF 18,F01CA: MOVF 18,W01CB: MOVWF 1A01CC: CALL 0A001CD: RETLW 00*0214: MOVLW 580215: MOVWF 1A0216: CALL 0A00217: MOVF 0E,W0218: MOVWF 180219: MOVLW 11021A: MOVWF 19021B: CALL 19C021C: MOVLW 20021D: MOVWF 1A021E: CALL 0A0021F: MOVF 10,W0220: MOVWF 180221: MOVLW 100222: MOVWF 190223: CALL 19C0224: MOVF 12,W0225: MOVWF 180226: MOVLW 100227: MOVWF 190228: CALL 19C0229: MOVF 13,W022A: MOVWF 18022B: MOVLW 10022C: MOVWF 19022D: CALL 19C022E: MOVLW 20022F: MOVWF 1A0230: CALL 0A00231: MOVLW 200232: MOVWF 1A0233: CALL 0A0.................... lcd_gotoxy(1,2);0234: MOVLW 010235: MOVWF 1B0236: MOVLW 020237: MOVWF 1C0238: CALL 08F.................... printf(lcd_putc,"Y%2U %3U%3U%3U ", y, yc, e3, e4);0239: MOVLW 59023A: MOVWF 1A023B: CALL 0A0023C: MOVF 0F,W023D: MOVWF 18023E: MOVLW 11023F: MOVWF 190240: CALL 19C0241: MOVLW 200242: MOVWF 1A0243: CALL 0A00244: MOVF 11,W0245: MOVWF 180246: MOVLW 100247: MOVWF 190248: CALL 19C0249: MOVF 14,W024A: MOVWF 18024B: MOVLW 10024C: MOVWF 19024D: CALL 19C024E: MOVF 15,W024F: MOVWF 180250: MOVLW 100251: MOVWF 190252: CALL 19C0253: MOVLW 200254: MOVWF 1A0255: CALL 0A00256: MOVLW 200257: MOVWF 1A0258: CALL 0A0........................................ // ovladani serv.................... output_high(SERVO_X);0259: BSF 03.5025A: BCF 05.0025B: BCF 03.5025C: BSF 05.0.................... delay_ms(1);025D: MOVLW 01025E: MOVWF 1B025F: CALL 015.................... for (data=x; data--; data>0)0260: MOVF 0E,W0261: MOVWF 170262: MOVF 17,W0263: DECF 17,F0264: XORLW 000265: BTFSC 03.20266: GOTO 271.................... delay_us(65);0267: MOVLW 150268: MOVWF 0C0269: DECFSZ 0C,F026A: GOTO 269026B: NOP026C: MOVF 17,F026D: BTFSS 03.2026E: GOTO 270026F: MOVLW 000270: GOTO 262.................... output_low(SERVO_X);0271: BSF 03.50272: BCF 05.00273: BCF 03.50274: BCF 05.0........................................ output_high(SERVO_Y);0275: BSF 03.50276: BCF 05.10277: BCF 03.50278: BSF 05.1.................... delay_ms(1);0279: MOVLW 01027A: MOVWF 1B027B: CALL 015.................... for (data=y; data--; data>0)027C: MOVF 0F,W027D: MOVWF 17027E: MOVF 17,W027F: DECF 17,F0280: XORLW 000281: BTFSC 03.20282: GOTO 28D.................... delay_us(65);0283: MOVLW 150284: MOVWF 0C0285: DECFSZ 0C,F0286: GOTO 2850287: NOP0288: MOVF 17,F0289: BTFSS 03.2028A: GOTO 28C028B: MOVLW 00028C: GOTO 27E.................... output_low(SERVO_Y);028D: BSF 03.5028E: BCF 05.1028F: BCF 03.50290: BCF 05.1........................................ for (data=30-x-y; data--; data>0)0291: MOVF 0E,W0292: SUBLW 1E0293: MOVWF 0D0294: MOVF 0F,W0295: SUBWF 0D,W0296: MOVWF 170297: MOVF 17,W0298: DECF 17,F0299: XORLW 00029A: BTFSC 03.2029B: GOTO 2A6.................... delay_us(65);029C: MOVLW 15029D: MOVWF 0C029E: DECFSZ 0C,F029F: GOTO 29E02A0: NOP02A1: MOVF 17,F02A2: BTFSS 03.202A3: GOTO 2A502A4: MOVLW 0002A5: GOTO 297........................................ }.................... }02A6: GOTO 1F5.................... }....................02A7: SLEEP........................................