Subversion Repositories svnkaklik

Rev

Blame | Last modification | View Log | Download

CCS PCM C Compiler, Version 3.245, 27853               12-V-06 23:56

               Filename: D:\KAKLIK\roboti\istrobot\3Orbis\vystava\main.lst

               ROM used: 646 words (16%)
                         Largest free fragment is 2048
               RAM used: 32 (18%) at main() level
                         35 (20%) worst case
               Stack:    3 worst case (1 in main + 2 for interrupts)

*
0000:  MOVLW  00
0001:  MOVWF  0A
0002:  GOTO   07D
0003:  NOP
0004:  MOVWF  7F
0005:  SWAPF  03,W
0006:  CLRF   03
0007:  MOVWF  21
0008:  MOVF   7F,W
0009:  MOVWF  20
000A:  MOVF   0A,W
000B:  MOVWF  28
000C:  CLRF   0A
000D:  SWAPF  20,F
000E:  MOVF   04,W
000F:  MOVWF  22
0010:  MOVF   77,W
0011:  MOVWF  23
0012:  MOVF   78,W
0013:  MOVWF  24
0014:  MOVF   79,W
0015:  MOVWF  25
0016:  MOVF   7A,W
0017:  MOVWF  26
0018:  MOVF   7B,W
0019:  MOVWF  27
001A:  BCF    03.7
001B:  BCF    03.5
001C:  MOVLW  8C
001D:  MOVWF  04
001E:  BTFSS  00.1
001F:  GOTO   022
0020:  BTFSC  0C.1
0021:  GOTO   035
0022:  MOVF   22,W
0023:  MOVWF  04
0024:  MOVF   23,W
0025:  MOVWF  77
0026:  MOVF   24,W
0027:  MOVWF  78
0028:  MOVF   25,W
0029:  MOVWF  79
002A:  MOVF   26,W
002B:  MOVWF  7A
002C:  MOVF   27,W
002D:  MOVWF  7B
002E:  MOVF   28,W
002F:  MOVWF  0A
0030:  SWAPF  21,W
0031:  MOVWF  03
0032:  SWAPF  7F,F
0033:  SWAPF  7F,W
0034:  RETFIE
0035:  BCF    0A.3
0036:  GOTO   047
.................... #include ".\main.h" 
.................... #include <16F88.h> 
.................... //////// Standard Header file for the PIC16F88 device //////////////// 
.................... #device PIC16F88 
.................... #list 
....................  
.................... #device adc=8 
....................  
.................... #FUSES NOWDT                       //No Watch Dog Timer 
.................... #FUSES INTRC_IO 
.................... #FUSES NOPUT                       //No Power Up Timer 
.................... #FUSES MCLR                        //Master Clear pin enabled 
.................... #FUSES NOBROWNOUT             //Reset when brownout detected 
.................... #FUSES NOLVP                  //Low Voltage Programming on B3(PIC16) or B5(PIC18) 
.................... #FUSES NOCPD                       //No EE protection 
.................... #FUSES NOWRT                       //Program memory not write protected 
.................... #FUSES NODEBUG                     //No Debug mode for ICD 
.................... #FUSES NOPROTECT                   //Code not protected from reading 
.................... #FUSES NOFCMEN                //Fail-safe clock monitor enabled 
.................... #FUSES NOIESO                      //Internal External Switch Over mode enabled 
....................  
.................... #use delay(clock=8000000,RESTART_WDT) 
0037:  MOVLW  08
0038:  SUBWF  3D,F
0039:  BTFSS  03.0
003A:  GOTO   046
003B:  MOVLW  3D
003C:  MOVWF  04
003D:  BCF    03.0
003E:  RRF    00,F
003F:  MOVF   00,W
0040:  BTFSC  03.2
0041:  GOTO   046
0042:  GOTO   044
0043:  CLRWDT
0044:  DECFSZ 00,F
0045:  GOTO   043
0046:  RETLW  00
*
0065:  MOVLW  3A
0066:  MOVWF  04
0067:  MOVF   00,W
0068:  BTFSC  03.2
0069:  GOTO   07C
006A:  MOVLW  02
006B:  MOVWF  78
006C:  MOVLW  BF
006D:  MOVWF  77
006E:  CLRWDT
006F:  DECFSZ 77,F
0070:  GOTO   06E
0071:  DECFSZ 78,F
0072:  GOTO   06C
0073:  MOVLW  96
0074:  MOVWF  77
0075:  DECFSZ 77,F
0076:  GOTO   075
0077:  NOP
0078:  NOP
0079:  CLRWDT
007A:  DECFSZ 00,F
007B:  GOTO   06A
007C:  RETLW  00
....................  
....................  
....................  
.................... #define  KOLMO1      225         // predni kolecko sroubem dopredu 
.................... #define  KOLMO2      30          // predni kolecko je hlavou sroubu dozadu 
.................... #define  STRED       128         // sredni poloha zataceciho kolecka 
.................... #define  BEAR1       10          // 3 stupne zataceni 
.................... #define  BEAR2       25 
.................... #define  BEAR3       45 
.................... #define  R           100         // Rozumna rychlost 
.................... #define  R17         200         // X nasobek rozumne rychlosti 
.................... #define  PRED_CIHLOU 100         // rychlost pri dalkove detekci cihly 
.................... #define  L2            2     // cara vlevo 
.................... #define  L3            3     // cara vlevo 
.................... #define  S             0     // cara mezi sensory 
.................... #define  R2           -2     // cara vpravo 
.................... #define  R3           -3     // cara vpravo 
....................  
.................... // servo 
.................... #define  SERVO PIN_B5 
....................  
.................... // kroutitka 
.................... #define  CERVENA  4  // AN4 
.................... #define  MODRA    2  // AN2 
....................  
.................... // IR 
.................... #define IRTX      PIN_B2 
.................... #define  CIHLA    PIN_A3 
....................  
.................... //motory 
.................... #define  FR         output_low(PIN_A7); output_high(PIN_A6)  // Vpred 
.................... #define  FL         output_low(PIN_A1); output_high(PIN_A0) 
.................... #define  BR         output_low(PIN_A6); output_high(PIN_A7)  // Vzad 
.................... #define  BL         output_low(PIN_A0); output_high(PIN_A1) 
.................... #define  STOPR      output_low(PIN_A6);output_low(PIN_A7) 
.................... #define  STOPL      output_low(PIN_A0);output_low(PIN_A1) 
....................  
.................... //HID 
.................... #define  LED1     PIN_B1      //oranzova 
.................... #define  LED2     PIN_B2      //zluta 
....................  
.................... #define  STROBE   PIN_B0 
....................  
.................... unsigned int8 sensors;        // pomocna promenna pro cteni cidel na caru 
.................... signed int8 line = S;         // na ktere strane byla detekovana cara 
*
008A:  BCF    03.5
008B:  CLRF   2B
.................... unsigned int8 uhel;           // urcuje aktualni uhel zataceni 
.................... unsigned int8 speed;          // maximalni povolena rychlost 
.................... unsigned int8 turn;           // rychlost toceni 
.................... unsigned int8 rovinka;        // pocitadlo na zjisteni rovinky 
....................  
.................... signed int16  Lmotor;         // promene, ktere urcuji velikost vykonu na levem 
.................... signed int16  Rmotor;         // a pravem motoru 
....................  
.................... // makro pro PWM pro motory 
.................... #define GO(motor, direction, power) if(get_timer0()<=power) \ 
.................... {direction##motor;} else {stop##motor;} 
.................... //////////////////////////////////////////////////////////////////////////////// 
.................... #int_TIMER2 
.................... TIMER2_isr()      // ovladani serva 
.................... { 
....................    unsigned int8 n; 
....................  
....................    output_high(SERVO); 
*
0047:  BSF    03.5
0048:  BCF    06.5
0049:  BCF    03.5
004A:  BSF    06.5
....................    delay_us(1000); 
004B:  CLRWDT
004C:  MOVLW  09
004D:  MOVWF  3C
004E:  MOVLW  6D
004F:  MOVWF  3D
0050:  CALL   037
0051:  DECFSZ 3C,F
0052:  GOTO   04E
....................    for(n=uhel; n>0; n--) Delay_us(2); 
0053:  MOVF   2C,W
0054:  MOVWF  3B
0055:  MOVF   3B,F
0056:  BTFSC  03.2
0057:  GOTO   05E
0058:  CLRWDT
0059:  NOP
005A:  NOP
005B:  NOP
005C:  DECF   3B,F
005D:  GOTO   055
....................    output_low(SERVO); 
005E:  BSF    03.5
005F:  BCF    06.5
0060:  BCF    03.5
0061:  BCF    06.5
.................... } 
....................  
.................... //////////////////////////////////////////////////////////////////////////////// 
0062:  BCF    0C.1
0063:  BCF    0A.3
0064:  GOTO   022
.................... void main() 
.................... { 
*
007D:  CLRF   04
007E:  MOVLW  1F
007F:  ANDWF  03,F
0080:  MOVLW  70
0081:  BSF    03.5
0082:  MOVWF  0F
0083:  BCF    1F.4
0084:  BCF    1F.5
0085:  MOVF   1B,W
0086:  ANDLW  80
0087:  MOVWF  1B
0088:  MOVLW  07
0089:  MOVWF  1C
....................  
....................    unsigned int8 n; 
....................    unsigned int8 i,j; 
....................    unsigned int8 last_sensors; 
....................    unsigned int8 RozumnaRychlost; 
....................  
....................    setup_adc_ports(sAN5|sAN2|sAN4|sAN6|VSS_VDD); // AD pro kroutitka 
*
008C:  BSF    03.5
008D:  BCF    1F.4
008E:  BCF    1F.5
008F:  MOVF   1B,W
0090:  ANDLW  80
0091:  IORLW  74
0092:  MOVWF  1B
....................    setup_adc(ADC_CLOCK_INTERNAL); 
0093:  BCF    1F.6
0094:  BCF    03.5
0095:  BSF    1F.6
0096:  BSF    1F.7
0097:  BSF    03.5
0098:  BCF    1F.7
0099:  BCF    03.5
009A:  BSF    1F.0
....................    setup_spi(SPI_MASTER|SPI_H_TO_L|SPI_XMIT_L_TO_H|SPI_CLK_DIV_16); 
009B:  BCF    14.5
009C:  BSF    03.5
009D:  BCF    06.2
009E:  BSF    06.1
009F:  BCF    06.4
00A0:  MOVLW  31
00A1:  BCF    03.5
00A2:  MOVWF  14
00A3:  MOVLW  00
00A4:  BSF    03.5
00A5:  MOVWF  14
....................    setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1); 
00A6:  MOVF   01,W
00A7:  ANDLW  C7
00A8:  IORLW  08
00A9:  MOVWF  01
....................    setup_timer_1(T1_DISABLED|T1_DIV_BY_8); 
00AA:  MOVLW  30
00AB:  BCF    03.5
00AC:  MOVWF  10
....................    setup_timer_2(T2_DIV_BY_16,140,16); 
00AD:  MOVLW  78
00AE:  MOVWF  78
00AF:  IORLW  06
00B0:  MOVWF  12
00B1:  MOVLW  8C
00B2:  BSF    03.5
00B3:  MOVWF  12
....................    setup_oscillator(OSC_8MHZ|OSC_INTRC); 
00B4:  MOVLW  72
00B5:  MOVWF  0F
....................  
....................    STOPR; STOPL;  // zastav motory 
00B6:  BCF    05.6
00B7:  BCF    03.5
00B8:  BCF    05.6
00B9:  BSF    03.5
00BA:  BCF    05.7
00BB:  BCF    03.5
00BC:  BCF    05.7
00BD:  BSF    03.5
00BE:  BCF    05.0
00BF:  BCF    03.5
00C0:  BCF    05.0
00C1:  BSF    03.5
00C2:  BCF    05.1
00C3:  BCF    03.5
00C4:  BCF    05.1
....................    Lmotor=0;Rmotor=0; 
00C5:  CLRF   31
00C6:  CLRF   30
00C7:  CLRF   33
00C8:  CLRF   32
....................  
....................    uhel = STRED;    // nastav zadni kolecko na stred 
00C9:  MOVLW  80
00CA:  MOVWF  2C
....................    rovinka = 0; 
00CB:  CLRF   2F
....................  
....................    enable_interrupts(INT_TIMER2); 
00CC:  BSF    03.5
00CD:  BSF    0C.1
....................    enable_interrupts(GLOBAL); 
00CE:  MOVLW  C0
00CF:  BCF    03.5
00D0:  IORWF  0B,F
....................  
....................    output_low(IRTX); // zapni IR vysilac 
00D1:  BSF    03.5
00D2:  BCF    06.2
00D3:  BCF    03.5
00D4:  BCF    06.2
....................  
....................    delay_ms(2000); // musime pockat na diagnostiku slave CPU 
00D5:  MOVLW  08
00D6:  MOVWF  39
00D7:  MOVLW  FA
00D8:  MOVWF  3A
00D9:  CALL   065
00DA:  DECFSZ 39,F
00DB:  GOTO   0D7
....................  
....................    //nastaveni rychlosti 
....................    set_adc_channel(CERVENA); 
00DC:  MOVLW  20
00DD:  MOVWF  78
00DE:  MOVF   1F,W
00DF:  ANDLW  C7
00E0:  IORWF  78,W
00E1:  MOVWF  1F
....................  
....................    Delay_ms(1); 
00E2:  MOVLW  01
00E3:  MOVWF  3A
00E4:  CALL   065
....................    speed=R+(read_adc()>>2); // rychlost rovne +63; kroutitko dava 0-63 
00E5:  BSF    1F.2
00E6:  BTFSC  1F.2
00E7:  GOTO   0E6
00E8:  MOVF   1E,W
00E9:  MOVWF  77
00EA:  RRF    77,F
00EB:  RRF    77,F
00EC:  MOVLW  3F
00ED:  ANDWF  77,F
00EE:  MOVF   77,W
00EF:  ADDLW  64
00F0:  MOVWF  2D
....................    set_adc_channel(MODRA); 
00F1:  MOVLW  10
00F2:  MOVWF  78
00F3:  MOVF   1F,W
00F4:  ANDLW  C7
00F5:  IORWF  78,W
00F6:  MOVWF  1F
....................    Delay_ms(1); 
00F7:  MOVLW  01
00F8:  MOVWF  3A
00F9:  CALL   065
....................    turn=speed-32+(read_adc()>>2);  // rychlost toceni +-32; kroutitko dava 0-63 
00FA:  MOVLW  20
00FB:  SUBWF  2D,W
00FC:  MOVWF  39
00FD:  BSF    1F.2
00FE:  BTFSC  1F.2
00FF:  GOTO   0FE
0100:  MOVF   1E,W
0101:  MOVWF  77
0102:  RRF    77,F
0103:  RRF    77,F
0104:  MOVLW  3F
0105:  ANDWF  77,F
0106:  MOVF   77,W
0107:  ADDWF  39,W
0108:  MOVWF  2E
....................  
....................  
....................    while(true) 
....................    { 
....................  
....................       GO(L,F,Lmotor);GO(R,F,Rmotor);   // zapni motory PWM podle promenych Lmotor a Rmotor 
0109:  MOVF   01,W
010A:  BTFSS  00.7
010B:  GOTO   10F
010C:  BTFSS  31.7
010D:  GOTO   117
010E:  GOTO   111
010F:  BTFSC  31.7
0110:  GOTO   120
0111:  MOVF   31,F
0112:  BTFSS  03.2
0113:  GOTO   117
0114:  SUBWF  30,W
0115:  BTFSS  03.0
0116:  GOTO   120
0117:  BSF    03.5
0118:  BCF    05.1
0119:  BCF    03.5
011A:  BCF    05.1
011B:  BSF    03.5
011C:  BCF    05.0
011D:  BCF    03.5
011E:  BSF    05.0
011F:  GOTO   128
0120:  BSF    03.5
0121:  BCF    05.0
0122:  BCF    03.5
0123:  BCF    05.0
0124:  BSF    03.5
0125:  BCF    05.1
0126:  BCF    03.5
0127:  BCF    05.1
0128:  MOVF   01,W
0129:  BTFSS  00.7
012A:  GOTO   12E
012B:  BTFSS  33.7
012C:  GOTO   136
012D:  GOTO   130
012E:  BTFSC  33.7
012F:  GOTO   13F
0130:  MOVF   33,F
0131:  BTFSS  03.2
0132:  GOTO   136
0133:  SUBWF  32,W
0134:  BTFSS  03.0
0135:  GOTO   13F
0136:  BSF    03.5
0137:  BCF    05.7
0138:  BCF    03.5
0139:  BCF    05.7
013A:  BSF    03.5
013B:  BCF    05.6
013C:  BCF    03.5
013D:  BSF    05.6
013E:  GOTO   147
013F:  BSF    03.5
0140:  BCF    05.6
0141:  BCF    03.5
0142:  BCF    05.6
0143:  BSF    03.5
0144:  BCF    05.7
0145:  BCF    03.5
0146:  BCF    05.7
....................  
....................       delay_us(2000);                  // cekani na SLAVE, nez pripravi data od cidel 
0147:  CLRWDT
0148:  MOVLW  01
0149:  MOVWF  3A
014A:  CALL   065
014B:  MOVLW  09
014C:  MOVWF  39
014D:  CLRF   29
014E:  BTFSC  0B.7
014F:  BSF    29.7
0150:  BCF    0B.7
0151:  MOVLW  6D
0152:  MOVWF  3D
0153:  CALL   037
0154:  BTFSC  29.7
0155:  BSF    0B.7
0156:  DECFSZ 39,F
0157:  GOTO   14D
....................  
....................       last_sensors=sensors; 
0158:  MOVF   2A,W
0159:  MOVWF  37
....................  
....................       output_low(STROBE);              // vypni zobrazovani na posuvnem registru 
015A:  BSF    03.5
015B:  BCF    06.0
015C:  BCF    03.5
015D:  BCF    06.0
....................       sensors = spi_read(0);           // cteni senzoru 
015E:  MOVF   13,W
015F:  CLRF   13
0160:  BSF    03.5
0161:  BTFSC  14.0
0162:  GOTO   165
0163:  BCF    03.5
0164:  GOTO   160
0165:  BCF    03.5
0166:  MOVF   13,W
0167:  MOVWF  2A
....................       sensors=~sensors;                // neguj prijata data 
0168:  COMF   2A,F
....................       output_high(STROBE);       // zobraz data na posuvnem registru 
0169:  BSF    03.5
016A:  BCF    06.0
016B:  BCF    03.5
016C:  BSF    06.0
....................  
....................       i=0;                       // havarijni kod 
016D:  CLRF   35
....................       for (n=0; n<=6; n++) 
016E:  CLRF   34
016F:  MOVF   34,W
0170:  SUBLW  06
0171:  BTFSS  03.0
0172:  GOTO   181
....................       { 
....................          if(bit_test(sensors,n)) i++; 
0173:  MOVF   2A,W
0174:  MOVWF  77
0175:  MOVF   34,W
0176:  MOVWF  78
0177:  BTFSC  03.2
0178:  GOTO   17D
0179:  BCF    03.0
017A:  RRF    77,F
017B:  DECFSZ 78,F
017C:  GOTO   179
017D:  BTFSC  77.0
017E:  INCF   35,F
....................       } 
017F:  INCF   34,F
0180:  GOTO   16F
....................       if (i>4) // zastavi, kdyz je cerno pod vice nez tremi cidly 
0181:  MOVF   35,W
0182:  SUBLW  04
0183:  BTFSC  03.0
0184:  GOTO   1AD
....................       { 
....................          BL; BR; 
0185:  BSF    03.5
0186:  BCF    05.0
0187:  BCF    03.5
0188:  BCF    05.0
0189:  BSF    03.5
018A:  BCF    05.1
018B:  BCF    03.5
018C:  BSF    05.1
018D:  BSF    03.5
018E:  BCF    05.6
018F:  BCF    03.5
0190:  BCF    05.6
0191:  BSF    03.5
0192:  BCF    05.7
0193:  BCF    03.5
0194:  BSF    05.7
....................          delay_ms(300); 
0195:  MOVLW  02
0196:  MOVWF  39
0197:  MOVLW  96
0198:  MOVWF  3A
0199:  CALL   065
019A:  DECFSZ 39,F
019B:  GOTO   197
....................          STOPR; STOPL; 
019C:  BSF    03.5
019D:  BCF    05.6
019E:  BCF    03.5
019F:  BCF    05.6
01A0:  BSF    03.5
01A1:  BCF    05.7
01A2:  BCF    03.5
01A3:  BCF    05.7
01A4:  BSF    03.5
01A5:  BCF    05.0
01A6:  BCF    03.5
01A7:  BCF    05.0
01A8:  BSF    03.5
01A9:  BCF    05.1
01AA:  BCF    03.5
01AB:  BCF    05.1
....................          While(true); 
01AC:  GOTO   1AC
....................       }; 
....................  
....................       if (bit_test(sensors,7))    // detekce cihly 
01AD:  BTFSS  2A.7
01AE:  GOTO   1D9
....................       { 
....................          BR;BL; 
01AF:  BSF    03.5
01B0:  BCF    05.6
01B1:  BCF    03.5
01B2:  BCF    05.6
01B3:  BSF    03.5
01B4:  BCF    05.7
01B5:  BCF    03.5
01B6:  BSF    05.7
01B7:  BSF    03.5
01B8:  BCF    05.0
01B9:  BCF    03.5
01BA:  BCF    05.0
01BB:  BSF    03.5
01BC:  BCF    05.1
01BD:  BCF    03.5
01BE:  BSF    05.1
....................          Delay_ms(100); 
01BF:  MOVLW  64
01C0:  MOVWF  3A
01C1:  CALL   065
....................          STOPR;STOPL; 
01C2:  BSF    03.5
01C3:  BCF    05.6
01C4:  BCF    03.5
01C5:  BCF    05.6
01C6:  BSF    03.5
01C7:  BCF    05.7
01C8:  BCF    03.5
01C9:  BCF    05.7
01CA:  BSF    03.5
01CB:  BCF    05.0
01CC:  BCF    03.5
01CD:  BCF    05.0
01CE:  BSF    03.5
01CF:  BCF    05.1
01D0:  BCF    03.5
01D1:  BCF    05.1
....................          Delay_ms(1000); 
01D2:  MOVLW  04
01D3:  MOVWF  39
01D4:  MOVLW  FA
01D5:  MOVWF  3A
01D6:  CALL   065
01D7:  DECFSZ 39,F
01D8:  GOTO   1D4
....................       } 
....................  
....................       if(bit_test(sensors,0)) //|......//     // z duvodu zkraceni doby reakce se cidla nevyhodnocuji poporade ale od krajnich k prostrednimu 
01D9:  BTFSS  2A.0
01DA:  GOTO   1E7
....................       { 
....................          uhel=STRED - BEAR3; 
01DB:  MOVLW  53
01DC:  MOVWF  2C
....................          Lmotor=0; 
01DD:  CLRF   31
01DE:  CLRF   30
....................          Rmotor=turn; 
01DF:  CLRF   7A
01E0:  MOVF   2E,W
01E1:  MOVWF  32
01E2:  MOVF   7A,W
01E3:  MOVWF  33
....................          line=L3; 
01E4:  MOVLW  03
01E5:  MOVWF  2B
....................          continue; 
01E6:  GOTO   109
....................       } 
....................  
....................       if(bit_test(sensors,6)) //......|// 
01E7:  BTFSS  2A.6
01E8:  GOTO   1F5
....................       { 
....................          uhel=STRED + BEAR3; 
01E9:  MOVLW  AD
01EA:  MOVWF  2C
....................          Rmotor=0; 
01EB:  CLRF   33
01EC:  CLRF   32
....................          Lmotor=turn; 
01ED:  CLRF   7A
01EE:  MOVF   2E,W
01EF:  MOVWF  30
01F0:  MOVF   7A,W
01F1:  MOVWF  31
....................          line=R3; 
01F2:  MOVLW  FD
01F3:  MOVWF  2B
....................          continue; 
01F4:  GOTO   109
....................       } 
....................  
....................       if(bit_test(sensors,1)) //.|.....// 
01F5:  BTFSS  2A.1
01F6:  GOTO   207
....................       { 
....................          uhel=STRED - BEAR2; 
01F7:  MOVLW  67
01F8:  MOVWF  2C
....................          Lmotor=speed-70; 
01F9:  MOVLW  46
01FA:  SUBWF  2D,W
01FB:  CLRF   7A
01FC:  MOVWF  30
01FD:  MOVF   7A,W
01FE:  MOVWF  31
....................          Rmotor=speed; 
01FF:  CLRF   7A
0200:  MOVF   2D,W
0201:  MOVWF  32
0202:  MOVF   7A,W
0203:  MOVWF  33
....................          line=L2; 
0204:  MOVLW  02
0205:  MOVWF  2B
....................          continue; 
0206:  GOTO   109
....................       } 
....................  
....................       if(bit_test(sensors,5)) //.....|.// 
0207:  BTFSS  2A.5
0208:  GOTO   219
....................       { 
....................          uhel=STRED + BEAR2; 
0209:  MOVLW  99
020A:  MOVWF  2C
....................          Rmotor=speed-70; 
020B:  MOVLW  46
020C:  SUBWF  2D,W
020D:  CLRF   7A
020E:  MOVWF  32
020F:  MOVF   7A,W
0210:  MOVWF  33
....................          Lmotor=speed; 
0211:  CLRF   7A
0212:  MOVF   2D,W
0213:  MOVWF  30
0214:  MOVF   7A,W
0215:  MOVWF  31
....................          line=R2; 
0216:  MOVLW  FE
0217:  MOVWF  2B
....................          continue; 
0218:  GOTO   109
....................       } 
....................  
....................       if (bit_test(sensors,2)) //..|....// 
0219:  BTFSS  2A.2
021A:  GOTO   22F
....................       { 
....................          uhel=STRED - BEAR1; 
021B:  MOVLW  76
021C:  MOVWF  2C
....................          Lmotor=speed-20; 
021D:  MOVLW  14
021E:  SUBWF  2D,W
021F:  CLRF   7A
0220:  MOVWF  30
0221:  MOVF   7A,W
0222:  MOVWF  31
....................          Rmotor=speed; 
0223:  CLRF   7A
0224:  MOVF   2D,W
0225:  MOVWF  32
0226:  MOVF   7A,W
0227:  MOVWF  33
....................          line=L2; 
0228:  MOVLW  02
0229:  MOVWF  2B
....................          if (rovinka<255) rovinka++; 
022A:  INCFSZ 2F,W
022B:  GOTO   22D
022C:  GOTO   22E
022D:  INCF   2F,F
....................          continue; 
022E:  GOTO   109
....................       } 
....................  
....................       if (bit_test(sensors,4)) //....|..// 
022F:  BTFSS  2A.4
0230:  GOTO   245
....................       { 
....................          uhel=STRED + BEAR1; 
0231:  MOVLW  8A
0232:  MOVWF  2C
....................          Rmotor=speed-20; 
0233:  MOVLW  14
0234:  SUBWF  2D,W
0235:  CLRF   7A
0236:  MOVWF  32
0237:  MOVF   7A,W
0238:  MOVWF  33
....................          Lmotor=speed; 
0239:  CLRF   7A
023A:  MOVF   2D,W
023B:  MOVWF  30
023C:  MOVF   7A,W
023D:  MOVWF  31
....................          line=L2; 
023E:  MOVLW  02
023F:  MOVWF  2B
....................          if (rovinka<255) rovinka++; 
0240:  INCFSZ 2F,W
0241:  GOTO   243
0242:  GOTO   244
0243:  INCF   2F,F
....................          continue; 
0244:  GOTO   109
....................       } 
....................  
....................       if(bit_test(sensors,3)) //...|...// 
0245:  BTFSS  2A.3
0246:  GOTO   259
....................       { 
....................          uhel=STRED; 
0247:  MOVLW  80
0248:  MOVWF  2C
....................          Lmotor=speed; 
0249:  CLRF   7A
024A:  MOVF   2D,W
024B:  MOVWF  30
024C:  MOVF   7A,W
024D:  MOVWF  31
....................          Rmotor=speed; 
024E:  CLRF   7A
024F:  MOVF   2D,W
0250:  MOVWF  32
0251:  MOVF   7A,W
0252:  MOVWF  33
....................          line=S; 
0253:  CLRF   2B
....................          if (rovinka < 255) rovinka++; 
0254:  INCFSZ 2F,W
0255:  GOTO   257
0256:  GOTO   258
0257:  INCF   2F,F
....................          continue; 
0258:  GOTO   109
....................       } 
....................  
....................  
....................  
....................       if ((L3==line) || (R3==line)) // Brzdeni pri vyjeti z trate 
0259:  MOVF   2B,W
025A:  SUBLW  03
025B:  BTFSC  03.2
025C:  GOTO   261
025D:  MOVF   2B,W
025E:  SUBLW  FD
025F:  BTFSS  03.2
0260:  GOTO   284
....................       { 
....................          if (rovinka>50) 
0261:  MOVF   2F,W
0262:  SUBLW  32
0263:  BTFSC  03.0
0264:  GOTO   283
....................          { 
....................             BL; BR; 
0265:  BSF    03.5
0266:  BCF    05.0
0267:  BCF    03.5
0268:  BCF    05.0
0269:  BSF    03.5
026A:  BCF    05.1
026B:  BCF    03.5
026C:  BSF    05.1
026D:  BSF    03.5
026E:  BCF    05.6
026F:  BCF    03.5
0270:  BCF    05.6
0271:  BSF    03.5
0272:  BCF    05.7
0273:  BCF    03.5
0274:  BSF    05.7
....................             Delay_ms(70); 
0275:  MOVLW  46
0276:  MOVWF  3A
0277:  CALL   065
....................             if (rovinka > 250 || speed > 170) delay_ms(50); 
0278:  MOVF   2F,W
0279:  SUBLW  FA
027A:  BTFSS  03.0
027B:  GOTO   280
027C:  MOVF   2D,W
027D:  SUBLW  AA
027E:  BTFSC  03.0
027F:  GOTO   283
0280:  MOVLW  32
0281:  MOVWF  3A
0282:  CALL   065
....................          }; 
....................          rovinka=0; 
0283:  CLRF   2F
....................       }; 
....................    } 
0284:  GOTO   109
.................... } 
0285:  SLEEP

Configuration Fuses:
   Word  1: 3F38   NOWDT NOPUT MCLR NOBROWNOUT NOLVP NOCPD NOWRT NODEBUG CCPB0 NOPROTECT INTRC_IO
   Word  2: 3FFC   NOFCMEN NOIESO