| /roboti/merkur/PIC16F873/Kopie (2) - main.c |
|---|
| 0,0 → 1,236 |
| #include "main.h" |
| int movement; // smer minuleho pohybu |
| int line; // na ktere strane byla detekovana cara |
| unsigned int8 dira; // pocitadlo pro nalezeni preruseni cary |
| unsigned int8 speed; // rychlost zataceni |
| unsigned int8 straight; // pocitadlo pro zjisteni rovneho useku |
| // Konstanty pro dynamiku pohybu |
| #define T_DIRA 16 // po jakem case zataceni se detekuje dira |
| #define INC_SPEED 5 // prirustek rychlosti v jednom kroku |
| #define RIGHT_ANGLE 1000 // 90 stupnu |
| #define CIKCAK 20000 // 45 stupnu |
| #define BW_PO_DIRE 200 // zpetny chod po dire |
| #define FW_RYCHLE 200 // cara primo rovne |
| #define FW_POMALU 100 // trochu mimo caru vnitrni pas |
| #define FW_STREDNE 150 // trochu mimo caru vnejsi pas |
| #define TURN_MIN 90 // minimalni rychlost pri zataceni |
| #define TURN_MAX 150 // miximalni rychlost pri zataceni |
| #define BRZDENI 40 // doba zpetneho chodu v ms, aby pas stal |
| #define ROVINKA 8 // doba po kterou se musi jet rovne, aby se brzdilo |
| //motory //Napred vypnout potom zapnout! |
| #define FR output_low(PIN_B5); output_high(PIN_B4) // Vpred |
| #define FL output_low(PIN_B7); output_high(PIN_B6) |
| #define BR output_low(PIN_B4); output_high(PIN_B5) // Vzad |
| #define BL output_low(PIN_B6); output_high(PIN_B7) |
| #define STOPR output_low(PIN_B4);output_low(PIN_B5) // Zastav |
| #define STOPL output_low(PIN_B6);output_low(PIN_B7) |
| #define L 0b10 // left |
| #define R 0b01 // right |
| #define S 0b11 // straight |
| //cidla |
| #define RSENSOR 1 // Senzory na caru |
| #define LSENSOR 0 |
| #define BUMPER PIN_C4 // Senzor na cihlu |
| #define DIAG_SERVO PIN_B0 // Propojka pro diagnosticky mod |
| #define DIAG_SENSORS PIN_B1 // Propojka pro diagnosticky mod |
| #DEFINE SOUND_HI PIN_B3 // komplementarni vystupy pro piezo pipak |
| #DEFINE SOUND_LO PIN_B2 |
| char AXstring[40]; // Buffer pro prenos telemetrie |
| // makro pro PWM |
| #define GO(motor, direction, power) if(get_timer0()<=power) \ |
| {direction##motor;} \ |
| else \ |
| {stop##motor;} |
| #int_TIMER1 // This function is called every time |
| void TIMER1_isr() { // the RTCC (timer0) overflows (255->0). |
| // For this program this is apx 76 times |
| // per second. |
| if (speed<TURN_MAX) speed+=INC_SPEED; |
| if (dira<255) dira++; |
| if (straight<255) straight++; |
| } |
| // Primitivni Pipani |
| void beep(unsigned int16 period, unsigned int16 length) |
| { |
| unsigned int16 nn; |
| for(nn=length; nn>0; nn--) |
| { |
| output_high(SOUND_HI);output_low(SOUND_LO); |
| delay_us(period); |
| output_high(SOUND_LO);output_low(SOUND_HI); |
| delay_us(period); |
| } |
| } |
| void diagnostika() |
| { |
| unsigned int16 n; |
| while (input(DIAG_SERVO)) // Propojka, ktera spousti diagnostiku |
| { |
| for (n=500; n<800; n+=100) |
| { |
| beep(n,n); //beep UP |
| }; |
| Delay_ms(1000); |
| //zastav vse |
| STOPL; STOPR; |
| //pravy pas |
| FR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| BR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //levy pas |
| FL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| BL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //oba pasy |
| FL; FR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| BL; BR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| }; |
| while (input(DIAG_SENSORS)) |
| { |
| int ls, rs; |
| while(!input(BUMPER)){beep(1100,100); Delay_ms(50);} |
| set_adc_channel(RSENSOR); |
| Delay_us(20); |
| rs=read_adc(); |
| set_adc_channel(LSENSOR); |
| Delay_us(20); |
| ls=read_adc(); |
| }; |
| } |
| void main() |
| { |
| STOPL; STOPR; // prepne vystupy na ovladani motoru na output a zastavi |
| setup_adc_ports(RA0_RA1_RA3_ANALOG); |
| setup_adc(ADC_CLOCK_DIV_2); |
| setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1); // Casovac pro PWM |
| setup_timer_1(T1_INTERNAL|T1_DIV_BY_1); // Casovac pro regulaci |
| setup_timer_2(T2_DISABLED,0,1); |
| setup_ccp1(CCP_OFF); |
| diagnostika(); |
| Beep(1000,200); //double beep |
| Delay_ms(50); |
| Beep(1000,200); |
| Delay_ms(1000); // 1s |
| speed=TURN_MIN; // povoleni rizeni rychlosti zataceni pres preruseni |
| enable_interrupts(INT_TIMER1); |
| enable_interrupts(GLOBAL); |
| // Cik-Cak ------------------------------------------------------------- |
| line=S; |
| movement=R; |
| // cik_cak(); // toc se, abys nasel caru |
| Delay_ms(500); |
| Beep(1000,200); |
| Delay_ms(500); |
| dira=0; // inicializace globalnich promennych |
| straight=255; |
| while(true) // hlavni smycka (jizda podle cary) |
| { |
| set_adc_channel(LSENSOR); // kdyz cara nebyla pod pravym cidlem, mozna bude pod levym |
| Delay_us(10); |
| if(tresholdL > read_adc()) |
| { |
| movement = L; |
| if (straight>ROVINKA) |
| {GO(R, F, FW_STREDNE+40); GO(L, F, FW_POMALU+40)} // pridej |
| else |
| {GO(R, F, FW_STREDNE); GO(L, F, FW_POMALU)}; |
| speed=TURN_MIN; |
| dira=0; |
| line=L; |
| continue; |
| } |
| set_adc_channel(RSENSOR); // podivej se jestli neni cara pod pravym cidlem |
| Delay_us(10); |
| if(tresholdR > read_adc()) |
| { |
| movement = R; |
| if (straight>ROVINKA) |
| {GO(L, F, FW_STREDNE+40); GO(R, F, FW_POMALU+40)} // pridej |
| else |
| {GO(L, F, FW_STREDNE); GO(R, F, FW_POMALU)}; |
| speed=TURN_MIN; |
| dira=0; |
| line=R; |
| continue; |
| } |
| if(line==S) |
| movement = S; |
| if (straight>ROVINKA) |
| {FL; FR;} // pokud se jede dlouho rovne, tak pridej |
| else |
| {GO(R, F, FW_RYCHLE); GO(L, F, FW_RYCHLE)}; |
| speed=TURN_MIN; // nastav minimalni rychlost pro zataceni |
| dira=0; // protoze byla cara, tak nuluj pocitadlo diry |
| continue; |
| if (straight>ROVINKA) // pokud byla dlouha rovinka, tak zabrzdi |
| { |
| BL; BR; |
| Delay_ms(BRZDENI); |
| STOPL; |
| STOPR; |
| dira=0; |
| }; |
| straight=0; // nuluj pocitadlo rovinky |
| if (L==movement) // kdyz jsou obe cidla mimo caru, zatoc na caru |
| { |
| GO(R, F, speed); |
| STOPL; |
| } |
| else |
| { |
| GO(L, F, speed); |
| STOPR; |
| } |
| if (dira>T_DIRA) // pokud se moc dlouho zataci bez detekce cary, vrat se |
| { |
| STOPL; |
| STOPR; |
| Beep(1000,200); //double beep |
| Delay_ms(30); |
| Beep(2000,200); |
| Delay_ms(30); |
| if (L==movement) // zpet, podle toho kam se jelo |
| { |
| STOPL; |
| BR; |
| } |
| else |
| { |
| STOPR; |
| BL; |
| }; |
| Delay_ms(BW_PO_DIRE); |
| STOPL; |
| STOPR; |
| cik_cak(); // najdi caru |
| dira=0; |
| } |
| } // while(true) |
| } |
| /roboti/merkur/PIC16F873/main.BAK |
|---|
| 0,0 → 1,332 |
| #include "main.h" |
| #define TXo PIN_C3 // To the transmitter modulator |
| #include "AX25.c" // podprogram pro prenos telemetrie |
| //motory //Napred vypnout potom zapnout! |
| #define FR output_low(PIN_B5); output_high(PIN_B4) // Vpred |
| #define FL output_low(PIN_B7); output_high(PIN_B6) |
| #define BR output_low(PIN_B4); output_high(PIN_B5) // Vzad |
| #define BL output_low(PIN_B6); output_high(PIN_B7) |
| #define STOPR output_low(PIN_B4);output_low(PIN_B5) |
| #define STOPL output_low(PIN_B6);output_low(PIN_B7) |
| #define L 0b10 // left |
| #define R 0b01 // right |
| #define S 0b11 // straight |
| #define COUVANI 1600 // couvnuti po zjisteni diry |
| #define MEZERA 5400 // za jak dlouho bude ztracena cara |
| #define PRES_DIRU 400 // velikost mezery v care |
| #define ODEZVA 1 // za jak dlouho po opusteni cary se ma zacit zatacet |
| #define BRZDENI 90 // doba (v ms) ptrebna k zastaveni jednoho motoru |
| //cidla |
| #define RSENSOR 1 // Senzory na caru |
| #define LSENSOR 0 |
| #define BUMPER PIN_C4 // sensor na cihlu |
| #define DIAG_SERVO PIN_B0 // Propojka pro diagnosticky mod |
| #define DIAG_SENSORS PIN_B1 // Propojka pro diagnosticky mod |
| #DEFINE SOUND_HI PIN_B3 |
| #DEFINE SOUND_LO PIN_B2 |
| char AXstring[40]; // Buffer pro prenos telemetrie |
| int tresholdL; // rozhodovaci uroven pro prave cidlo |
| int tresholdR; // rozhodovaci uroven pro prave cidlo |
| int movement; // smer minuleho pohybu |
| int line; // na ktere strane byla detekovana cara |
| unsigned int16 dira; // pocitadlo pro nalezeni preruseni cary |
| // Primitivni Pipani |
| void beep(unsigned int16 period, unsigned int16 length) |
| { |
| unsigned int16 nn; |
| for(nn=length; nn>0; nn--) |
| { |
| output_high(SOUND_HI);output_low(SOUND_LO); |
| delay_us(period); |
| output_high(SOUND_LO);output_low(SOUND_HI); |
| delay_us(period); |
| } |
| } |
| // Diagnostika pohonu, hejbne vsema motorama ve vsech smerech |
| void diagnostika() |
| { |
| unsigned int16 n; |
| while (input(DIAG_SERVO)) // Propojka, ktera spousti diagnostiku |
| { |
| for (n=500; n<800; n+=100) |
| { |
| beep(n,n); //beep UP |
| }; |
| Delay_ms(1000); |
| //zastav vse |
| STOPL; STOPR; |
| //pravy pas |
| FR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| BR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //levy pas |
| FL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| BL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //oba pasy |
| FL; FR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| BL; BR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| }; |
| while (input(DIAG_SENSORS)) |
| { |
| int ls, rs; |
| while(!input(BUMPER)){beep(1100,100); Delay_ms(50);} |
| set_adc_channel(RSENSOR); |
| Delay_us(20); |
| rs=read_adc(); |
| set_adc_channel(LSENSOR); |
| Delay_us(20); |
| ls=read_adc(); |
| sprintf(AXstring,"L: %U R: %U\0", ls, rs); // Convert DATA to String. |
| SendPacket(&AXstring[0]); |
| delay_ms(1000); |
| }; |
| } |
| void cikcak() |
| { |
| int n; |
| switch(movement) // podivej se na jednu stranu |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| case S: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| set_adc_channel(LSENSOR); |
| Delay_us(10); |
| while (tresholdL < read_adc()) // je tam cara? |
| { |
| if (n==50) // asi bude na druhe strane |
| { |
| STOPR;STOPL; |
| n=0; |
| switch(movement) |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| } |
| Delay_ms(5); |
| n++; |
| } |
| STOPL;STOPR; // nasli jsme caru |
| line=S; |
| } |
| void objizdka() |
| { |
| BL;BR;Delay_ms(300); |
| STOPR;STOPL; |
| beep(1000,1000); |
| Delay_ms(500); |
| beep(1000,1000); |
| Delay_ms(1000); |
| } |
| void kalibrace() |
| { |
| unsigned int16 i; |
| int min; |
| int max; |
| int current; |
| int treshold; |
| FL; BR; Delay_ms(130); |
| chyba1: |
| FR; BL; //kalibrace leveho cidla |
| set_adc_channel(LSENSOR); |
| Delay_us(20); |
| min=max=read_adc(); |
| for (i=1;i<=500;i++) |
| { |
| current=read_adc(); |
| if (max < current) max=current; |
| if (min > current) min=current; |
| Delay_us(500); |
| } |
| FL; BR; |
| for (i=1;i<=500;i++) |
| { |
| current=read_adc(); |
| if (max < current) max=current; |
| if (min > current) min=current; |
| Delay_us(500); |
| } |
| STOPL; STOPR; Delay_ms(200); |
| if((max-min)<50) {Beep(1000,300); GOTO chyba1;} |
| treshold=(max-min)>>1; |
| tresholdL=treshold+min; |
| chyba2: |
| FR; BL; |
| set_adc_channel(RSENSOR); |
| Delay_us(20); |
| min=max=read_adc(); //naplneni min a max nejakou rozumnou hodnotou |
| for (i=1;i<=500 ;i++) |
| { |
| current=read_adc(); |
| if (max < current) max=current; //zmereni minima a maxima |
| if (min > current) min=current; |
| Delay_us(500); |
| } |
| FL; BR; |
| for (i=1;i<=500 ;i++) |
| { |
| current=read_adc(); |
| if (max < current) max=current; //zmereni minima a maxima |
| if (min > current) min=current; |
| Delay_us(500); |
| } |
| STOPL; STOPR; Delay_ms(200); |
| if((max-min)<50) {Beep(1000,300); GOTO chyba2;} |
| treshold=(max-min)>>1; |
| tresholdR=treshold+min; |
| FR; BL; |
| movement=L; |
| set_adc_channel(LSENSOR); |
| Delay_us(20); |
| while (tresholdL < read_adc()) Delay_us(100); |
| FL; BR; Delay_ms(50); |
| STOPL; STOPR; Delay_ms(500); |
| Beep(780,200); |
| } |
| void main() |
| { |
| unsigned int16 rovne; // pocita delku rovne cary |
| STOPL; STOPR; |
| setup_adc_ports(RA0_RA1_RA3_ANALOG); |
| setup_adc(ADC_CLOCK_DIV_2); |
| port_b_pullups(false); |
| diagnostika(); |
| Beep(1000,200); //double beep |
| Delay_ms(50); |
| Beep(1000,200); |
| Delay_ms(1000); // 1s |
| // kalibrace(); |
| tresholdl=tresholdr=80; |
| // FL; FR; |
| movement=S; |
| line=S; |
| dira=0; |
| rovne=0; |
| while(true) |
| { |
| if(!input(BUMPER)) objizdka(); |
| line=0; |
| set_adc_channel(RSENSOR); // podivej se jestli neni cara pod pravym cidlem |
| Delay_us(10); |
| if(tresholdR > read_adc()) |
| { |
| dira=0; |
| line=R; |
| } |
| set_adc_channel(LSENSOR); // kdyz cara nebyla pod pravym cidlem, mozna bude pod levym |
| Delay_us(10); |
| if(tresholdL > read_adc()) |
| { |
| dira=0; |
| line=line | L; |
| } |
| switch(line) |
| { |
| case S: |
| FR;FL; |
| movement=S; |
| continue; |
| case L: |
| STOPL; |
| FR;movement=L; |
| continue; |
| case R: |
| STOPR; |
| FL;movement=R; |
| continue; |
| default: |
| } |
| if (dira==ODEZVA) // kdyz uz chvili jedeme po bile plose |
| { |
| //BR;BL;Delay_us(rovne >>= 5); |
| rovne=0; //kdyz sme museli zatocit, uz neni rovna cara |
| switch (line) // musime zatocit |
| { |
| case L: |
| BL;Delay_ms(BRZDENI);STOPL; |
| FR; |
| movement=L; |
| break; |
| case R: |
| BR;Delay_ms(BRZDENI);STOPR; |
| FL; |
| movement=R; |
| break; |
| } |
| } |
| if (dira==MEZERA) // kdyz zkoncila cara |
| { |
| beep(800,500); |
| Delay_ms(50); |
| beep(800,500); |
| switch (movement) //vrat se zpet na caru |
| { |
| case L: |
| STOPL;STOPR; |
| BR;Delay_ms(COUVANI);STOPR; |
| break; |
| case R: |
| STOPL;STOPR; |
| BL;Delay_ms(COUVANI);STOPL; |
| break; |
| case S: |
| BL; BR; Delay_ms(COUVANI); |
| STOPL; STOPR; |
| break; |
| } |
| FR;FL; Delay_ms(PRES_DIRU); // popojedem dopredu mozna tam bude cara |
| STOPL; STOPR; movement=S; |
| cikcak(); // najdi caru |
| dira=0; |
| } |
| dira++; |
| } // while(true) |
| } |
| /roboti/merkur/PIC16F873/main.HEX |
|---|
| 0,0 → 1,200 |
| :1000000000308A001D2C00000A108A100A11820795 |
| :100010004C343A342034253455342034203452348E |
| :100020003A34203425345534003400347830840098 |
| :10003000FC308005800C800C00080319232821283F |
| :100040000000800B202800347508F7007408F600C3 |
| :10005000F608031D2E28F708031949288316861170 |
| :100060008312861583160611831206117208F80092 |
| :100070001620831606118312061583168611831225 |
| :1000800086117208F800162076080319F703F603A4 |
| :100090002828003473308400000803195E280130DA |
| :1000A000A100A001A00B5228A10B51284A30A000AA |
| :1000B000A00B582800000000800B4F2800346B086C |
| :1000C000840075088000840A8001EB0A00347608F9 |
| :1000D000A101750203186F287508A0007B28A001F4 |
| :1000E0000830F700F50DA00D760820020318A000D7 |
| :1000F000A10DF70B7228003421087308F500643055 |
| :10010000F60067202008F30021083030031D8F28F7 |
| :100110007418F415F4199528741A20309128F411E4 |
| :100120007412A1072108F5005F207308F5000A305A |
| :10013000F60067202008F30021083030031DA428B2 |
| :10014000F419A828741A2030A1072108F5005F20AF |
| :100150003030F3077308F5005F200034B801351C18 |
| :10016000B3283510B42835140034351CE828BC11E8 |
| :100170003C0883168700831287154930A000A00B26 |
| :10018000BF2800000000BC113C08831687008312C2 |
| :1001900087114930A000A00BCB2800000000BC1143 |
| :1001A0003C0883168700831287154930A000A00BF6 |
| :1001B000D72800000000BC113C088316870083127A |
| :1001C00087111930A000A00BE32800000000FE28D2 |
| :1001D000BC113C0883168700831287158930A00064 |
| :1001E000A00BF028BC113C088316870083128711EE |
| :1001F0007230A000A00BFA28000000000034F501C6 |
| :100200007508073C031C492974080139F600BA082F |
| :1002100003190C2900300D290130F700B908031922 |
| :1002200013290030142901307705003A03192729D2 |
| :100230007608F7000310B70CB60C030801397706EF |
| :10024000013C031D27298430B7060830B606F6089E |
| :10025000031D2C29AE204429B908031D3029B80AF2 |
| :10026000B90803193529003036290130F70038085C |
| :10027000053C03193D2900303E2901307705003A3D |
| :1002800003194429B520AE20B5200310F40CF50A5B |
| :1002900000290034831606148312061C752A0130C7 |
| :1002A000EF00F430EE006F08033C031C6B29031DC4 |
| :1002B0005D296E081F3C031C6B296F08F3006E0854 |
| :1002C000F2006F08F5006E08F40024206430EE0799 |
| :1002D0000318EF0A53290430F200FA30F3004A20E1 |
| :1002E000F20B6D29831606138312061383168613E9 |
| :1002F0008312861383160612831206128316861241 |
| :1003000083128612831686128312861283160612B1 |
| :10031000831206160430F200FA30F3004A20F20B82 |
| :100320008C298316061283120612831686128312F4 |
| :1003300086120430F200FA30F3004A20F20B9B29B7 |
| :1003400083160612831206128316861283128616ED |
| :100350000430F200FA30F3004A20F20BAA29831687 |
| :100360000612831206128316861283128612043036 |
| :10037000F200FA30F3004A20F20BB9290330F300FF |
| :100380007030F200F5016430F40024200430F200F3 |
| :10039000FA30F3004A20F20BC82983168613831221 |
| :1003A000861383160613831206170430F200FA3000 |
| :1003B000F3004A20F20BD729831606138312061383 |
| :1003C00083168613831286130430F200FA30F3008A |
| :1003D0004A20F20BE62983160613831206138316AE |
| :1003E0008613831286170430F200FA30F3004A2095 |
| :1003F000F20BF52983160613831206138316861350 |
| :10040000831286130430F200FA30F3004A20F20B14 |
| :10041000042A0330F3007030F200F5016430F40078 |
| :1004200024200430F200FA30F3004A20F20B132AA1 |
| :1004300083168613831286138316061383120617F8 |
| :1004400083168612831286128316061283120616EC |
| :100450000430F200FA30F3004A20F20B2A2A831605 |
| :1004600006138312061383168613831286138316CC |
| :100470000612831206128316861283128612043025 |
| :10048000F200FA30F3004A20F20B412A83160613D9 |
| :100490008312061383168613831286178316061299 |
| :1004A0008312061283168612831286160430F20017 |
| :1004B000FA30F3004A20F20B582A831606138312EF |
| :1004C000061383168613831286138316061283126D |
| :1004D000061283168612831286120430F200FA3056 |
| :1004E000F3004A20F20B6F2A4A29831686148312DE |
| :1004F000861C192B3C163C08831687008312071AAA |
| :100500008D2A0430F3004C30F200F5016430F40021 |
| :1005100024203230F3004A207A2A0830A1001F0834 |
| :10052000C73921049F000630A000A00B952A0000C7 |
| :100530001F151F19992A1E08F1000030A1001F087D |
| :10054000C73921049F000630A000A00BA52A000097 |
| :100550001F151F19A92A1E08F0003D30EB004C3072 |
| :10056000F5005F203A30F5005F202030F5005F2075 |
| :100570007008F3001830F4007C200530F200720897 |
| :100580000420F20AF5005F200A307202031DBF2A20 |
| :100590007108F3001830F4007C203D30F200351073 |
| :1005A000FF30B700B600B8010130B900BA01BB0195 |
| :1005B0003B08093C031CE12A7E30F400FF20BB0A03 |
| :1005C000D82AB901BB013B080F3C031CF02A253097 |
| :1005D0003B0784000008F300F400FF20BB0AE32A75 |
| :1005E000BB01720884000008003A0319002B72084E |
| :1005F00084000008F300F400FF20F20ABB0AF12A8D |
| :100600000130BA00FF30B606B7063608F400FF2006 |
| :100610003708F400FF20BA010130B9007E30F40041 |
| :10062000FF200430F200FA30F3004A20F20B132BC3 |
| :10063000752A8A115E2C83160613831206138316FD |
| :1006400086138312861783160612831206128316E8 |
| :100650008612831286160230EE009630F3004A208E |
| :10066000EE0B2D2B831606128312061283168612AA |
| :1006700083128612831606138312061383168613BB |
| :10068000831286130330F300E830F2000330F500E4 |
| :10069000E830F40024200230EE00FA30F3004A2063 |
| :1006A000EE0B4D2B0330F300E830F2000330F50081 |
| :1006B000E830F40024200430EE00FA30F3004A2041 |
| :1006C000EE0B5D2B8A118A2C01306702FD3E031868 |
| :1006D000A42B033E102C83168613831286138316D5 |
| :1006E0000613831206178316061283120612831648 |
| :1006F0008612831286160130E700A42B8316861219 |
| :1007000083128612831606128312061683160613A8 |
| :100710008312061383168613831286170230E700AE |
| :10072000A42B831686128312861283160612831256 |
| :100730000616831606138312061383168613831276 |
| :1007400086170230E700A42B0030A1001F08C7392C |
| :1007500021049F000330A000A00BAC2B1F151F1914 |
| :10076000AF2B1E0865020318FC2B6E08323C031DDC |
| :10077000F72B831606128312061283168612831233 |
| :1007800086128316061383120613831686138312AA |
| :100790008613EE0101306702FE3E0318F72B023E7E |
| :1007A000172C83168613831286138316061383125F |
| :1007B00006178316061283120612831686128312F8 |
| :1007C00086160130E700F72B8316861283128612F5 |
| :1007D0008316061283120616831606138312061357 |
| :1007E00083168613831286170230E700F72B053035 |
| :1007F000F3004A20EE0AAE2B83160613831206136B |
| :10080000831686138312861383160612831206122A |
| :1008100083168612831286120330E8008A11102E86 |
| :100820000A108A100A1582077E2B6B2B912B0A1057 |
| :100830008A100A158207E42BD12B84011F3083050F |
| :10084000073083169F0082308312A5009830A600DF |
| :10085000A7004030A800A900AA006030AB00863095 |
| :10086000AC00B430AD006030AE00A430AF00B000DA |
| :10087000B1006130B2000330B300F030B400FF309B |
| :10088000BC00EB018316061383120613831686132E |
| :10089000831286138316061283120612831686129B |
| :1008A00083128612043083169F0083121F08383982 |
| :1008B00001389F008316811783124A290330F30001 |
| :1008C000E830F200F501C830F40024203230F300A3 |
| :1008D0004A200330F300E830F200F501C830F4009C |
| :1008E00024200430EE00FA30F3004A20EE0B732C83 |
| :1008F0005030E600E5000330E700E800EA01E901D6 |
| :10090000ED01EC013C163C08831687008312071AA0 |
| :100910008A2C1B2BE8010830A1001F08C7392104CD |
| :100920009F000330A000A00B932C1F151F19962CBD |
| :100930001E0866020319A22C031CA22CEA01E9017D |
| :100940000130E8000030A1001F08C73921049F00D2 |
| :100950000330A000A00BAA2C1F151F19AD2C1E08D8 |
| :1009600065020319B82C031CB82CEA01E901E8144C |
| :100970006808A000033020020319C72C02302002AF |
| :100980000319DA2C013020020319ED2C002D8316F7 |
| :100990008612831286128316061283120616831697 |
| :1009A00086138312861383160613831206170330E9 |
| :1009B000E700822C83160613831206138316861310 |
| :1009C00083128613831686128312861283160612EA |
| :1009D000831206160230E700822C83160612831259 |
| :1009E00006128316861283128612831686138312CA |
| :1009F000861383160613831206170130E700822C34 |
| :100A0000690B4A2DEA08031D4A2DED01EC01013066 |
| :100A10006802FE3E03184A2D023E172E8316061367 |
| :100A20008312061383168613831286176430F3002D |
| :100A30004A20831606138312061383168613831225 |
| :100A40008613831686128312861283160612831269 |
| :100A500006160230E7004A2D83160612831206128C |
| :100A600083168612831286166430F3004A2083169A |
| :100A700006128312061283168612831286128316BA |
| :100A8000861383128613831606138312061701300A |
| :100A9000E7004A2D6908183C031D122E6A08153C10 |
| :100AA000031D122E0330F3002030F2000130F50058 |
| :100AB000F430F40024203230F3004A200330F300F5 |
| :100AC0002030F2000130F500F430F4002420013031 |
| :100AD0006702FD3E0318E62D033E1D2E8316061306 |
| :100AE0008312061383168613831286138316061247 |
| :100AF000831206128316861283128612831606123A |
| :100B00008312061283168612831286160830EE00B0 |
| :100B1000C830F3004A20EE0B882D8316061283128C |
| :100B200006128316861283128612E62D831606138A |
| :100B300083120613831686138312861383160612F6 |
| :100B400083120612831686128312861283160613E8 |
| :100B50008312061383168613831286170830EE005D |
| :100B6000C830F3004A20EE0BB02D83160613831213 |
| :100B700006138316861383128613E62D8316061337 |
| :100B800083120613831686138312861783160612A2 |
| :100B90008312061283168612831286160830EE0020 |
| :100BA000C830F3004A20EE0BD02D831606138312B3 |
| :100BB0000613831686138312861383160612831276 |
| :100BC00006128316861283128612E62D831686126B |
| :100BD0008312861283160612831206168316861354 |
| :100BE0008312861383160613831206170230EE0053 |
| :100BF000C830F3004A20EE0BF82D8316061383123B |
| :100C00000613831686138312861383160612831225 |
| :100C1000061283168612831286120330E700642BB5 |
| :100C2000EA01E901E90A0319EA0A822C63000A10C1 |
| :100C30008A140A1582072C2D0E2D0A108A140A1503 |
| :080C40008207962D6E2DBE2DDA |
| :02400E00793FF8 |
| :00000001FF |
| ;PIC16F873 |
| /roboti/merkur/PIC16F873/main.LST |
|---|
| 0,0 → 1,2057 |
| CCS PCW C Compiler, Version 3.110, 15448 |
| Filename: d:\kaklik\programy\pic_c\roboti\merkur\main.LST |
| ROM used: 1572 (38%) |
| Largest free fragment is 2048 |
| RAM used: 79 (41%) at main() level |
| 90 (47%) worst case |
| Stack: 3 locations |
| * |
| 0000: MOVLW 00 |
| 0001: MOVWF 0A |
| 0002: GOTO 41D |
| 0003: NOP |
| .................... #include "main.h" |
| .................... #include <16F873.h> |
| .................... //////// Standard Header file for the PIC16F873 device //////////////// |
| .................... #device PIC16F873 |
| .................... #list |
| .................... |
| .................... #device adc=8 |
| .................... #use delay(clock=4000000) |
| * |
| 0016: MOVLW 78 |
| 0017: MOVWF 04 |
| 0018: MOVLW FC |
| 0019: ANDWF 00,F |
| 001A: RRF 00,F |
| 001B: RRF 00,F |
| 001C: MOVF 00,W |
| 001D: BTFSC 03.2 |
| 001E: GOTO 023 |
| 001F: GOTO 021 |
| 0020: NOP |
| 0021: DECFSZ 00,F |
| 0022: GOTO 020 |
| 0023: RETLW 00 |
| * |
| 004A: MOVLW 73 |
| 004B: MOVWF 04 |
| 004C: MOVF 00,W |
| 004D: BTFSC 03.2 |
| 004E: GOTO 05E |
| 004F: MOVLW 01 |
| 0050: MOVWF 21 |
| 0051: CLRF 20 |
| 0052: DECFSZ 20,F |
| 0053: GOTO 052 |
| 0054: DECFSZ 21,F |
| 0055: GOTO 051 |
| 0056: MOVLW 4A |
| 0057: MOVWF 20 |
| 0058: DECFSZ 20,F |
| 0059: GOTO 058 |
| 005A: NOP |
| 005B: NOP |
| 005C: DECFSZ 00,F |
| 005D: GOTO 04F |
| 005E: RETLW 00 |
| .................... #fuses XT,NOWDT,NOLVP |
| .................... |
| .................... |
| .................... |
| .................... #define TXo PIN_C3 // To the transmitter modulator |
| .................... #include "AX25.c" // podprogram pro prenos telemetrie |
| .................... //#define PTT PIN_A2 // PTT control |
| .................... //#define TXo PIN_C0 // To the transmitter modulator |
| .................... #define PERIODAH delay_us(222) // Halfperiod H 222;78/1200 500;430/500 |
| .................... #define TAILH delay_us(78) |
| .................... #define PERIODAL delay_us(412) // Halfperiod L 412;345/1200 1000;880/500 |
| .................... #define TAILL delay_us(345) |
| .................... #byte STATUS = 3 // CPUs status register |
| .................... |
| .................... byte SendData[16] = {'A'<<1, 'L'<<1, 'L'<<1, ' '<<1, ' '<<1, ' '<<1, 0x60, |
| .................... 'C'<<1, 'Z'<<1, '0'<<1, 'R'<<1, 'R'<<1, 'R'<<1, 0x61, |
| .................... 0x03, 0xF0}; |
| .................... |
| .................... boolean bit; |
| .................... int fcslo, fcshi; // variabloes for calculating FCS (CRC) |
| .................... int stuff; // stuff counter for extra 0 |
| .................... int flag_flag; // if it is sending flag (7E) |
| .................... int fcs_flag; // if it is sending Frame Check Sequence |
| .................... int i; // for for |
| .................... |
| .................... void flipout() //flips the state of output pin a_1 |
| .................... { |
| .................... stuff = 0; //since this is a 0, reset the stuff counter |
| * |
| 00AE: CLRF 38 |
| .................... if (bit) |
| 00AF: BTFSS 35.0 |
| 00B0: GOTO 0B3 |
| .................... { |
| .................... bit=FALSE; //if the state of the pin was low, make it high. |
| 00B1: BCF 35.0 |
| .................... } |
| .................... else |
| 00B2: GOTO 0B4 |
| .................... { |
| .................... bit=TRUE; //if the state of the pin was high make it low |
| 00B3: BSF 35.0 |
| .................... } |
| 00B4: RETLW 00 |
| .................... } |
| .................... |
| .................... void fcsbit(byte tbyte) |
| .................... { |
| .................... #asm |
| .................... BCF STATUS,0 |
| * |
| 011A: BCF 03.0 |
| .................... RRF fcshi,F // rotates the entire 16 bits |
| 011B: RRF 37,F |
| .................... RRF fcslo,F // to the right |
| .................... #endasm |
| 011C: RRF 36,F |
| .................... if (((STATUS & 0x01)^(tbyte)) ==0x01) |
| 011D: MOVF 03,W |
| 011E: ANDLW 01 |
| 011F: XORWF 77,W |
| 0120: SUBLW 01 |
| 0121: BTFSS 03.2 |
| 0122: GOTO 127 |
| .................... { |
| .................... fcshi = fcshi^0x84; |
| 0123: MOVLW 84 |
| 0124: XORWF 37,F |
| .................... fcslo = fcslo^0x08; |
| 0125: MOVLW 08 |
| 0126: XORWF 36,F |
| .................... } |
| .................... } |
| .................... |
| .................... void SendBit () |
| .................... { |
| .................... if (bit) |
| * |
| 00B5: BTFSS 35.0 |
| 00B6: GOTO 0E8 |
| .................... { |
| .................... output_high(TXo); |
| 00B7: BCF 3C.3 |
| 00B8: MOVF 3C,W |
| 00B9: BSF 03.5 |
| 00BA: MOVWF 07 |
| 00BB: BCF 03.5 |
| 00BC: BSF 07.3 |
| .................... PERIODAH; |
| 00BD: MOVLW 49 |
| 00BE: MOVWF 20 |
| 00BF: DECFSZ 20,F |
| 00C0: GOTO 0BF |
| 00C1: NOP |
| 00C2: NOP |
| .................... output_low(TXo); |
| 00C3: BCF 3C.3 |
| 00C4: MOVF 3C,W |
| 00C5: BSF 03.5 |
| 00C6: MOVWF 07 |
| 00C7: BCF 03.5 |
| 00C8: BCF 07.3 |
| .................... PERIODAH; |
| 00C9: MOVLW 49 |
| 00CA: MOVWF 20 |
| 00CB: DECFSZ 20,F |
| 00CC: GOTO 0CB |
| 00CD: NOP |
| 00CE: NOP |
| .................... output_high(TXo); |
| 00CF: BCF 3C.3 |
| 00D0: MOVF 3C,W |
| 00D1: BSF 03.5 |
| 00D2: MOVWF 07 |
| 00D3: BCF 03.5 |
| 00D4: BSF 07.3 |
| .................... PERIODAH; |
| 00D5: MOVLW 49 |
| 00D6: MOVWF 20 |
| 00D7: DECFSZ 20,F |
| 00D8: GOTO 0D7 |
| 00D9: NOP |
| 00DA: NOP |
| .................... output_low(TXo); |
| 00DB: BCF 3C.3 |
| 00DC: MOVF 3C,W |
| 00DD: BSF 03.5 |
| 00DE: MOVWF 07 |
| 00DF: BCF 03.5 |
| 00E0: BCF 07.3 |
| .................... TAILH; |
| 00E1: MOVLW 19 |
| 00E2: MOVWF 20 |
| 00E3: DECFSZ 20,F |
| 00E4: GOTO 0E3 |
| 00E5: NOP |
| 00E6: NOP |
| .................... } |
| .................... else |
| 00E7: GOTO 0FE |
| .................... { |
| .................... output_high(TXo); |
| 00E8: BCF 3C.3 |
| 00E9: MOVF 3C,W |
| 00EA: BSF 03.5 |
| 00EB: MOVWF 07 |
| 00EC: BCF 03.5 |
| 00ED: BSF 07.3 |
| .................... PERIODAL; |
| 00EE: MOVLW 89 |
| 00EF: MOVWF 20 |
| 00F0: DECFSZ 20,F |
| 00F1: GOTO 0F0 |
| .................... output_low(TXo); |
| 00F2: BCF 3C.3 |
| 00F3: MOVF 3C,W |
| 00F4: BSF 03.5 |
| 00F5: MOVWF 07 |
| 00F6: BCF 03.5 |
| 00F7: BCF 07.3 |
| .................... TAILL; |
| 00F8: MOVLW 72 |
| 00F9: MOVWF 20 |
| 00FA: DECFSZ 20,F |
| 00FB: GOTO 0FA |
| 00FC: NOP |
| 00FD: NOP |
| .................... }; |
| 00FE: RETLW 00 |
| .................... } |
| .................... |
| .................... void SendByte (byte inbyte) |
| .................... { |
| .................... int k, bt; |
| .................... |
| .................... for (k=0;k<8;k++) //do the following for each of the 8 bits in the byte |
| 00FF: CLRF 75 |
| 0100: MOVF 75,W |
| 0101: SUBLW 07 |
| 0102: BTFSS 03.0 |
| 0103: GOTO 149 |
| .................... { |
| .................... bt = inbyte & 0x01; //strip off the rightmost bit of the byte to be sent (inbyte) |
| 0104: MOVF 74,W |
| 0105: ANDLW 01 |
| 0106: MOVWF 76 |
| .................... if ((fcs_flag == FALSE) & (flag_flag == FALSE)) fcsbit(bt); //do FCS calc, but only if this |
| 0107: MOVF 3A,F |
| 0108: BTFSC 03.2 |
| 0109: GOTO 10C |
| 010A: MOVLW 00 |
| 010B: GOTO 10D |
| 010C: MOVLW 01 |
| 010D: MOVWF 77 |
| 010E: MOVF 39,F |
| 010F: BTFSC 03.2 |
| 0110: GOTO 113 |
| 0111: MOVLW 00 |
| 0112: GOTO 114 |
| 0113: MOVLW 01 |
| 0114: ANDWF 77,W |
| 0115: XORLW 00 |
| 0116: BTFSC 03.2 |
| 0117: GOTO 127 |
| 0118: MOVF 76,W |
| 0119: MOVWF 77 |
| .................... //is not a flag or fcs byte |
| .................... if (bt == 0) |
| * |
| 0127: MOVF 76,F |
| 0128: BTFSS 03.2 |
| 0129: GOTO 12C |
| .................... { |
| .................... flipout(); |
| 012A: CALL 0AE |
| .................... } // if this bit is a zero, flip the output state |
| .................... else |
| 012B: GOTO 144 |
| .................... { //otherwise if it is a 1, do the following: |
| .................... if (flag_flag == FALSE) stuff++; //increment the count of consequtive 1's |
| 012C: MOVF 39,F |
| 012D: BTFSS 03.2 |
| 012E: GOTO 130 |
| 012F: INCF 38,F |
| .................... if ((flag_flag == FALSE) & (stuff == 5)) |
| 0130: MOVF 39,F |
| 0131: BTFSC 03.2 |
| 0132: GOTO 135 |
| 0133: MOVLW 00 |
| 0134: GOTO 136 |
| 0135: MOVLW 01 |
| 0136: MOVWF 77 |
| 0137: MOVF 38,W |
| 0138: SUBLW 05 |
| 0139: BTFSC 03.2 |
| 013A: GOTO 13D |
| 013B: MOVLW 00 |
| 013C: GOTO 13E |
| 013D: MOVLW 01 |
| 013E: ANDWF 77,W |
| 013F: XORLW 00 |
| 0140: BTFSC 03.2 |
| 0141: GOTO 144 |
| .................... { //stuff an extra 0, if 5 1's in a row |
| .................... SendBit(); |
| 0142: CALL 0B5 |
| .................... flipout(); //flip the output state to stuff a 0 |
| 0143: CALL 0AE |
| .................... }//end of if |
| .................... }//end of else |
| .................... // delay_us(850); //introduces a delay that creates 1200 baud |
| .................... SendBit(); |
| 0144: CALL 0B5 |
| .................... inbyte = inbyte>>1; //go to the next bit in the byte |
| 0145: BCF 03.0 |
| 0146: RRF 74,F |
| .................... }//end of for |
| 0147: INCF 75,F |
| 0148: GOTO 100 |
| 0149: RETLW 00 |
| .................... }//end of SendByte |
| .................... |
| .................... void SendPacket(char *data) |
| .................... { |
| .................... bit=FALSE; |
| * |
| 02CF: BCF 35.0 |
| .................... |
| .................... fcslo=fcshi=0xFF; //The 2 FCS Bytes are initialized to FF |
| 02D0: MOVLW FF |
| 02D1: MOVWF 37 |
| 02D2: MOVWF 36 |
| .................... stuff = 0; //The variable stuff counts the number of 1's in a row. When it gets to 5 |
| 02D3: CLRF 38 |
| .................... // it is time to stuff a 0. |
| .................... |
| .................... // output_low(PTT); // Blinking LED |
| .................... // delay_ms(1000); |
| .................... // output_high(PTT); |
| .................... |
| .................... flag_flag = TRUE; //The variable flag is true if you are transmitted flags (7E's) false otherwise. |
| 02D4: MOVLW 01 |
| 02D5: MOVWF 39 |
| .................... fcs_flag = FALSE; //The variable fcsflag is true if you are transmitting FCS bytes, false otherwise. |
| 02D6: CLRF 3A |
| .................... |
| .................... for(i=0; i<10; i++) SendByte(0x7E); //Sends flag bytes. Adjust length for txdelay |
| 02D7: CLRF 3B |
| 02D8: MOVF 3B,W |
| 02D9: SUBLW 09 |
| 02DA: BTFSS 03.0 |
| 02DB: GOTO 2E1 |
| 02DC: MOVLW 7E |
| 02DD: MOVWF 74 |
| 02DE: CALL 0FF |
| 02DF: INCF 3B,F |
| 02E0: GOTO 2D8 |
| .................... //each flag takes approx 6.7 ms |
| .................... flag_flag = FALSE; //done sending flags |
| 02E1: CLRF 39 |
| .................... |
| .................... for(i=0; i<16; i++) SendByte(SendData[i]); //send the packet bytes |
| 02E2: CLRF 3B |
| 02E3: MOVF 3B,W |
| 02E4: SUBLW 0F |
| 02E5: BTFSS 03.0 |
| 02E6: GOTO 2F0 |
| 02E7: MOVLW 25 |
| 02E8: ADDWF 3B,W |
| 02E9: MOVWF 04 |
| 02EA: MOVF 00,W |
| 02EB: MOVWF 73 |
| 02EC: MOVWF 74 |
| 02ED: CALL 0FF |
| 02EE: INCF 3B,F |
| 02EF: GOTO 2E3 |
| .................... |
| .................... for(i=0; 0 != *data; i++) |
| 02F0: CLRF 3B |
| 02F1: MOVF 72,W |
| 02F2: MOVWF 04 |
| 02F3: MOVF 00,W |
| 02F4: XORLW 00 |
| 02F5: BTFSC 03.2 |
| 02F6: GOTO 300 |
| .................... { |
| .................... SendByte(*data); //send the packet bytes |
| 02F7: MOVF 72,W |
| 02F8: MOVWF 04 |
| 02F9: MOVF 00,W |
| 02FA: MOVWF 73 |
| 02FB: MOVWF 74 |
| 02FC: CALL 0FF |
| .................... data++; |
| 02FD: INCF 72,F |
| .................... }; |
| 02FE: INCF 3B,F |
| 02FF: GOTO 2F1 |
| .................... |
| .................... fcs_flag = TRUE; //about to send the FCS bytes |
| 0300: MOVLW 01 |
| 0301: MOVWF 3A |
| .................... fcslo =fcslo^0xff; //must XOR them with FF before sending |
| 0302: MOVLW FF |
| 0303: XORWF 36,F |
| .................... fcshi = fcshi^0xff; |
| 0304: XORWF 37,F |
| .................... SendByte(fcslo); //send the low byte of fcs |
| 0305: MOVF 36,W |
| 0306: MOVWF 74 |
| 0307: CALL 0FF |
| .................... SendByte(fcshi); //send the high byte of fcs |
| 0308: MOVF 37,W |
| 0309: MOVWF 74 |
| 030A: CALL 0FF |
| .................... fcs_flag = FALSE; //done sending FCS |
| 030B: CLRF 3A |
| .................... flag_flag = TRUE; //about to send flags |
| 030C: MOVLW 01 |
| 030D: MOVWF 39 |
| .................... SendByte(0x7e); // Send a flag to end packet |
| 030E: MOVLW 7E |
| 030F: MOVWF 74 |
| 0310: CALL 0FF |
| .................... } |
| .................... |
| .................... |
| .................... |
| .................... |
| .................... |
| .................... //motory //Napred vypnout potom zapnout! |
| .................... #define FR output_low(PIN_B5); output_high(PIN_B4) // Vpred |
| .................... #define FL output_low(PIN_B7); output_high(PIN_B6) |
| .................... #define BR output_low(PIN_B4); output_high(PIN_B5) // Vzad |
| .................... #define BL output_low(PIN_B6); output_high(PIN_B7) |
| .................... #define STOPR output_low(PIN_B4);output_low(PIN_B5) |
| .................... #define STOPL output_low(PIN_B6);output_low(PIN_B7) |
| .................... |
| .................... #define L 0b10 // left |
| .................... #define R 0b01 // right |
| .................... #define S 0b11 // straight |
| .................... |
| .................... #define COUVANI 1600 // couvnuti po zjisteni diry |
| .................... #define MEZERA 5400 // za jak dlouho bude ztracena cara |
| .................... #define PRES_DIRU 400 // velikost mezery v care |
| .................... #define ODEZVA 1 // za jak dlouho po opusteni cary se ma zacit zatacet |
| .................... #define BRZDENI 100 // doba (v ms) ptrebna k zastaveni jednoho motoru |
| .................... |
| .................... //cidla |
| .................... #define RSENSOR 1 // Senzory na caru |
| .................... #define LSENSOR 0 |
| .................... #define BUMPER PIN_C4 // sensor na cihlu |
| .................... |
| .................... #define DIAG_SERVO PIN_B0 // Propojka pro diagnosticky mod |
| .................... #define DIAG_SENSORS PIN_B1 // Propojka pro diagnosticky mod |
| .................... |
| .................... #DEFINE SOUND_HI PIN_B3 |
| .................... #DEFINE SOUND_LO PIN_B2 |
| .................... |
| .................... char AXstring[40]; // Buffer pro prenos telemetrie |
| .................... |
| .................... int tresholdL; // rozhodovaci uroven pro prave cidlo |
| .................... int tresholdR; // rozhodovaci uroven pro prave cidlo |
| .................... int movement; // smer minuleho pohybu |
| .................... int line; // na ktere strane byla detekovana cara |
| .................... unsigned int16 dira; // pocitadlo pro nalezeni preruseni cary |
| .................... |
| .................... // Primitivni Pipani |
| .................... void beep(unsigned int16 period, unsigned int16 length) |
| .................... { |
| .................... unsigned int16 nn; |
| .................... |
| .................... for(nn=length; nn>0; nn--) |
| * |
| 0024: MOVF 75,W |
| 0025: MOVWF 77 |
| 0026: MOVF 74,W |
| 0027: MOVWF 76 |
| 0028: MOVF 76,F |
| 0029: BTFSS 03.2 |
| 002A: GOTO 02E |
| 002B: MOVF 77,F |
| 002C: BTFSC 03.2 |
| 002D: GOTO 049 |
| .................... { |
| .................... output_high(SOUND_HI);output_low(SOUND_LO); |
| 002E: BSF 03.5 |
| 002F: BCF 06.3 |
| 0030: BCF 03.5 |
| 0031: BSF 06.3 |
| 0032: BSF 03.5 |
| 0033: BCF 06.2 |
| 0034: BCF 03.5 |
| 0035: BCF 06.2 |
| .................... delay_us(period); |
| 0036: MOVF 72,W |
| 0037: MOVWF 78 |
| 0038: CALL 016 |
| .................... output_high(SOUND_LO);output_low(SOUND_HI); |
| 0039: BSF 03.5 |
| 003A: BCF 06.2 |
| 003B: BCF 03.5 |
| 003C: BSF 06.2 |
| 003D: BSF 03.5 |
| 003E: BCF 06.3 |
| 003F: BCF 03.5 |
| 0040: BCF 06.3 |
| .................... delay_us(period); |
| 0041: MOVF 72,W |
| 0042: MOVWF 78 |
| 0043: CALL 016 |
| .................... } |
| 0044: MOVF 76,W |
| 0045: BTFSC 03.2 |
| 0046: DECF 77,F |
| 0047: DECF 76,F |
| 0048: GOTO 028 |
| 0049: RETLW 00 |
| .................... } |
| .................... |
| .................... // Diagnostika pohonu, hejbne vsema motorama ve vsech smerech |
| .................... void diagnostika() |
| .................... { |
| .................... unsigned int16 n; |
| .................... |
| .................... while (input(DIAG_SERVO)) // Propojka, ktera spousti diagnostiku |
| * |
| 014A: BSF 03.5 |
| 014B: BSF 06.0 |
| 014C: BCF 03.5 |
| 014D: BTFSS 06.0 |
| 014E: GOTO 275 |
| .................... { |
| .................... for (n=500; n<800; n+=100) |
| 014F: MOVLW 01 |
| 0150: MOVWF 6F |
| 0151: MOVLW F4 |
| 0152: MOVWF 6E |
| 0153: MOVF 6F,W |
| 0154: SUBLW 03 |
| 0155: BTFSS 03.0 |
| 0156: GOTO 16B |
| 0157: BTFSS 03.2 |
| 0158: GOTO 15D |
| 0159: MOVF 6E,W |
| 015A: SUBLW 1F |
| 015B: BTFSS 03.0 |
| 015C: GOTO 16B |
| .................... { |
| .................... beep(n,n); //beep UP |
| 015D: MOVF 6F,W |
| 015E: MOVWF 73 |
| 015F: MOVF 6E,W |
| 0160: MOVWF 72 |
| 0161: MOVF 6F,W |
| 0162: MOVWF 75 |
| 0163: MOVF 6E,W |
| 0164: MOVWF 74 |
| 0165: CALL 024 |
| .................... }; |
| 0166: MOVLW 64 |
| 0167: ADDWF 6E,F |
| 0168: BTFSC 03.0 |
| 0169: INCF 6F,F |
| 016A: GOTO 153 |
| .................... Delay_ms(1000); |
| 016B: MOVLW 04 |
| 016C: MOVWF 72 |
| 016D: MOVLW FA |
| 016E: MOVWF 73 |
| 016F: CALL 04A |
| 0170: DECFSZ 72,F |
| 0171: GOTO 16D |
| .................... //zastav vse |
| .................... STOPL; STOPR; |
| 0172: BSF 03.5 |
| 0173: BCF 06.6 |
| 0174: BCF 03.5 |
| 0175: BCF 06.6 |
| 0176: BSF 03.5 |
| 0177: BCF 06.7 |
| 0178: BCF 03.5 |
| 0179: BCF 06.7 |
| 017A: BSF 03.5 |
| 017B: BCF 06.4 |
| 017C: BCF 03.5 |
| 017D: BCF 06.4 |
| 017E: BSF 03.5 |
| 017F: BCF 06.5 |
| 0180: BCF 03.5 |
| 0181: BCF 06.5 |
| .................... //pravy pas |
| .................... FR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| 0182: BSF 03.5 |
| 0183: BCF 06.5 |
| 0184: BCF 03.5 |
| 0185: BCF 06.5 |
| 0186: BSF 03.5 |
| 0187: BCF 06.4 |
| 0188: BCF 03.5 |
| 0189: BSF 06.4 |
| 018A: MOVLW 04 |
| 018B: MOVWF 72 |
| 018C: MOVLW FA |
| 018D: MOVWF 73 |
| 018E: CALL 04A |
| 018F: DECFSZ 72,F |
| 0190: GOTO 18C |
| 0191: BSF 03.5 |
| 0192: BCF 06.4 |
| 0193: BCF 03.5 |
| 0194: BCF 06.4 |
| 0195: BSF 03.5 |
| 0196: BCF 06.5 |
| 0197: BCF 03.5 |
| 0198: BCF 06.5 |
| 0199: MOVLW 04 |
| 019A: MOVWF 72 |
| 019B: MOVLW FA |
| 019C: MOVWF 73 |
| 019D: CALL 04A |
| 019E: DECFSZ 72,F |
| 019F: GOTO 19B |
| .................... BR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| 01A0: BSF 03.5 |
| 01A1: BCF 06.4 |
| 01A2: BCF 03.5 |
| 01A3: BCF 06.4 |
| 01A4: BSF 03.5 |
| 01A5: BCF 06.5 |
| 01A6: BCF 03.5 |
| 01A7: BSF 06.5 |
| 01A8: MOVLW 04 |
| 01A9: MOVWF 72 |
| 01AA: MOVLW FA |
| 01AB: MOVWF 73 |
| 01AC: CALL 04A |
| 01AD: DECFSZ 72,F |
| 01AE: GOTO 1AA |
| 01AF: BSF 03.5 |
| 01B0: BCF 06.4 |
| 01B1: BCF 03.5 |
| 01B2: BCF 06.4 |
| 01B3: BSF 03.5 |
| 01B4: BCF 06.5 |
| 01B5: BCF 03.5 |
| 01B6: BCF 06.5 |
| 01B7: MOVLW 04 |
| 01B8: MOVWF 72 |
| 01B9: MOVLW FA |
| 01BA: MOVWF 73 |
| 01BB: CALL 04A |
| 01BC: DECFSZ 72,F |
| 01BD: GOTO 1B9 |
| .................... Beep(880,100); Delay_ms(1000); |
| 01BE: MOVLW 03 |
| 01BF: MOVWF 73 |
| 01C0: MOVLW 70 |
| 01C1: MOVWF 72 |
| 01C2: CLRF 75 |
| 01C3: MOVLW 64 |
| 01C4: MOVWF 74 |
| 01C5: CALL 024 |
| 01C6: MOVLW 04 |
| 01C7: MOVWF 72 |
| 01C8: MOVLW FA |
| 01C9: MOVWF 73 |
| 01CA: CALL 04A |
| 01CB: DECFSZ 72,F |
| 01CC: GOTO 1C8 |
| .................... //levy pas |
| .................... FL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| 01CD: BSF 03.5 |
| 01CE: BCF 06.7 |
| 01CF: BCF 03.5 |
| 01D0: BCF 06.7 |
| 01D1: BSF 03.5 |
| 01D2: BCF 06.6 |
| 01D3: BCF 03.5 |
| 01D4: BSF 06.6 |
| 01D5: MOVLW 04 |
| 01D6: MOVWF 72 |
| 01D7: MOVLW FA |
| 01D8: MOVWF 73 |
| 01D9: CALL 04A |
| 01DA: DECFSZ 72,F |
| 01DB: GOTO 1D7 |
| 01DC: BSF 03.5 |
| 01DD: BCF 06.6 |
| 01DE: BCF 03.5 |
| 01DF: BCF 06.6 |
| 01E0: BSF 03.5 |
| 01E1: BCF 06.7 |
| 01E2: BCF 03.5 |
| 01E3: BCF 06.7 |
| 01E4: MOVLW 04 |
| 01E5: MOVWF 72 |
| 01E6: MOVLW FA |
| 01E7: MOVWF 73 |
| 01E8: CALL 04A |
| 01E9: DECFSZ 72,F |
| 01EA: GOTO 1E6 |
| .................... BL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| 01EB: BSF 03.5 |
| 01EC: BCF 06.6 |
| 01ED: BCF 03.5 |
| 01EE: BCF 06.6 |
| 01EF: BSF 03.5 |
| 01F0: BCF 06.7 |
| 01F1: BCF 03.5 |
| 01F2: BSF 06.7 |
| 01F3: MOVLW 04 |
| 01F4: MOVWF 72 |
| 01F5: MOVLW FA |
| 01F6: MOVWF 73 |
| 01F7: CALL 04A |
| 01F8: DECFSZ 72,F |
| 01F9: GOTO 1F5 |
| 01FA: BSF 03.5 |
| 01FB: BCF 06.6 |
| 01FC: BCF 03.5 |
| 01FD: BCF 06.6 |
| 01FE: BSF 03.5 |
| 01FF: BCF 06.7 |
| 0200: BCF 03.5 |
| 0201: BCF 06.7 |
| 0202: MOVLW 04 |
| 0203: MOVWF 72 |
| 0204: MOVLW FA |
| 0205: MOVWF 73 |
| 0206: CALL 04A |
| 0207: DECFSZ 72,F |
| 0208: GOTO 204 |
| .................... Beep(880,100); Delay_ms(1000); |
| 0209: MOVLW 03 |
| 020A: MOVWF 73 |
| 020B: MOVLW 70 |
| 020C: MOVWF 72 |
| 020D: CLRF 75 |
| 020E: MOVLW 64 |
| 020F: MOVWF 74 |
| 0210: CALL 024 |
| 0211: MOVLW 04 |
| 0212: MOVWF 72 |
| 0213: MOVLW FA |
| 0214: MOVWF 73 |
| 0215: CALL 04A |
| 0216: DECFSZ 72,F |
| 0217: GOTO 213 |
| .................... //oba pasy |
| .................... FL; FR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| 0218: BSF 03.5 |
| 0219: BCF 06.7 |
| 021A: BCF 03.5 |
| 021B: BCF 06.7 |
| 021C: BSF 03.5 |
| 021D: BCF 06.6 |
| 021E: BCF 03.5 |
| 021F: BSF 06.6 |
| 0220: BSF 03.5 |
| 0221: BCF 06.5 |
| 0222: BCF 03.5 |
| 0223: BCF 06.5 |
| 0224: BSF 03.5 |
| 0225: BCF 06.4 |
| 0226: BCF 03.5 |
| 0227: BSF 06.4 |
| 0228: MOVLW 04 |
| 0229: MOVWF 72 |
| 022A: MOVLW FA |
| 022B: MOVWF 73 |
| 022C: CALL 04A |
| 022D: DECFSZ 72,F |
| 022E: GOTO 22A |
| 022F: BSF 03.5 |
| 0230: BCF 06.6 |
| 0231: BCF 03.5 |
| 0232: BCF 06.6 |
| 0233: BSF 03.5 |
| 0234: BCF 06.7 |
| 0235: BCF 03.5 |
| 0236: BCF 06.7 |
| 0237: BSF 03.5 |
| 0238: BCF 06.4 |
| 0239: BCF 03.5 |
| 023A: BCF 06.4 |
| 023B: BSF 03.5 |
| 023C: BCF 06.5 |
| 023D: BCF 03.5 |
| 023E: BCF 06.5 |
| 023F: MOVLW 04 |
| 0240: MOVWF 72 |
| 0241: MOVLW FA |
| 0242: MOVWF 73 |
| 0243: CALL 04A |
| 0244: DECFSZ 72,F |
| 0245: GOTO 241 |
| .................... BL; BR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| 0246: BSF 03.5 |
| 0247: BCF 06.6 |
| 0248: BCF 03.5 |
| 0249: BCF 06.6 |
| 024A: BSF 03.5 |
| 024B: BCF 06.7 |
| 024C: BCF 03.5 |
| 024D: BSF 06.7 |
| 024E: BSF 03.5 |
| 024F: BCF 06.4 |
| 0250: BCF 03.5 |
| 0251: BCF 06.4 |
| 0252: BSF 03.5 |
| 0253: BCF 06.5 |
| 0254: BCF 03.5 |
| 0255: BSF 06.5 |
| 0256: MOVLW 04 |
| 0257: MOVWF 72 |
| 0258: MOVLW FA |
| 0259: MOVWF 73 |
| 025A: CALL 04A |
| 025B: DECFSZ 72,F |
| 025C: GOTO 258 |
| 025D: BSF 03.5 |
| 025E: BCF 06.6 |
| 025F: BCF 03.5 |
| 0260: BCF 06.6 |
| 0261: BSF 03.5 |
| 0262: BCF 06.7 |
| 0263: BCF 03.5 |
| 0264: BCF 06.7 |
| 0265: BSF 03.5 |
| 0266: BCF 06.4 |
| 0267: BCF 03.5 |
| 0268: BCF 06.4 |
| 0269: BSF 03.5 |
| 026A: BCF 06.5 |
| 026B: BCF 03.5 |
| 026C: BCF 06.5 |
| 026D: MOVLW 04 |
| 026E: MOVWF 72 |
| 026F: MOVLW FA |
| 0270: MOVWF 73 |
| 0271: CALL 04A |
| 0272: DECFSZ 72,F |
| 0273: GOTO 26F |
| .................... }; |
| 0274: GOTO 14A |
| .................... |
| .................... while (input(DIAG_SENSORS)) |
| 0275: BSF 03.5 |
| 0276: BSF 06.1 |
| 0277: BCF 03.5 |
| 0278: BTFSS 06.1 |
| 0279: GOTO 319 |
| .................... { |
| .................... int ls, rs; |
| .................... while(!input(BUMPER)){beep(1100,100); Delay_ms(50);} |
| 027A: BSF 3C.4 |
| 027B: MOVF 3C,W |
| 027C: BSF 03.5 |
| 027D: MOVWF 07 |
| 027E: BCF 03.5 |
| 027F: BTFSC 07.4 |
| 0280: GOTO 28D |
| 0281: MOVLW 04 |
| 0282: MOVWF 73 |
| 0283: MOVLW 4C |
| 0284: MOVWF 72 |
| 0285: CLRF 75 |
| 0286: MOVLW 64 |
| 0287: MOVWF 74 |
| 0288: CALL 024 |
| 0289: MOVLW 32 |
| 028A: MOVWF 73 |
| 028B: CALL 04A |
| 028C: GOTO 27A |
| .................... set_adc_channel(RSENSOR); |
| 028D: MOVLW 08 |
| 028E: MOVWF 21 |
| 028F: MOVF 1F,W |
| 0290: ANDLW C7 |
| 0291: IORWF 21,W |
| 0292: MOVWF 1F |
| .................... Delay_us(20); |
| 0293: MOVLW 06 |
| 0294: MOVWF 20 |
| 0295: DECFSZ 20,F |
| 0296: GOTO 295 |
| 0297: NOP |
| .................... rs=read_adc(); |
| 0298: BSF 1F.2 |
| 0299: BTFSC 1F.2 |
| 029A: GOTO 299 |
| 029B: MOVF 1E,W |
| 029C: MOVWF 71 |
| .................... set_adc_channel(LSENSOR); |
| 029D: MOVLW 00 |
| 029E: MOVWF 21 |
| 029F: MOVF 1F,W |
| 02A0: ANDLW C7 |
| 02A1: IORWF 21,W |
| 02A2: MOVWF 1F |
| .................... Delay_us(20); |
| 02A3: MOVLW 06 |
| 02A4: MOVWF 20 |
| 02A5: DECFSZ 20,F |
| 02A6: GOTO 2A5 |
| 02A7: NOP |
| .................... ls=read_adc(); |
| 02A8: BSF 1F.2 |
| 02A9: BTFSC 1F.2 |
| 02AA: GOTO 2A9 |
| 02AB: MOVF 1E,W |
| 02AC: MOVWF 70 |
| .................... sprintf(AXstring,"L: %U R: %U\0", ls, rs); // Convert DATA to String. |
| * |
| 0004: BCF 0A.0 |
| 0005: BCF 0A.1 |
| 0006: BCF 0A.2 |
| 0007: ADDWF 02,F |
| 0008: RETLW 4C |
| 0009: RETLW 3A |
| 000A: RETLW 20 |
| 000B: RETLW 25 |
| 000C: RETLW 55 |
| 000D: RETLW 20 |
| 000E: RETLW 20 |
| 000F: RETLW 52 |
| 0010: RETLW 3A |
| 0011: RETLW 20 |
| 0012: RETLW 25 |
| 0013: RETLW 55 |
| 0014: RETLW 00 |
| 0015: RETLW 00 |
| * |
| 007C: MOVF 21,W |
| 007D: MOVF 73,W |
| 007E: MOVWF 75 |
| 007F: MOVLW 64 |
| 0080: MOVWF 76 |
| 0081: CALL 067 |
| 0082: MOVF 20,W |
| 0083: MOVWF 73 |
| 0084: MOVF 21,W |
| 0085: MOVLW 30 |
| 0086: BTFSS 03.2 |
| 0087: GOTO 08F |
| 0088: BTFSC 74.0 |
| 0089: BSF 74.3 |
| 008A: BTFSC 74.3 |
| 008B: GOTO 095 |
| 008C: BTFSC 74.4 |
| 008D: MOVLW 20 |
| 008E: GOTO 091 |
| 008F: BCF 74.3 |
| 0090: BCF 74.4 |
| 0091: ADDWF 21,F |
| 0092: MOVF 21,W |
| 0093: MOVWF 75 |
| 0094: CALL 05F |
| 0095: MOVF 73,W |
| 0096: MOVWF 75 |
| 0097: MOVLW 0A |
| 0098: MOVWF 76 |
| 0099: CALL 067 |
| 009A: MOVF 20,W |
| 009B: MOVWF 73 |
| 009C: MOVF 21,W |
| 009D: MOVLW 30 |
| 009E: BTFSS 03.2 |
| 009F: GOTO 0A4 |
| 00A0: BTFSC 74.3 |
| 00A1: GOTO 0A8 |
| 00A2: BTFSC 74.4 |
| 00A3: MOVLW 20 |
| 00A4: ADDWF 21,F |
| 00A5: MOVF 21,W |
| 00A6: MOVWF 75 |
| 00A7: CALL 05F |
| 00A8: MOVLW 30 |
| 00A9: ADDWF 73,F |
| 00AA: MOVF 73,W |
| 00AB: MOVWF 75 |
| 00AC: CALL 05F |
| 00AD: RETLW 00 |
| * |
| 02AD: MOVLW 3D |
| 02AE: MOVWF 6B |
| 02AF: MOVLW 4C |
| 02B0: MOVWF 75 |
| 02B1: CALL 05F |
| 02B2: MOVLW 3A |
| 02B3: MOVWF 75 |
| 02B4: CALL 05F |
| 02B5: MOVLW 20 |
| 02B6: MOVWF 75 |
| 02B7: CALL 05F |
| 02B8: MOVF 70,W |
| 02B9: MOVWF 73 |
| 02BA: MOVLW 18 |
| 02BB: MOVWF 74 |
| 02BC: CALL 07C |
| 02BD: MOVLW 05 |
| 02BE: MOVWF 72 |
| 02BF: MOVF 72,W |
| 02C0: CALL 004 |
| 02C1: INCF 72,F |
| 02C2: MOVWF 75 |
| 02C3: CALL 05F |
| 02C4: MOVLW 0A |
| 02C5: SUBWF 72,W |
| 02C6: BTFSS 03.2 |
| 02C7: GOTO 2BF |
| 02C8: MOVF 71,W |
| 02C9: MOVWF 73 |
| 02CA: MOVLW 18 |
| 02CB: MOVWF 74 |
| 02CC: CALL 07C |
| .................... SendPacket(&AXstring[0]); |
| 02CD: MOVLW 3D |
| 02CE: MOVWF 72 |
| .................... delay_ms(1000); |
| * |
| 0311: MOVLW 04 |
| 0312: MOVWF 72 |
| 0313: MOVLW FA |
| 0314: MOVWF 73 |
| 0315: CALL 04A |
| 0316: DECFSZ 72,F |
| 0317: GOTO 313 |
| .................... }; |
| 0318: GOTO 275 |
| 0319: BCF 0A.3 |
| 031A: GOTO 45E (RETURN) |
| .................... } |
| .................... |
| .................... void cikcak() |
| .................... { |
| .................... int n; |
| .................... switch(movement) // podivej se na jednu stranu |
| * |
| 0364: MOVLW 01 |
| 0365: SUBWF 67,W |
| 0366: ADDLW FD |
| 0367: BTFSC 03.0 |
| 0368: GOTO 3A4 |
| 0369: ADDLW 03 |
| 036A: GOTO 410 |
| .................... { |
| .................... case L: |
| .................... FL;BR; |
| 036B: BSF 03.5 |
| 036C: BCF 06.7 |
| 036D: BCF 03.5 |
| 036E: BCF 06.7 |
| 036F: BSF 03.5 |
| 0370: BCF 06.6 |
| 0371: BCF 03.5 |
| 0372: BSF 06.6 |
| 0373: BSF 03.5 |
| 0374: BCF 06.4 |
| 0375: BCF 03.5 |
| 0376: BCF 06.4 |
| 0377: BSF 03.5 |
| 0378: BCF 06.5 |
| 0379: BCF 03.5 |
| 037A: BSF 06.5 |
| .................... movement=R; |
| 037B: MOVLW 01 |
| 037C: MOVWF 67 |
| .................... break; |
| 037D: GOTO 3A4 |
| .................... case R: |
| .................... FR;BL; |
| 037E: BSF 03.5 |
| 037F: BCF 06.5 |
| 0380: BCF 03.5 |
| 0381: BCF 06.5 |
| 0382: BSF 03.5 |
| 0383: BCF 06.4 |
| 0384: BCF 03.5 |
| 0385: BSF 06.4 |
| 0386: BSF 03.5 |
| 0387: BCF 06.6 |
| 0388: BCF 03.5 |
| 0389: BCF 06.6 |
| 038A: BSF 03.5 |
| 038B: BCF 06.7 |
| 038C: BCF 03.5 |
| 038D: BSF 06.7 |
| .................... movement=L; |
| 038E: MOVLW 02 |
| 038F: MOVWF 67 |
| .................... break; |
| 0390: GOTO 3A4 |
| .................... case S: |
| .................... FR;BL; |
| 0391: BSF 03.5 |
| 0392: BCF 06.5 |
| 0393: BCF 03.5 |
| 0394: BCF 06.5 |
| 0395: BSF 03.5 |
| 0396: BCF 06.4 |
| 0397: BCF 03.5 |
| 0398: BSF 06.4 |
| 0399: BSF 03.5 |
| 039A: BCF 06.6 |
| 039B: BCF 03.5 |
| 039C: BCF 06.6 |
| 039D: BSF 03.5 |
| 039E: BCF 06.7 |
| 039F: BCF 03.5 |
| 03A0: BSF 06.7 |
| .................... movement=L; |
| 03A1: MOVLW 02 |
| 03A2: MOVWF 67 |
| .................... break; |
| 03A3: GOTO 3A4 |
| .................... } |
| * |
| 0410: BCF 0A.0 |
| 0411: BCF 0A.1 |
| 0412: BSF 0A.2 |
| 0413: ADDWF 02,F |
| 0414: GOTO 37E |
| 0415: GOTO 36B |
| 0416: GOTO 391 |
| .................... set_adc_channel(LSENSOR); |
| * |
| 03A4: MOVLW 00 |
| 03A5: MOVWF 21 |
| 03A6: MOVF 1F,W |
| 03A7: ANDLW C7 |
| 03A8: IORWF 21,W |
| 03A9: MOVWF 1F |
| .................... Delay_us(10); |
| 03AA: MOVLW 03 |
| 03AB: MOVWF 20 |
| 03AC: DECFSZ 20,F |
| 03AD: GOTO 3AC |
| .................... while (tresholdL < read_adc()) // je tam cara?? |
| 03AE: BSF 1F.2 |
| 03AF: BTFSC 1F.2 |
| 03B0: GOTO 3AF |
| 03B1: MOVF 1E,W |
| 03B2: SUBWF 65,W |
| 03B3: BTFSC 03.0 |
| 03B4: GOTO 3FC |
| .................... { |
| .................... if (n==50) // asi bude na druhe strane |
| 03B5: MOVF 6E,W |
| 03B6: SUBLW 32 |
| 03B7: BTFSS 03.2 |
| 03B8: GOTO 3F7 |
| .................... { |
| .................... STOPR;STOPL; |
| 03B9: BSF 03.5 |
| 03BA: BCF 06.4 |
| 03BB: BCF 03.5 |
| 03BC: BCF 06.4 |
| 03BD: BSF 03.5 |
| 03BE: BCF 06.5 |
| 03BF: BCF 03.5 |
| 03C0: BCF 06.5 |
| 03C1: BSF 03.5 |
| 03C2: BCF 06.6 |
| 03C3: BCF 03.5 |
| 03C4: BCF 06.6 |
| 03C5: BSF 03.5 |
| 03C6: BCF 06.7 |
| 03C7: BCF 03.5 |
| 03C8: BCF 06.7 |
| .................... n=0; |
| 03C9: CLRF 6E |
| .................... switch(movement) |
| 03CA: MOVLW 01 |
| 03CB: SUBWF 67,W |
| 03CC: ADDLW FE |
| 03CD: BTFSC 03.0 |
| 03CE: GOTO 3F7 |
| 03CF: ADDLW 02 |
| 03D0: GOTO 417 |
| .................... { |
| .................... case L: |
| .................... FL;BR; |
| 03D1: BSF 03.5 |
| 03D2: BCF 06.7 |
| 03D3: BCF 03.5 |
| 03D4: BCF 06.7 |
| 03D5: BSF 03.5 |
| 03D6: BCF 06.6 |
| 03D7: BCF 03.5 |
| 03D8: BSF 06.6 |
| 03D9: BSF 03.5 |
| 03DA: BCF 06.4 |
| 03DB: BCF 03.5 |
| 03DC: BCF 06.4 |
| 03DD: BSF 03.5 |
| 03DE: BCF 06.5 |
| 03DF: BCF 03.5 |
| 03E0: BSF 06.5 |
| .................... movement=R; |
| 03E1: MOVLW 01 |
| 03E2: MOVWF 67 |
| .................... break; |
| 03E3: GOTO 3F7 |
| .................... case R: |
| .................... FR;BL; |
| 03E4: BSF 03.5 |
| 03E5: BCF 06.5 |
| 03E6: BCF 03.5 |
| 03E7: BCF 06.5 |
| 03E8: BSF 03.5 |
| 03E9: BCF 06.4 |
| 03EA: BCF 03.5 |
| 03EB: BSF 06.4 |
| 03EC: BSF 03.5 |
| 03ED: BCF 06.6 |
| 03EE: BCF 03.5 |
| 03EF: BCF 06.6 |
| 03F0: BSF 03.5 |
| 03F1: BCF 06.7 |
| 03F2: BCF 03.5 |
| 03F3: BSF 06.7 |
| .................... movement=L; |
| 03F4: MOVLW 02 |
| 03F5: MOVWF 67 |
| .................... break; |
| 03F6: GOTO 3F7 |
| .................... } |
| * |
| 0417: BCF 0A.0 |
| 0418: BCF 0A.1 |
| 0419: BSF 0A.2 |
| 041A: ADDWF 02,F |
| 041B: GOTO 3E4 |
| 041C: GOTO 3D1 |
| .................... } |
| .................... Delay_ms(5); |
| * |
| 03F7: MOVLW 05 |
| 03F8: MOVWF 73 |
| 03F9: CALL 04A |
| .................... n++; |
| 03FA: INCF 6E,F |
| .................... } |
| 03FB: GOTO 3AE |
| .................... STOPL;STOPR; // nasli jsme caru |
| 03FC: BSF 03.5 |
| 03FD: BCF 06.6 |
| 03FE: BCF 03.5 |
| 03FF: BCF 06.6 |
| 0400: BSF 03.5 |
| 0401: BCF 06.7 |
| 0402: BCF 03.5 |
| 0403: BCF 06.7 |
| 0404: BSF 03.5 |
| 0405: BCF 06.4 |
| 0406: BCF 03.5 |
| 0407: BCF 06.4 |
| 0408: BSF 03.5 |
| 0409: BCF 06.5 |
| 040A: BCF 03.5 |
| 040B: BCF 06.5 |
| .................... line=S; |
| 040C: MOVLW 03 |
| 040D: MOVWF 68 |
| 040E: BCF 0A.3 |
| 040F: GOTO 610 (RETURN) |
| .................... } |
| .................... void objizdka() |
| .................... { |
| .................... BL;BR;Delay_ms(300); |
| * |
| 031B: BSF 03.5 |
| 031C: BCF 06.6 |
| 031D: BCF 03.5 |
| 031E: BCF 06.6 |
| 031F: BSF 03.5 |
| 0320: BCF 06.7 |
| 0321: BCF 03.5 |
| 0322: BSF 06.7 |
| 0323: BSF 03.5 |
| 0324: BCF 06.4 |
| 0325: BCF 03.5 |
| 0326: BCF 06.4 |
| 0327: BSF 03.5 |
| 0328: BCF 06.5 |
| 0329: BCF 03.5 |
| 032A: BSF 06.5 |
| 032B: MOVLW 02 |
| 032C: MOVWF 6E |
| 032D: MOVLW 96 |
| 032E: MOVWF 73 |
| 032F: CALL 04A |
| 0330: DECFSZ 6E,F |
| 0331: GOTO 32D |
| .................... STOPR;STOPL; |
| 0332: BSF 03.5 |
| 0333: BCF 06.4 |
| 0334: BCF 03.5 |
| 0335: BCF 06.4 |
| 0336: BSF 03.5 |
| 0337: BCF 06.5 |
| 0338: BCF 03.5 |
| 0339: BCF 06.5 |
| 033A: BSF 03.5 |
| 033B: BCF 06.6 |
| 033C: BCF 03.5 |
| 033D: BCF 06.6 |
| 033E: BSF 03.5 |
| 033F: BCF 06.7 |
| 0340: BCF 03.5 |
| 0341: BCF 06.7 |
| .................... beep(1000,1000); |
| 0342: MOVLW 03 |
| 0343: MOVWF 73 |
| 0344: MOVLW E8 |
| 0345: MOVWF 72 |
| 0346: MOVLW 03 |
| 0347: MOVWF 75 |
| 0348: MOVLW E8 |
| 0349: MOVWF 74 |
| 034A: CALL 024 |
| .................... Delay_ms(500); |
| 034B: MOVLW 02 |
| 034C: MOVWF 6E |
| 034D: MOVLW FA |
| 034E: MOVWF 73 |
| 034F: CALL 04A |
| 0350: DECFSZ 6E,F |
| 0351: GOTO 34D |
| .................... beep(1000,1000); |
| 0352: MOVLW 03 |
| 0353: MOVWF 73 |
| 0354: MOVLW E8 |
| 0355: MOVWF 72 |
| 0356: MOVLW 03 |
| 0357: MOVWF 75 |
| 0358: MOVLW E8 |
| 0359: MOVWF 74 |
| 035A: CALL 024 |
| .................... Delay_ms(1000); |
| 035B: MOVLW 04 |
| 035C: MOVWF 6E |
| 035D: MOVLW FA |
| 035E: MOVWF 73 |
| 035F: CALL 04A |
| 0360: DECFSZ 6E,F |
| 0361: GOTO 35D |
| 0362: BCF 0A.3 |
| 0363: GOTO 48A (RETURN) |
| .................... |
| .................... } |
| .................... void kalibrace() |
| .................... { |
| .................... unsigned int16 i; |
| .................... int min; |
| .................... int max; |
| .................... int current; |
| .................... int treshold; |
| .................... |
| .................... FL; BR; Delay_ms(130); |
| .................... chyba1: |
| .................... FR; BL; //kalibrace leveho cidla |
| .................... set_adc_channel(LSENSOR); |
| .................... Delay_us(20); |
| .................... min=max=read_adc(); |
| .................... for (i=1;i<=500;i++) |
| .................... { |
| .................... current=read_adc(); |
| .................... if (max < current) max=current; |
| .................... if (min > current) min=current; |
| .................... Delay_us(500); |
| .................... } |
| .................... FL; BR; |
| .................... for (i=1;i<=500;i++) |
| .................... { |
| .................... current=read_adc(); |
| .................... if (max < current) max=current; |
| .................... if (min > current) min=current; |
| .................... Delay_us(500); |
| .................... } |
| .................... STOPL; STOPR; Delay_ms(200); |
| .................... if((max-min)<50) {Beep(1000,300); GOTO chyba1;} |
| .................... treshold=(max-min)>>1; |
| .................... tresholdL=treshold+min; |
| .................... |
| .................... chyba2: |
| .................... FR; BL; |
| .................... set_adc_channel(RSENSOR); |
| .................... Delay_us(20); |
| .................... min=max=read_adc(); //naplneni min a max nejakou rozumnou hodnotou |
| .................... for (i=1;i<=500 ;i++) |
| .................... { |
| .................... current=read_adc(); |
| .................... if (max < current) max=current; //zmereni minima a maxima |
| .................... if (min > current) min=current; |
| .................... Delay_us(500); |
| .................... } |
| .................... FL; BR; |
| .................... for (i=1;i<=500 ;i++) |
| .................... { |
| .................... current=read_adc(); |
| .................... if (max < current) max=current; //zmereni minima a maxima |
| .................... if (min > current) min=current; |
| .................... Delay_us(500); |
| .................... } |
| .................... STOPL; STOPR; Delay_ms(200); |
| .................... if((max-min)<50) {Beep(1000,300); GOTO chyba2;} |
| .................... treshold=(max-min)>>1; |
| .................... tresholdR=treshold+min; |
| .................... |
| .................... FR; BL; |
| .................... movement=L; |
| .................... set_adc_channel(LSENSOR); |
| .................... Delay_us(20); |
| .................... while (tresholdL < read_adc()) Delay_us(100); |
| .................... FL; BR; Delay_ms(50); |
| .................... STOPL; STOPR; Delay_ms(500); |
| .................... Beep(780,200); |
| .................... } |
| .................... |
| .................... void main() |
| .................... { |
| .................... unsigned int16 rovne; // pocita delku rovne cary |
| * |
| 041D: CLRF 04 |
| 041E: MOVLW 1F |
| 041F: ANDWF 03,F |
| 0420: MOVLW 07 |
| 0421: BSF 03.5 |
| 0422: MOVWF 1F |
| 0423: MOVLW 82 |
| 0424: BCF 03.5 |
| 0425: MOVWF 25 |
| 0426: MOVLW 98 |
| 0427: MOVWF 26 |
| 0428: MOVWF 27 |
| 0429: MOVLW 40 |
| 042A: MOVWF 28 |
| 042B: MOVWF 29 |
| 042C: MOVWF 2A |
| 042D: MOVLW 60 |
| 042E: MOVWF 2B |
| 042F: MOVLW 86 |
| 0430: MOVWF 2C |
| 0431: MOVLW B4 |
| 0432: MOVWF 2D |
| 0433: MOVLW 60 |
| 0434: MOVWF 2E |
| 0435: MOVLW A4 |
| 0436: MOVWF 2F |
| 0437: MOVWF 30 |
| 0438: MOVWF 31 |
| 0439: MOVLW 61 |
| 043A: MOVWF 32 |
| 043B: MOVLW 03 |
| 043C: MOVWF 33 |
| 043D: MOVLW F0 |
| 043E: MOVWF 34 |
| 043F: MOVLW FF |
| 0440: MOVWF 3C |
| 0441: CLRF 6B |
| .................... |
| .................... STOPL; STOPR; |
| 0442: BSF 03.5 |
| 0443: BCF 06.6 |
| 0444: BCF 03.5 |
| 0445: BCF 06.6 |
| 0446: BSF 03.5 |
| 0447: BCF 06.7 |
| 0448: BCF 03.5 |
| 0449: BCF 06.7 |
| 044A: BSF 03.5 |
| 044B: BCF 06.4 |
| 044C: BCF 03.5 |
| 044D: BCF 06.4 |
| 044E: BSF 03.5 |
| 044F: BCF 06.5 |
| 0450: BCF 03.5 |
| 0451: BCF 06.5 |
| .................... |
| .................... setup_adc_ports(RA0_RA1_RA3_ANALOG); |
| 0452: MOVLW 04 |
| 0453: BSF 03.5 |
| 0454: MOVWF 1F |
| .................... setup_adc(ADC_CLOCK_DIV_2); |
| 0455: BCF 03.5 |
| 0456: MOVF 1F,W |
| 0457: ANDLW 38 |
| 0458: IORLW 01 |
| 0459: MOVWF 1F |
| .................... |
| .................... port_b_pullups(false); |
| 045A: BSF 03.5 |
| 045B: BSF 01.7 |
| .................... |
| .................... diagnostika(); |
| 045C: BCF 03.5 |
| 045D: GOTO 14A |
| .................... |
| .................... Beep(1000,200); //double beep |
| 045E: MOVLW 03 |
| 045F: MOVWF 73 |
| 0460: MOVLW E8 |
| 0461: MOVWF 72 |
| 0462: CLRF 75 |
| 0463: MOVLW C8 |
| 0464: MOVWF 74 |
| 0465: CALL 024 |
| .................... Delay_ms(50); |
| 0466: MOVLW 32 |
| 0467: MOVWF 73 |
| 0468: CALL 04A |
| .................... Beep(1000,200); |
| 0469: MOVLW 03 |
| 046A: MOVWF 73 |
| 046B: MOVLW E8 |
| 046C: MOVWF 72 |
| 046D: CLRF 75 |
| 046E: MOVLW C8 |
| 046F: MOVWF 74 |
| 0470: CALL 024 |
| .................... Delay_ms(1000); // 1s |
| 0471: MOVLW 04 |
| 0472: MOVWF 6E |
| 0473: MOVLW FA |
| 0474: MOVWF 73 |
| 0475: CALL 04A |
| 0476: DECFSZ 6E,F |
| 0477: GOTO 473 |
| .................... |
| .................... // kalibrace(); |
| .................... tresholdl=tresholdr=80; |
| 0478: MOVLW 50 |
| 0479: MOVWF 66 |
| 047A: MOVWF 65 |
| .................... // FL; FR; |
| .................... movement=S; |
| 047B: MOVLW 03 |
| 047C: MOVWF 67 |
| .................... line=S; |
| 047D: MOVWF 68 |
| .................... dira=0; |
| 047E: CLRF 6A |
| 047F: CLRF 69 |
| .................... rovne=0; |
| 0480: CLRF 6D |
| 0481: CLRF 6C |
| .................... |
| .................... while(true) |
| .................... { |
| .................... if(!input(BUMPER)) objizdka(); |
| 0482: BSF 3C.4 |
| 0483: MOVF 3C,W |
| 0484: BSF 03.5 |
| 0485: MOVWF 07 |
| 0486: BCF 03.5 |
| 0487: BTFSC 07.4 |
| 0488: GOTO 48A |
| 0489: GOTO 31B |
| .................... line=0; |
| 048A: CLRF 68 |
| .................... set_adc_channel(RSENSOR); // podivej se jestli neni cara pod pravym cidlem |
| 048B: MOVLW 08 |
| 048C: MOVWF 21 |
| 048D: MOVF 1F,W |
| 048E: ANDLW C7 |
| 048F: IORWF 21,W |
| 0490: MOVWF 1F |
| .................... Delay_us(10); |
| 0491: MOVLW 03 |
| 0492: MOVWF 20 |
| 0493: DECFSZ 20,F |
| 0494: GOTO 493 |
| .................... if(tresholdR > read_adc()) |
| 0495: BSF 1F.2 |
| 0496: BTFSC 1F.2 |
| 0497: GOTO 496 |
| 0498: MOVF 1E,W |
| 0499: SUBWF 66,W |
| 049A: BTFSC 03.2 |
| 049B: GOTO 4A2 |
| 049C: BTFSS 03.0 |
| 049D: GOTO 4A2 |
| .................... { |
| .................... dira=0; |
| 049E: CLRF 6A |
| 049F: CLRF 69 |
| .................... line=R; |
| 04A0: MOVLW 01 |
| 04A1: MOVWF 68 |
| .................... } |
| .................... set_adc_channel(LSENSOR); // kdyz cara nebyla pod pravym cidlem, mozna bude pod levym |
| 04A2: MOVLW 00 |
| 04A3: MOVWF 21 |
| 04A4: MOVF 1F,W |
| 04A5: ANDLW C7 |
| 04A6: IORWF 21,W |
| 04A7: MOVWF 1F |
| .................... Delay_us(10); |
| 04A8: MOVLW 03 |
| 04A9: MOVWF 20 |
| 04AA: DECFSZ 20,F |
| 04AB: GOTO 4AA |
| .................... if(tresholdL > read_adc()) |
| 04AC: BSF 1F.2 |
| 04AD: BTFSC 1F.2 |
| 04AE: GOTO 4AD |
| 04AF: MOVF 1E,W |
| 04B0: SUBWF 65,W |
| 04B1: BTFSC 03.2 |
| 04B2: GOTO 4B8 |
| 04B3: BTFSS 03.0 |
| 04B4: GOTO 4B8 |
| .................... { |
| .................... dira=0; |
| 04B5: CLRF 6A |
| 04B6: CLRF 69 |
| .................... line=line | L; |
| 04B7: BSF 68.1 |
| .................... } |
| .................... |
| .................... switch(line) |
| 04B8: MOVF 68,W |
| 04B9: MOVWF 20 |
| 04BA: MOVLW 03 |
| 04BB: SUBWF 20,W |
| 04BC: BTFSC 03.2 |
| 04BD: GOTO 4C7 |
| 04BE: MOVLW 02 |
| 04BF: SUBWF 20,W |
| 04C0: BTFSC 03.2 |
| 04C1: GOTO 4DA |
| 04C2: MOVLW 01 |
| 04C3: SUBWF 20,W |
| 04C4: BTFSC 03.2 |
| 04C5: GOTO 4ED |
| 04C6: GOTO 500 |
| .................... { |
| .................... case S: |
| .................... FR;FL; |
| 04C7: BSF 03.5 |
| 04C8: BCF 06.5 |
| 04C9: BCF 03.5 |
| 04CA: BCF 06.5 |
| 04CB: BSF 03.5 |
| 04CC: BCF 06.4 |
| 04CD: BCF 03.5 |
| 04CE: BSF 06.4 |
| 04CF: BSF 03.5 |
| 04D0: BCF 06.7 |
| 04D1: BCF 03.5 |
| 04D2: BCF 06.7 |
| 04D3: BSF 03.5 |
| 04D4: BCF 06.6 |
| 04D5: BCF 03.5 |
| 04D6: BSF 06.6 |
| .................... movement=S; |
| 04D7: MOVLW 03 |
| 04D8: MOVWF 67 |
| .................... continue; |
| 04D9: GOTO 482 |
| .................... case L: |
| .................... STOPL; |
| 04DA: BSF 03.5 |
| 04DB: BCF 06.6 |
| 04DC: BCF 03.5 |
| 04DD: BCF 06.6 |
| 04DE: BSF 03.5 |
| 04DF: BCF 06.7 |
| 04E0: BCF 03.5 |
| 04E1: BCF 06.7 |
| .................... FR;movement=L; |
| 04E2: BSF 03.5 |
| 04E3: BCF 06.5 |
| 04E4: BCF 03.5 |
| 04E5: BCF 06.5 |
| 04E6: BSF 03.5 |
| 04E7: BCF 06.4 |
| 04E8: BCF 03.5 |
| 04E9: BSF 06.4 |
| 04EA: MOVLW 02 |
| 04EB: MOVWF 67 |
| .................... continue; |
| 04EC: GOTO 482 |
| .................... case R: |
| .................... STOPR; |
| 04ED: BSF 03.5 |
| 04EE: BCF 06.4 |
| 04EF: BCF 03.5 |
| 04F0: BCF 06.4 |
| 04F1: BSF 03.5 |
| 04F2: BCF 06.5 |
| 04F3: BCF 03.5 |
| 04F4: BCF 06.5 |
| .................... FL;movement=R; |
| 04F5: BSF 03.5 |
| 04F6: BCF 06.7 |
| 04F7: BCF 03.5 |
| 04F8: BCF 06.7 |
| 04F9: BSF 03.5 |
| 04FA: BCF 06.6 |
| 04FB: BCF 03.5 |
| 04FC: BSF 06.6 |
| 04FD: MOVLW 01 |
| 04FE: MOVWF 67 |
| .................... continue; |
| 04FF: GOTO 482 |
| .................... default: |
| .................... } |
| .................... |
| .................... if (dira==ODEZVA) // kdyz uz chvili jedeme po bile plose |
| 0500: DECFSZ 69,W |
| 0501: GOTO 54A |
| 0502: MOVF 6A,F |
| 0503: BTFSS 03.2 |
| 0504: GOTO 54A |
| .................... { |
| .................... //BR;BL;Delay_us(rovne >>= 5); |
| .................... rovne=0; //kdyz sme museli zatocit, uz neni rovna cara |
| 0505: CLRF 6D |
| 0506: CLRF 6C |
| .................... |
| .................... switch (line) // musime zatocit |
| 0507: MOVLW 01 |
| 0508: SUBWF 68,W |
| 0509: ADDLW FE |
| 050A: BTFSC 03.0 |
| 050B: GOTO 54A |
| 050C: ADDLW 02 |
| 050D: GOTO 617 |
| .................... { |
| .................... case L: |
| .................... BL;Delay_ms(BRZDENI);STOPL; |
| 050E: BSF 03.5 |
| 050F: BCF 06.6 |
| 0510: BCF 03.5 |
| 0511: BCF 06.6 |
| 0512: BSF 03.5 |
| 0513: BCF 06.7 |
| 0514: BCF 03.5 |
| 0515: BSF 06.7 |
| 0516: MOVLW 64 |
| 0517: MOVWF 73 |
| 0518: CALL 04A |
| 0519: BSF 03.5 |
| 051A: BCF 06.6 |
| 051B: BCF 03.5 |
| 051C: BCF 06.6 |
| 051D: BSF 03.5 |
| 051E: BCF 06.7 |
| 051F: BCF 03.5 |
| 0520: BCF 06.7 |
| .................... FR; |
| 0521: BSF 03.5 |
| 0522: BCF 06.5 |
| 0523: BCF 03.5 |
| 0524: BCF 06.5 |
| 0525: BSF 03.5 |
| 0526: BCF 06.4 |
| 0527: BCF 03.5 |
| 0528: BSF 06.4 |
| .................... movement=L; |
| 0529: MOVLW 02 |
| 052A: MOVWF 67 |
| .................... break; |
| 052B: GOTO 54A |
| .................... case R: |
| .................... BR;Delay_ms(BRZDENI);STOPR; |
| 052C: BSF 03.5 |
| 052D: BCF 06.4 |
| 052E: BCF 03.5 |
| 052F: BCF 06.4 |
| 0530: BSF 03.5 |
| 0531: BCF 06.5 |
| 0532: BCF 03.5 |
| 0533: BSF 06.5 |
| 0534: MOVLW 64 |
| 0535: MOVWF 73 |
| 0536: CALL 04A |
| 0537: BSF 03.5 |
| 0538: BCF 06.4 |
| 0539: BCF 03.5 |
| 053A: BCF 06.4 |
| 053B: BSF 03.5 |
| 053C: BCF 06.5 |
| 053D: BCF 03.5 |
| 053E: BCF 06.5 |
| .................... FL; |
| 053F: BSF 03.5 |
| 0540: BCF 06.7 |
| 0541: BCF 03.5 |
| 0542: BCF 06.7 |
| 0543: BSF 03.5 |
| 0544: BCF 06.6 |
| 0545: BCF 03.5 |
| 0546: BSF 06.6 |
| .................... movement=R; |
| 0547: MOVLW 01 |
| 0548: MOVWF 67 |
| .................... break; |
| 0549: GOTO 54A |
| .................... } |
| * |
| 0617: BCF 0A.0 |
| 0618: BSF 0A.1 |
| 0619: BSF 0A.2 |
| 061A: ADDWF 02,F |
| 061B: GOTO 52C |
| 061C: GOTO 50E |
| .................... } |
| .................... if (dira==MEZERA) // kdyz zkoncila cara |
| * |
| 054A: MOVF 69,W |
| 054B: SUBLW 18 |
| 054C: BTFSS 03.2 |
| 054D: GOTO 612 |
| 054E: MOVF 6A,W |
| 054F: SUBLW 15 |
| 0550: BTFSS 03.2 |
| 0551: GOTO 612 |
| .................... { |
| .................... beep(800,500); |
| 0552: MOVLW 03 |
| 0553: MOVWF 73 |
| 0554: MOVLW 20 |
| 0555: MOVWF 72 |
| 0556: MOVLW 01 |
| 0557: MOVWF 75 |
| 0558: MOVLW F4 |
| 0559: MOVWF 74 |
| 055A: CALL 024 |
| .................... Delay_ms(50); |
| 055B: MOVLW 32 |
| 055C: MOVWF 73 |
| 055D: CALL 04A |
| .................... beep(800,500); |
| 055E: MOVLW 03 |
| 055F: MOVWF 73 |
| 0560: MOVLW 20 |
| 0561: MOVWF 72 |
| 0562: MOVLW 01 |
| 0563: MOVWF 75 |
| 0564: MOVLW F4 |
| 0565: MOVWF 74 |
| 0566: CALL 024 |
| .................... switch (movement) //vrat se zpet na caru |
| 0567: MOVLW 01 |
| 0568: SUBWF 67,W |
| 0569: ADDLW FD |
| 056A: BTFSC 03.0 |
| 056B: GOTO 5E6 |
| 056C: ADDLW 03 |
| 056D: GOTO 61D |
| .................... { |
| .................... case L: |
| .................... STOPL;STOPR; |
| 056E: BSF 03.5 |
| 056F: BCF 06.6 |
| 0570: BCF 03.5 |
| 0571: BCF 06.6 |
| 0572: BSF 03.5 |
| 0573: BCF 06.7 |
| 0574: BCF 03.5 |
| 0575: BCF 06.7 |
| 0576: BSF 03.5 |
| 0577: BCF 06.4 |
| 0578: BCF 03.5 |
| 0579: BCF 06.4 |
| 057A: BSF 03.5 |
| 057B: BCF 06.5 |
| 057C: BCF 03.5 |
| 057D: BCF 06.5 |
| .................... BR;Delay_ms(COUVANI);STOPR; |
| 057E: BSF 03.5 |
| 057F: BCF 06.4 |
| 0580: BCF 03.5 |
| 0581: BCF 06.4 |
| 0582: BSF 03.5 |
| 0583: BCF 06.5 |
| 0584: BCF 03.5 |
| 0585: BSF 06.5 |
| 0586: MOVLW 08 |
| 0587: MOVWF 6E |
| 0588: MOVLW C8 |
| 0589: MOVWF 73 |
| 058A: CALL 04A |
| 058B: DECFSZ 6E,F |
| 058C: GOTO 588 |
| 058D: BSF 03.5 |
| 058E: BCF 06.4 |
| 058F: BCF 03.5 |
| 0590: BCF 06.4 |
| 0591: BSF 03.5 |
| 0592: BCF 06.5 |
| 0593: BCF 03.5 |
| 0594: BCF 06.5 |
| .................... break; |
| 0595: GOTO 5E6 |
| .................... case R: |
| .................... STOPL;STOPR; |
| 0596: BSF 03.5 |
| 0597: BCF 06.6 |
| 0598: BCF 03.5 |
| 0599: BCF 06.6 |
| 059A: BSF 03.5 |
| 059B: BCF 06.7 |
| 059C: BCF 03.5 |
| 059D: BCF 06.7 |
| 059E: BSF 03.5 |
| 059F: BCF 06.4 |
| 05A0: BCF 03.5 |
| 05A1: BCF 06.4 |
| 05A2: BSF 03.5 |
| 05A3: BCF 06.5 |
| 05A4: BCF 03.5 |
| 05A5: BCF 06.5 |
| .................... BL;Delay_ms(COUVANI);STOPL; |
| 05A6: BSF 03.5 |
| 05A7: BCF 06.6 |
| 05A8: BCF 03.5 |
| 05A9: BCF 06.6 |
| 05AA: BSF 03.5 |
| 05AB: BCF 06.7 |
| 05AC: BCF 03.5 |
| 05AD: BSF 06.7 |
| 05AE: MOVLW 08 |
| 05AF: MOVWF 6E |
| 05B0: MOVLW C8 |
| 05B1: MOVWF 73 |
| 05B2: CALL 04A |
| 05B3: DECFSZ 6E,F |
| 05B4: GOTO 5B0 |
| 05B5: BSF 03.5 |
| 05B6: BCF 06.6 |
| 05B7: BCF 03.5 |
| 05B8: BCF 06.6 |
| 05B9: BSF 03.5 |
| 05BA: BCF 06.7 |
| 05BB: BCF 03.5 |
| 05BC: BCF 06.7 |
| .................... break; |
| 05BD: GOTO 5E6 |
| .................... case S: |
| .................... BL; BR; Delay_ms(COUVANI); |
| 05BE: BSF 03.5 |
| 05BF: BCF 06.6 |
| 05C0: BCF 03.5 |
| 05C1: BCF 06.6 |
| 05C2: BSF 03.5 |
| 05C3: BCF 06.7 |
| 05C4: BCF 03.5 |
| 05C5: BSF 06.7 |
| 05C6: BSF 03.5 |
| 05C7: BCF 06.4 |
| 05C8: BCF 03.5 |
| 05C9: BCF 06.4 |
| 05CA: BSF 03.5 |
| 05CB: BCF 06.5 |
| 05CC: BCF 03.5 |
| 05CD: BSF 06.5 |
| 05CE: MOVLW 08 |
| 05CF: MOVWF 6E |
| 05D0: MOVLW C8 |
| 05D1: MOVWF 73 |
| 05D2: CALL 04A |
| 05D3: DECFSZ 6E,F |
| 05D4: GOTO 5D0 |
| .................... STOPL; STOPR; |
| 05D5: BSF 03.5 |
| 05D6: BCF 06.6 |
| 05D7: BCF 03.5 |
| 05D8: BCF 06.6 |
| 05D9: BSF 03.5 |
| 05DA: BCF 06.7 |
| 05DB: BCF 03.5 |
| 05DC: BCF 06.7 |
| 05DD: BSF 03.5 |
| 05DE: BCF 06.4 |
| 05DF: BCF 03.5 |
| 05E0: BCF 06.4 |
| 05E1: BSF 03.5 |
| 05E2: BCF 06.5 |
| 05E3: BCF 03.5 |
| 05E4: BCF 06.5 |
| .................... break; |
| 05E5: GOTO 5E6 |
| .................... } |
| * |
| 061D: BCF 0A.0 |
| 061E: BSF 0A.1 |
| 061F: BSF 0A.2 |
| 0620: ADDWF 02,F |
| 0621: GOTO 596 |
| 0622: GOTO 56E |
| 0623: GOTO 5BE |
| .................... |
| .................... FR;FL; Delay_ms(PRES_DIRU); // popojedem dopredu mozna tam bude cara |
| * |
| 05E6: BSF 03.5 |
| 05E7: BCF 06.5 |
| 05E8: BCF 03.5 |
| 05E9: BCF 06.5 |
| 05EA: BSF 03.5 |
| 05EB: BCF 06.4 |
| 05EC: BCF 03.5 |
| 05ED: BSF 06.4 |
| 05EE: BSF 03.5 |
| 05EF: BCF 06.7 |
| 05F0: BCF 03.5 |
| 05F1: BCF 06.7 |
| 05F2: BSF 03.5 |
| 05F3: BCF 06.6 |
| 05F4: BCF 03.5 |
| 05F5: BSF 06.6 |
| 05F6: MOVLW 02 |
| 05F7: MOVWF 6E |
| 05F8: MOVLW C8 |
| 05F9: MOVWF 73 |
| 05FA: CALL 04A |
| 05FB: DECFSZ 6E,F |
| 05FC: GOTO 5F8 |
| .................... STOPL; STOPR; movement=S; |
| 05FD: BSF 03.5 |
| 05FE: BCF 06.6 |
| 05FF: BCF 03.5 |
| 0600: BCF 06.6 |
| 0601: BSF 03.5 |
| 0602: BCF 06.7 |
| 0603: BCF 03.5 |
| 0604: BCF 06.7 |
| 0605: BSF 03.5 |
| 0606: BCF 06.4 |
| 0607: BCF 03.5 |
| 0608: BCF 06.4 |
| 0609: BSF 03.5 |
| 060A: BCF 06.5 |
| 060B: BCF 03.5 |
| 060C: BCF 06.5 |
| 060D: MOVLW 03 |
| 060E: MOVWF 67 |
| .................... cikcak(); // najdi caru |
| 060F: GOTO 364 |
| .................... dira=0; |
| 0610: CLRF 6A |
| 0611: CLRF 69 |
| .................... } |
| .................... dira++; |
| 0612: INCF 69,F |
| 0613: BTFSC 03.2 |
| 0614: INCF 6A,F |
| .................... } // while(true) |
| 0615: GOTO 482 |
| .................... } |
| .................... |
| 0616: SLEEP |
| /roboti/merkur/PIC16F873/main.SYM |
|---|
| 0,0 → 1,89 |
| 003 STATUS |
| 015-016 CCP_1 |
| 015 CCP_1_LOW |
| 016 CCP_1_HIGH |
| 01B-01C CCP_2 |
| 01B CCP_2_LOW |
| 01C CCP_2_HIGH |
| 020 @SCRATCH |
| 021 @SCRATCH |
| 021 _RETURN_ |
| 022 @SCRATCH |
| 023 @SCRATCH |
| 024 @SCRATCH |
| 025-034 SendData |
| 035.0 bit |
| 036 fcslo |
| 037 fcshi |
| 038 stuff |
| 039 flag_flag |
| 03A fcs_flag |
| 03B i |
| 03C @TRIS_C |
| 03D-064 AXstring |
| 065 tresholdL |
| 066 tresholdR |
| 067 movement |
| 068 line |
| 069-06A dira |
| 06B @sprintf_string |
| 06C-06D main.rovne |
| 06E-06F diagnostika.n |
| 06E cikcak.n |
| 06E objizdka.@SCRATCH |
| 06E main.@SCRATCH |
| 070 ls |
| 071 rs |
| 072 SendPacket.data |
| 072-073 beep.period |
| 072 diagnostika.@SCRATCH |
| 073 delay_ms.P1 |
| 073 @PRINTF_U_290.P2 |
| 073 SendPacket.@SCRATCH |
| 074 SendByte.inbyte |
| 074-075 beep.length |
| 074 @PRINTF_U_290.P1 |
| 075 SendByte.k |
| 075 @SPRINTF.P1 |
| 075 @DIV88.P2 |
| 076 SendByte.bt |
| 076-077 beep.nn |
| 076 @DIV88.P1 |
| 077 fcsbit.tbyte |
| 077 SendByte.@SCRATCH |
| 077 @DIV88.@SCRATCH |
| 078 delay_us.P1 |
| 078 fcsbit.@SCRATCH |
| 079 fcsbit.@SCRATCH |
| -000 kalibrace.i |
| kalibrace.min |
| kalibrace.max |
| kalibrace.current |
| kalibrace.treshold |
| 004A delay_ms |
| 0016 delay_us |
| 00AE flipout |
| 00B5 SendBit |
| 00FF SendByte |
| 0024 beep |
| 014A diagnostika |
| 0004 @const10170 |
| 005F @SPRINTF |
| 0067 @DIV88 |
| 007C @PRINTF_U_290 |
| 0364 cikcak |
| 0410 @goto10199 |
| 0417 @goto10214 |
| 031B objizdka |
| 041D main |
| 0617 @goto10341 |
| 061D @goto10355 |
| 0135 chyba1 |
| 0135 chyba2 |
| Project Files: |
| d:\kaklik\programy\pic_c\roboti\merkur\main.c |
| d:\kaklik\programy\pic_c\roboti\merkur\main.h |
| C:\Program Files\PICC\devices\16F873.h |
| C:\library\kaklik\CCS\AX25.c |
| /roboti/merkur/PIC16F873/main.c |
|---|
| 0,0 → 1,332 |
| #include "main.h" |
| #define TXo PIN_C3 // To the transmitter modulator |
| #include "AX25.c" // podprogram pro prenos telemetrie |
| //motory //Napred vypnout potom zapnout! |
| #define FR output_low(PIN_B5); output_high(PIN_B4) // Vpred |
| #define FL output_low(PIN_B7); output_high(PIN_B6) |
| #define BR output_low(PIN_B4); output_high(PIN_B5) // Vzad |
| #define BL output_low(PIN_B6); output_high(PIN_B7) |
| #define STOPR output_low(PIN_B4);output_low(PIN_B5) |
| #define STOPL output_low(PIN_B6);output_low(PIN_B7) |
| #define L 0b10 // left |
| #define R 0b01 // right |
| #define S 0b11 // straight |
| #define COUVANI 1600 // couvnuti po zjisteni diry |
| #define MEZERA 5400 // za jak dlouho bude ztracena cara |
| #define PRES_DIRU 400 // velikost mezery v care |
| #define ODEZVA 1 // za jak dlouho po opusteni cary se ma zacit zatacet |
| #define BRZDENI 100 // doba (v ms) ptrebna k zastaveni jednoho motoru |
| //cidla |
| #define RSENSOR 1 // Senzory na caru |
| #define LSENSOR 0 |
| #define BUMPER PIN_C4 // sensor na cihlu |
| #define DIAG_SERVO PIN_B0 // Propojka pro diagnosticky mod |
| #define DIAG_SENSORS PIN_B1 // Propojka pro diagnosticky mod |
| #DEFINE SOUND_HI PIN_B3 |
| #DEFINE SOUND_LO PIN_B2 |
| char AXstring[40]; // Buffer pro prenos telemetrie |
| int tresholdL; // rozhodovaci uroven pro prave cidlo |
| int tresholdR; // rozhodovaci uroven pro prave cidlo |
| int movement; // smer minuleho pohybu |
| int line; // na ktere strane byla detekovana cara |
| unsigned int16 dira; // pocitadlo pro nalezeni preruseni cary |
| // Primitivni Pipani |
| void beep(unsigned int16 period, unsigned int16 length) |
| { |
| unsigned int16 nn; |
| for(nn=length; nn>0; nn--) |
| { |
| output_high(SOUND_HI);output_low(SOUND_LO); |
| delay_us(period); |
| output_high(SOUND_LO);output_low(SOUND_HI); |
| delay_us(period); |
| } |
| } |
| // Diagnostika pohonu, hejbne vsema motorama ve vsech smerech |
| void diagnostika() |
| { |
| unsigned int16 n; |
| while (input(DIAG_SERVO)) // Propojka, ktera spousti diagnostiku |
| { |
| for (n=500; n<800; n+=100) |
| { |
| beep(n,n); //beep UP |
| }; |
| Delay_ms(1000); |
| //zastav vse |
| STOPL; STOPR; |
| //pravy pas |
| FR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| BR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //levy pas |
| FL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| BL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //oba pasy |
| FL; FR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| BL; BR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| }; |
| while (input(DIAG_SENSORS)) |
| { |
| int ls, rs; |
| while(!input(BUMPER)){beep(1100,100); Delay_ms(50);} |
| set_adc_channel(RSENSOR); |
| Delay_us(20); |
| rs=read_adc(); |
| set_adc_channel(LSENSOR); |
| Delay_us(20); |
| ls=read_adc(); |
| sprintf(AXstring,"L: %U R: %U\0", ls, rs); // Convert DATA to String. |
| SendPacket(&AXstring[0]); |
| delay_ms(1000); |
| }; |
| } |
| void cikcak() |
| { |
| int n; |
| switch(movement) // podivej se na jednu stranu |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| case S: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| set_adc_channel(LSENSOR); |
| Delay_us(10); |
| while (tresholdL < read_adc()) // je tam cara? |
| { |
| if (n==50) // asi bude na druhe strane |
| { |
| STOPR;STOPL; |
| n=0; |
| switch(movement) |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| } |
| Delay_ms(5); |
| n++; |
| } |
| STOPL;STOPR; // nasli jsme caru |
| line=S; |
| } |
| void objizdka() |
| { |
| BL;BR;Delay_ms(300); |
| STOPR;STOPL; |
| beep(1000,1000); |
| Delay_ms(500); |
| beep(1000,1000); |
| Delay_ms(1000); |
| } |
| void kalibrace() |
| { |
| unsigned int16 i; |
| int min; |
| int max; |
| int current; |
| int treshold; |
| FL; BR; Delay_ms(130); |
| chyba1: |
| FR; BL; //kalibrace leveho cidla |
| set_adc_channel(LSENSOR); |
| Delay_us(20); |
| min=max=read_adc(); |
| for (i=1;i<=500;i++) |
| { |
| current=read_adc(); |
| if (max < current) max=current; |
| if (min > current) min=current; |
| Delay_us(500); |
| } |
| FL; BR; |
| for (i=1;i<=500;i++) |
| { |
| current=read_adc(); |
| if (max < current) max=current; |
| if (min > current) min=current; |
| Delay_us(500); |
| } |
| STOPL; STOPR; Delay_ms(200); |
| if((max-min)<50) {Beep(1000,300); GOTO chyba1;} |
| treshold=(max-min)>>1; |
| tresholdL=treshold+min; |
| chyba2: |
| FR; BL; |
| set_adc_channel(RSENSOR); |
| Delay_us(20); |
| min=max=read_adc(); //naplneni min a max nejakou rozumnou hodnotou |
| for (i=1;i<=500 ;i++) |
| { |
| current=read_adc(); |
| if (max < current) max=current; //zmereni minima a maxima |
| if (min > current) min=current; |
| Delay_us(500); |
| } |
| FL; BR; |
| for (i=1;i<=500 ;i++) |
| { |
| current=read_adc(); |
| if (max < current) max=current; //zmereni minima a maxima |
| if (min > current) min=current; |
| Delay_us(500); |
| } |
| STOPL; STOPR; Delay_ms(200); |
| if((max-min)<50) {Beep(1000,300); GOTO chyba2;} |
| treshold=(max-min)>>1; |
| tresholdR=treshold+min; |
| FR; BL; |
| movement=L; |
| set_adc_channel(LSENSOR); |
| Delay_us(20); |
| while (tresholdL < read_adc()) Delay_us(100); |
| FL; BR; Delay_ms(50); |
| STOPL; STOPR; Delay_ms(500); |
| Beep(780,200); |
| } |
| void main() |
| { |
| unsigned int16 rovne; // pocita delku rovne cary |
| STOPL; STOPR; |
| setup_adc_ports(RA0_RA1_RA3_ANALOG); |
| setup_adc(ADC_CLOCK_DIV_2); |
| port_b_pullups(false); |
| diagnostika(); |
| Beep(1000,200); //double beep |
| Delay_ms(50); |
| Beep(1000,200); |
| Delay_ms(1000); // 1s |
| // kalibrace(); |
| tresholdl=tresholdr=80; |
| // FL; FR; |
| movement=S; |
| line=S; |
| dira=0; |
| rovne=0; |
| while(true) |
| { |
| if(!input(BUMPER)) objizdka(); |
| line=0; |
| set_adc_channel(RSENSOR); // podivej se jestli neni cara pod pravym cidlem |
| Delay_us(10); |
| if(tresholdR > read_adc()) |
| { |
| dira=0; |
| line=R; |
| } |
| set_adc_channel(LSENSOR); // kdyz cara nebyla pod pravym cidlem, mozna bude pod levym |
| Delay_us(10); |
| if(tresholdL > read_adc()) |
| { |
| dira=0; |
| line=line | L; |
| } |
| switch(line) |
| { |
| case S: |
| FR;FL; |
| movement=S; |
| continue; |
| case L: |
| STOPL; |
| FR;movement=L; |
| continue; |
| case R: |
| STOPR; |
| FL;movement=R; |
| continue; |
| default: |
| } |
| if (dira==ODEZVA) // kdyz uz chvili jedeme po bile plose |
| { |
| //BR;BL;Delay_us(rovne >>= 5); |
| rovne=0; //kdyz sme museli zatocit, uz neni rovna cara |
| switch (line) // musime zatocit |
| { |
| case L: |
| BL;Delay_ms(BRZDENI);STOPL; |
| FR; |
| movement=L; |
| break; |
| case R: |
| BR;Delay_ms(BRZDENI);STOPR; |
| FL; |
| movement=R; |
| break; |
| } |
| } |
| if (dira==MEZERA) // kdyz zkoncila cara |
| { |
| beep(800,500); |
| Delay_ms(50); |
| beep(800,500); |
| switch (movement) //vrat se zpet na caru |
| { |
| case L: |
| STOPL;STOPR; |
| BR;Delay_ms(COUVANI);STOPR; |
| break; |
| case R: |
| STOPL;STOPR; |
| BL;Delay_ms(COUVANI);STOPL; |
| break; |
| case S: |
| BL; BR; Delay_ms(COUVANI); |
| STOPL; STOPR; |
| break; |
| } |
| FR;FL; Delay_ms(PRES_DIRU); // popojedem dopredu mozna tam bude cara |
| STOPL; STOPR; movement=S; |
| cikcak(); // najdi caru |
| dira=0; |
| } |
| dira++; |
| } // while(true) |
| } |
| /roboti/merkur/PIC16F873/main.cod |
|---|
| Cannot display: file marked as a binary type. |
| svn:mime-type = application/octet-stream |
| Property changes: |
| Added: svn:mime-type |
| +application/octet-stream |
| \ No newline at end of property |
| /roboti/merkur/PIC16F873/main.err |
|---|
| 0,0 → 1,0 |
| No Errors |
| /roboti/merkur/PIC16F873/main.h |
|---|
| 0,0 → 1,5 |
| #include <16F873.h> |
| #device adc=8 |
| #use delay(clock=4000000) |
| #fuses XT,NOWDT,NOLVP |
| /roboti/merkur/PIC16F873/main.pjt |
|---|
| 0,0 → 1,40 |
| [PROJECT] |
| Target=main.HEX |
| Development_Mode= |
| Processor=0x873F |
| ToolSuite=CCS |
| [Directories] |
| Include=C:\Program Files\PICC\devices\;C:\Program Files\PICC\drivers\;C:\library\CCS; |
| Library= |
| LinkerScript= |
| [Target Data] |
| FileList=main.c; |
| BuildTool=C-COMPILER |
| OptionString=+FM |
| AdditionalOptionString= |
| BuildRequired=1 |
| [main.c] |
| Type=4 |
| Path= |
| FileList= |
| BuildTool= |
| OptionString= |
| AdditionalOptionString= |
| [mru-list] |
| 1=main.c |
| [Windows] |
| 0=0000 main.c 0 0 796 451 3 0 |
| [Opened Files] |
| 1=D:\KAKL\PIC\Tank\main.c |
| 2=D:\KAKL\PIC\Tank\main.h |
| 3=D:\KAKL\PIC\Tank\AX25.c |
| 4=C:\Program Files\PICC\devices\16F88.h |
| 5= |
| 6= |
| 7= |
| /roboti/merkur/PIC16F873/main.sta |
|---|
| 0,0 → 1,46 |
| ROM used: 1572 (38%) |
| 2048 (50%) including unused fragments |
| 2 Average locations per line |
| 4 Average locations per statement |
| RAM used: 79 (41%) at main() level |
| 90 (47%) worst case |
| Lines Stmts % Files |
| ----- ----- --- ----- |
| 333 374 85 d:\kaklik\programy\pic_c\roboti\merkur\main.c |
| 6 0 0 d:\kaklik\programy\pic_c\roboti\merkur\main.h |
| 225 0 0 C:\Program Files\PICC\devices\16F873.h |
| 136 67 8 C:\library\kaklik\CCS\AX25.c |
| ----- ----- |
| 1400 882 Total |
| Page ROM % RAM Functions: |
| ---- --- --- --- ---------- |
| 0 21 1 1 delay_ms |
| 0 14 1 1 delay_us |
| 0 7 0 0 flipout |
| 0 74 5 0 SendBit |
| 0 75 5 4 SendByte |
| 0 38 2 6 beep |
| 0 465 30 3 diagnostika |
| 0 18 1 0 @const10170 |
| 0 8 1 1 @SPRINTF |
| 0 21 1 3 @DIV88 |
| 0 50 3 2 @PRINTF_U_290 |
| 0 172 11 1 cikcak |
| 0 7 0 0 @goto10199 |
| 0 6 0 0 @goto10214 |
| 0 73 5 1 objizdka |
| 0 506 32 3 main |
| 0 6 0 0 @goto10341 |
| 0 7 0 0 @goto10355 |
| Segment Used Free |
| --------- ---- ---- |
| 0000-0003 4 0 |
| 0004-07FF 1568 476 |
| 0800-0FFF 0 2048 |
| /roboti/merkur/PIC16F873/main.tre |
|---|
| 0,0 → 1,124 |
| ÀÄmain |
| ÀÄmain 0/506 Ram=3 |
| ÃÄ??0?? |
| ÃÄdiagnostika 0/465 Ram=3 |
| ³ ÃÄbeep 0/38 Ram=6 |
| ³ ³ ÃÄdelay_us 0/14 Ram=1 |
| ³ ³ ÀÄdelay_us 0/14 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄbeep 0/38 Ram=6 |
| ³ ³ ÃÄdelay_us 0/14 Ram=1 |
| ³ ³ ÀÄdelay_us 0/14 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄbeep 0/38 Ram=6 |
| ³ ³ ÃÄdelay_us 0/14 Ram=1 |
| ³ ³ ÀÄdelay_us 0/14 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄbeep 0/38 Ram=6 |
| ³ ³ ÃÄdelay_us 0/14 Ram=1 |
| ³ ³ ÀÄdelay_us 0/14 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄ@SPRINTF 0/8 Ram=1 |
| ³ ÃÄ@SPRINTF 0/8 Ram=1 |
| ³ ÃÄ@SPRINTF 0/8 Ram=1 |
| ³ ÃÄ@PRINTF_U_290 0/50 Ram=2 |
| ³ ³ ÃÄ@DIV88 0/21 Ram=3 |
| ³ ³ ÃÄ@SPRINTF 0/8 Ram=1 |
| ³ ³ ÃÄ@DIV88 0/21 Ram=3 |
| ³ ³ ÃÄ@SPRINTF 0/8 Ram=1 |
| ³ ³ ÀÄ@SPRINTF 0/8 Ram=1 |
| ³ ÃÄ@const10170 0/18 Ram=0 |
| ³ ÃÄ@SPRINTF 0/8 Ram=1 |
| ³ ÃÄ@PRINTF_U_290 0/50 Ram=2 |
| ³ ³ ÃÄ@DIV88 0/21 Ram=3 |
| ³ ³ ÃÄ@SPRINTF 0/8 Ram=1 |
| ³ ³ ÃÄ@DIV88 0/21 Ram=3 |
| ³ ³ ÃÄ@SPRINTF 0/8 Ram=1 |
| ³ ³ ÀÄ@SPRINTF 0/8 Ram=1 |
| ³ ÃÄSendPacket (Inline) Ram=2 |
| ³ ³ ÃÄSendByte 0/75 Ram=4 |
| ³ ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÃÄSendBit 0/74 Ram=0 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÀÄSendBit 0/74 Ram=0 |
| ³ ³ ÃÄSendByte 0/75 Ram=4 |
| ³ ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÃÄSendBit 0/74 Ram=0 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÀÄSendBit 0/74 Ram=0 |
| ³ ³ ÃÄSendByte 0/75 Ram=4 |
| ³ ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÃÄSendBit 0/74 Ram=0 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÀÄSendBit 0/74 Ram=0 |
| ³ ³ ÃÄSendByte 0/75 Ram=4 |
| ³ ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÃÄSendBit 0/74 Ram=0 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÀÄSendBit 0/74 Ram=0 |
| ³ ³ ÃÄSendByte 0/75 Ram=4 |
| ³ ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÃÄSendBit 0/74 Ram=0 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÀÄSendBit 0/74 Ram=0 |
| ³ ³ ÀÄSendByte 0/75 Ram=4 |
| ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ÃÄSendBit 0/74 Ram=0 |
| ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ÀÄSendBit 0/74 Ram=0 |
| ³ ÀÄdelay_ms 0/21 Ram=1 |
| ÃÄbeep 0/38 Ram=6 |
| ³ ÃÄdelay_us 0/14 Ram=1 |
| ³ ÀÄdelay_us 0/14 Ram=1 |
| ÃÄdelay_ms 0/21 Ram=1 |
| ÃÄbeep 0/38 Ram=6 |
| ³ ÃÄdelay_us 0/14 Ram=1 |
| ³ ÀÄdelay_us 0/14 Ram=1 |
| ÃÄdelay_ms 0/21 Ram=1 |
| ÃÄobjizdka 0/73 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄbeep 0/38 Ram=6 |
| ³ ³ ÃÄdelay_us 0/14 Ram=1 |
| ³ ³ ÀÄdelay_us 0/14 Ram=1 |
| ³ ÃÄdelay_ms 0/21 Ram=1 |
| ³ ÃÄbeep 0/38 Ram=6 |
| ³ ³ ÃÄdelay_us 0/14 Ram=1 |
| ³ ³ ÀÄdelay_us 0/14 Ram=1 |
| ³ ÀÄdelay_ms 0/21 Ram=1 |
| ÃÄ@goto10341 0/6 Ram=0 |
| ÃÄdelay_ms 0/21 Ram=1 |
| ÃÄdelay_ms 0/21 Ram=1 |
| ÃÄbeep 0/38 Ram=6 |
| ³ ÃÄdelay_us 0/14 Ram=1 |
| ³ ÀÄdelay_us 0/14 Ram=1 |
| ÃÄdelay_ms 0/21 Ram=1 |
| ÃÄbeep 0/38 Ram=6 |
| ³ ÃÄdelay_us 0/14 Ram=1 |
| ³ ÀÄdelay_us 0/14 Ram=1 |
| ÃÄ@goto10355 0/7 Ram=0 |
| ÃÄdelay_ms 0/21 Ram=1 |
| ÃÄdelay_ms 0/21 Ram=1 |
| ÃÄdelay_ms 0/21 Ram=1 |
| ÃÄdelay_ms 0/21 Ram=1 |
| ÀÄcikcak 0/172 Ram=1 |
| ÃÄ@goto10199 0/7 Ram=0 |
| ÃÄ@goto10214 0/6 Ram=0 |
| ÀÄdelay_ms 0/21 Ram=1 |
| /roboti/merkur/PIC16F873/prg.bat |
|---|
| 0,0 → 1,6 |
| call picpgr stop lpt2 |
| call picpgr erase pic16f873 lpt2 |
| call picpgr program main.hex hex pic16f873 lpt2 |
| call picpgr run lpt2 |
| pause |
| call picpgr stop lpt2 |
| /roboti/merkur/PIC16F88/AX25.c |
|---|
| 0,0 → 1,135 |
| #nolist |
| //#define PTT PIN_A2 // PTT control |
| //#define TXo PIN_C0 // To the transmitter modulator |
| #define PERIODAH delay_us(222) // Halfperiod H 222;78/1200 500;430/500 |
| #define TAILH delay_us(78) |
| #define PERIODAL delay_us(412) // Halfperiod L 412;345/1200 1000;880/500 |
| #define TAILL delay_us(345) |
| #byte STATUS = 3 // CPUs status register |
| byte SendData[16] = {'A'<<1, 'L'<<1, 'L'<<1, ' '<<1, ' '<<1, ' '<<1, 0x60, |
| 'C'<<1, 'Z'<<1, '0'<<1, 'R'<<1, 'R'<<1, 'R'<<1, 0x61, |
| 0x03, 0xF0}; |
| boolean bit; |
| int fcslo, fcshi; // variabloes for calculating FCS (CRC) |
| int stuff; // stuff counter for extra 0 |
| int flag_flag; // if it is sending flag (7E) |
| int fcs_flag; // if it is sending Frame Check Sequence |
| int i; // for for |
| void flipout() //flips the state of output pin a_1 |
| { |
| stuff = 0; //since this is a 0, reset the stuff counter |
| if (bit) |
| { |
| bit=FALSE; //if the state of the pin was low, make it high. |
| } |
| else |
| { |
| bit=TRUE; //if the state of the pin was high make it low |
| } |
| } |
| void fcsbit(byte tbyte) |
| { |
| #asm |
| BCF STATUS,0 |
| RRF fcshi,F // rotates the entire 16 bits |
| RRF fcslo,F // to the right |
| #endasm |
| if (((STATUS & 0x01)^(tbyte)) ==0x01) |
| { |
| fcshi = fcshi^0x84; |
| fcslo = fcslo^0x08; |
| } |
| } |
| void SendBit () |
| { |
| if (bit) |
| { |
| output_high(TXo); |
| PERIODAH; |
| output_low(TXo); |
| PERIODAH; |
| output_high(TXo); |
| PERIODAH; |
| output_low(TXo); |
| TAILH; |
| } |
| else |
| { |
| output_high(TXo); |
| PERIODAL; |
| output_low(TXo); |
| TAILL; |
| }; |
| } |
| void SendByte (byte inbyte) |
| { |
| int k, bt; |
| for (k=0;k<8;k++) //do the following for each of the 8 bits in the byte |
| { |
| bt = inbyte & 0x01; //strip off the rightmost bit of the byte to be sent (inbyte) |
| if ((fcs_flag == FALSE) & (flag_flag == FALSE)) fcsbit(bt); //do FCS calc, but only if this |
| //is not a flag or fcs byte |
| if (bt == 0) |
| { |
| flipout(); |
| } // if this bit is a zero, flip the output state |
| else |
| { //otherwise if it is a 1, do the following: |
| if (flag_flag == FALSE) stuff++; //increment the count of consequtive 1's |
| if ((flag_flag == FALSE) & (stuff == 5)) |
| { //stuff an extra 0, if 5 1's in a row |
| SendBit(); |
| flipout(); //flip the output state to stuff a 0 |
| }//end of if |
| }//end of else |
| // delay_us(850); //introduces a delay that creates 1200 baud |
| SendBit(); |
| inbyte = inbyte>>1; //go to the next bit in the byte |
| }//end of for |
| }//end of SendByte |
| void SendPacket(char *data) |
| { |
| bit=FALSE; |
| fcslo=fcshi=0xFF; //The 2 FCS Bytes are initialized to FF |
| stuff = 0; //The variable stuff counts the number of 1's in a row. When it gets to 5 |
| // it is time to stuff a 0. |
| // output_low(PTT); // Blinking LED |
| // delay_ms(1000); |
| // output_high(PTT); |
| flag_flag = TRUE; //The variable flag is true if you are transmitted flags (7E's) false otherwise. |
| fcs_flag = FALSE; //The variable fcsflag is true if you are transmitting FCS bytes, false otherwise. |
| for(i=0; i<10; i++) SendByte(0x7E); //Sends flag bytes. Adjust length for txdelay |
| //each flag takes approx 6.7 ms |
| flag_flag = FALSE; //done sending flags |
| for(i=0; i<16; i++) SendByte(SendData[i]); //send the packet bytes |
| for(i=0; 0 != *data; i++) |
| { |
| SendByte(*data); //send the packet bytes |
| data++; |
| }; |
| fcs_flag = TRUE; //about to send the FCS bytes |
| fcslo =fcslo^0xff; //must XOR them with FF before sending |
| fcshi = fcshi^0xff; |
| SendByte(fcslo); //send the low byte of fcs |
| SendByte(fcshi); //send the high byte of fcs |
| fcs_flag = FALSE; //done sending FCS |
| flag_flag = TRUE; //about to send flags |
| SendByte(0x7e); // Send a flag to end packet |
| } |
| #list |
| /roboti/merkur/PIC16F88/tank.BAK |
|---|
| 0,0 → 1,350 |
| #include "tank.h" |
| #define DEBUG |
| #define TXo PIN_A3 // To the transmitter modulator |
| #include "AX25.c" // podprogram pro prenos telemetrie |
| unsigned int8 sensors; // pomocna promenna pro cteni cidel na caru |
| unsigned int8 line; // na ktere strane byla detekovana cara |
| unsigned int8 speed; // rychlost zataceni |
| unsigned int8 rovinka; // pocitadlo pro zjisteni rovneho useku |
| unsigned int8 last; // kde byla cara, kdyz byly minule cidla mimo |
| unsigned int8 movement; // obsahuje aktualni smer zataceni |
| unsigned int8 dira; // pocita dobu po kterou je ztracena cara |
| unsigned int8 cihla; // urcuje za jak dlouho muze byt znova detekovana cihla |
| // Konstanty pro dynamiku pohybu |
| #define T_DIRA 85 // po jakem case zataceni se detekuje dira |
| #define INC_SPEED 1 // prirustek rychlosti v jednom kroku |
| #define FW_POMALU 230 // trochu mimo caru vnitrni pas |
| #define FW_ZATACKA 200 // rychlost vnejsiho kola pri zataceni |
| #define FW_STREDNE 240 // trochu mimo caru vnejsi pas |
| #define COUVANI 650 // couvnuti zpet na caru, po detekci diry |
| #define PRES_DIRU 300 |
| #define MAX_ROVINKA (255-FW_STREDNE) |
| #define TRESHOLD 10 // rozhodovaci uroven komparatoru, 0xF = 0.75*Vdd |
| #define BUMPER_TRESHOLD 128 |
| #define CIK_CAK 30000 |
| #define T_CIHLA 100 // perioda detekce cihly |
| //motory //Napred vypnout potom zapnout! |
| #define FR output_low(PIN_B5); output_high(PIN_B4) // Vpred |
| #define FL output_low(PIN_B7); output_high(PIN_B6) |
| #define BR output_low(PIN_B4); output_high(PIN_B5) // Vzad |
| #define BL output_low(PIN_B6); output_high(PIN_B7) |
| #define STOPR output_low(PIN_B4);output_low(PIN_B5) // Zastav |
| #define STOPL output_low(PIN_B6);output_low(PIN_B7) |
| #define L 0b10 // left |
| #define R 0b01 // right |
| #define S 0b11 // straight |
| //cidla |
| #define RSENSOR C2OUT // Senzory na caru |
| #define LSENSOR C1OUT |
| #define BUMPER PIN_A4 // Senzor na cihlu |
| #define DIAG_SERVO PIN_B3 // Propojka pro diagnosticky mod |
| #define DIAG_SENSORS PIN_B2 // Propojka pro diagnosticky mod |
| #DEFINE SOUND_HI PIN_A6 // komplementarni vystupy pro piezo pipak |
| #DEFINE SOUND_LO PIN_A7 |
| char AXstring[40]; // Buffer pro prenos telemetrie |
| // makro pro PWM |
| #define GO(motor, direction, power) if(get_timer0()<=power) \ |
| {direction##motor;} else {stop##motor;} |
| #int_TIMER2 |
| void TIMER2_isr() |
| { |
| if (speed<255) speed+=INC_SPEED; |
| if (rovinka<MAX_ROVINKA) rovinka++; |
| if (dira<=T_DIRA) dira++; |
| if (cihla>0) cihla--; |
| } |
| // Primitivni Pipani |
| void beep(unsigned int16 period, unsigned int16 length) |
| { |
| unsigned int16 nn; |
| for(nn=length; nn>0; nn--) |
| { |
| output_high(SOUND_HI);output_low(SOUND_LO); |
| delay_us(period); |
| output_high(SOUND_LO);output_low(SOUND_HI); |
| delay_us(period); |
| } |
| } |
| /******************************************************************************/ |
| void diagnostika() |
| { |
| unsigned int16 n; |
| while (input(DIAG_SERVO)) // Propojka, ktera spousti diagnostiku |
| { |
| for (n=500; n<800; n+=100) |
| { |
| beep(n,n); //beep UP |
| }; |
| Delay_ms(1000); |
| //zastav vse |
| STOPL; STOPR; |
| //pravy pas |
| FR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| BR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //levy pas |
| FL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| BL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //oba pasy |
| FL; FR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| BL; BR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| }; |
| while (input(DIAG_SENSORS)) |
| { |
| int ls, rs; |
| while(!input(BUMPER)){beep(1100,100); Delay_ms(50);} |
| set_adc_channel(RSENSOR); |
| Delay_us(20); |
| rs=read_adc(); |
| set_adc_channel(LSENSOR); |
| Delay_us(20); |
| ls=read_adc(); |
| sprintf(AXstring,"L: %U R: %U\0", ls, rs); // Convert DATA to String. |
| SendPacket(&AXstring[0]); |
| delay_ms(1000); |
| }; |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void cikcak() |
| { |
| unsigned int16 n; |
| line = RSENSOR; // cteni senzoru na caru |
| line |= LSENSOR << 1; |
| if (line!=0) return; |
| n=0; |
| switch(movement) // podivej se na druhou stranu nez se jelo |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| case S: |
| FR;BL; |
| movement=L; |
| n=CIK_CAK/2; |
| break; |
| } |
| while (0==(RSENSOR|LSENSOR)) // zkontroluj caru |
| { |
| if (n==CIK_CAK) // zmen smer zataceni |
| { |
| n=0; |
| switch(movement) |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| } |
| n++; |
| } |
| switch(movement) |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| Delay_ms(50); |
| STOPL;STOPR; // nasli jsme caru |
| line=S; |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void objizdka() // objede cihlu |
| { |
| unsigned int16 n; |
| BL;BR;Delay_ms(200); |
| STOPR;STOPL; |
| beep(900,1000); |
| movement=S; |
| cikcak(); |
| BR; FL; Delay_ms(215); // otoc se 70° do prava |
| FR; FL; Delay_ms(600); // popojed rovne |
| BL; Delay_ms(50); // otoc se 90° do leva |
| STOPL; FR; Delay_ms(550); |
| FR; FL; Delay_ms(100); // popojed rovne na slepo |
| for(n=600;n>0;n--) // popojed rovne ale kontroluj caru |
| { |
| line = RSENSOR; // cteni senzoru na caru |
| line |= LSENSOR << 1; |
| if (line!=0) {Delay_ms(50); break;} |
| Delay_ms(1); |
| } |
| BR; // otoc se 60° do prava |
| for(n=600;n>0;n--) |
| { |
| line = RSENSOR; // cteni senzoru na caru |
| line |= LSENSOR << 1; |
| if (line!=0) break; |
| Delay_ms(1); |
| } |
| STOPR; STOPL; |
| movement=R; |
| cikcak(); |
| cihla=T_DIRA; |
| dira=0; |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void prejeddiru() // vyresi diru |
| { |
| unsigned int16 n; |
| STOPL;STOPR; |
| beep(800,500); |
| switch (movement) //vrat se zpet na caru |
| { |
| case L: |
| for (n=COUVANI;n>0;n--) {GO(R,B,speed); Delay_ms(1);} |
| STOPL;STOPR; |
| break; |
| case R: |
| for (n=COUVANI;n>0;n--) {GO(L,B,speed); Delay_ms(1);} |
| STOPL;STOPR; |
| break; |
| case S: |
| goto sem; |
| break; |
| } |
| beep(800,500); |
| FR;FL; Delay_ms(PRES_DIRU); // popojedem dopredu mozna tam bude cara |
| sem: |
| STOPL; STOPR; |
| movement=S; |
| cikcak(); // najdi caru |
| cihla=T_DIRA; |
| dira=0; |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void main() |
| { |
| unsigned int16 n; // pro FOR |
| STOPL; STOPR; // prepne vystupy na ovladani motoru na output a zastavi |
| setup_oscillator(OSC_4MHZ|OSC_INTRC); // 4 MHz interni RC oscilator |
| port_b_pullups(TRUE); // pullups pro piano na diagnostiku |
| setup_spi(FALSE); |
| setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1); // Casovac pro PWM |
| setup_timer_2(T2_DIV_BY_4,255,10); // Casovac pro regulaci |
| // preruseni kazdych 10ms |
| setup_adc_ports(sAN2|VSS_VDD); // nastaveni A/D prevodniku pro naraznik |
| setup_adc(ADC_CLOCK_INTERNAL); |
| set_adc_channel(2); |
| setup_timer_1(T1_INTERNAL|T1_DIV_BY_1); // Casovac pro naraznik |
| setup_ccp1(CCP_COMPARE_RESET_TIMER); |
| CCP_1=(2^10)-1; // prevod kazdou 1ms |
| setup_comparator(A0_VR_A1_VR); // inicializace komparatoru pro cidla cary |
| setup_vref(VREF_HIGH|TRESHOLD); // 32 kroku od 0.25 do 0.75 Vdd |
| Beep(1000,200); //double beep |
| Delay_ms(50); |
| Beep(1000,200); |
| Delay_ms(1000); // 1s |
| // povoleni rizeni rychlosti zataceni pres preruseni |
| enable_interrupts(INT_TIMER2); |
| enable_interrupts(GLOBAL); |
| /*---------------------------------------------------------------------------*/ |
| sensors=S; |
| line=S; |
| last=S; |
| movement=S; |
| speed=FW_POMALU; |
| diagnostika(); |
| cikcak(); // toc se, abys nasel caru |
| Delay_ms(500); |
| Beep(1000,200); |
| Delay_ms(500); |
| while(true) // hlavni smycka (jizda podle cary) |
| { |
| sensors = RSENSOR; // cteni senzoru na caru |
| sensors |= LSENSOR << 1; |
| if ((read_adc(ADC_READ_ONLY)<BUMPER_TRESHOLD) && (cihla==0)) objizdka(); |
| switch (sensors) // zatacej podle toho, kde vidis caru |
| { |
| case S: // rovne |
| FL; FR; // pokud se jede dlouho rovne, tak pridej |
| dira=0; |
| movement=S; |
| continue; |
| case L: // trochu vlevo |
| GO(L, F, FW_POMALU+rovinka); GO(R, F, FW_STREDNE+rovinka); |
| line=L; |
| dira=0; |
| movement=L; |
| continue; |
| case R: // trochu vpravo |
| GO(R, F, FW_POMALU+rovinka); GO(L, F, FW_STREDNE+rovinka); |
| line=R; |
| dira=0; |
| movement=R; |
| continue; |
| default: // kdyz jsou obe cidla mimo caru, tak pokracuj dal |
| } |
| rovinka=0; |
| if (dira>=T_DIRA) prejeddiru(); |
| if (last!=line) // pokud si prejel caru z jedne strany na druhou stranu, tak zabrzdi |
| { |
| last=line; |
| speed=FW_ZATACKA; |
| } |
| if (L==line) // kdyz jsou obe cidla mimo caru, zatoc na caru |
| { |
| STOPL; |
| GO(R, F, speed); |
| movement=L; |
| } |
| else |
| { |
| STOPR; |
| GO(L, F, speed); |
| movement=R; |
| } |
| } // while(true) |
| } |
| /roboti/merkur/PIC16F88/tank.HEX |
|---|
| 0,0 → 1,272 |
| :1000000008308A0000280000FF00030E8301A100D1 |
| :100010007F08A0000A08A8008A01A00E0408A20018 |
| :100020007708A3007808A4007908A5007A08A6003C |
| :100030007B08A700831383128C308400801C222845 |
| :100040008C183528220884002308F7002408F800BB |
| :100050002508F9002608FA002708FB0028088A006E |
| :10006000210E8300FF0E7F0E09008A1149280A1015 |
| :100070008A100A1182074C343A342034253455341E |
| :100080002034203452343A3420342534553400346A |
| :100090000034420F4C284E280130C20743080E3C62 |
| :1000A0000318C30A4608553C0318C60AC708031DAF |
| :1000B000C7038C108A11222812308316A402031C55 |
| :1000C0006F28A4308400FC3080050310800C800C65 |
| :1000D000000803196F286D280000800B6C2883121C |
| :1000E000003483162108A3002008A200A208031DE3 |
| :1000F0007C28A30803199B28051383120517831670 |
| :100100008513831285137C088316A40083125C2058 |
| :10011000831685138312851783160513831205131F |
| :100120007C088316A40083125C208316220803191E |
| :10013000A303A2037628831200347D3084000008D4 |
| :100140000319B1280130F800F701F70BA528F80BC7 |
| :10015000A4284A30F700F70BAB2800000000800B02 |
| :10016000A228003470088400831620088000840AC6 |
| :100170008001F00A8312003483162108F80120025E |
| :100180000318C5282008F700D128F7010830A2007D |
| :10019000A00DF70D210877020318F700F80DA20B48 |
| :1001A000C828831200347E13FE127D088316A00037 |
| :1001B0006430A1008312BC207708FD007808031D7D |
| :1001C0000129FE1A0129FE1913297E1BED287E182C |
| :1001D000ED287E19ED28FE1B13297E1CF928FE1B35 |
| :1001E00013297E1BF9287E1813297E19F928FE1B76 |
| :1001F000132920307E1E30308316A0008312B220D7 |
| :100200001329FE16FE1F0D2978088000F8002D30F6 |
| :100210008316A0008312B220FE13303078078316B5 |
| :10022000A0008312B2207E1B20297D088316A00027 |
| :100230000A30A1008312BC207708FD007E17DE285B |
| :10024000FE1F27292D308316A0008312B2203030E4 |
| :100250007D078316A0008312B2200034BC01391C34 |
| :1002600033293910342939140034391C6029831694 |
| :100270008511831285154930F700F70B3D290000E1 |
| :10028000000083168511831285114930F700F70BA2 |
| :100290004729000000008316851183128515493017 |
| :1002A000F700F70B51290000000083168511831217 |
| :1002B00085111930F700F70B5B2900000000722947 |
| :1002C00083168511831285158930F700F70B66298F |
| :1002D00083168511831285117230F700F70B6E2992 |
| :1002E0000000000000348316A0012008073C031C16 |
| :1002F000CF297E080139A1008312BE080319822983 |
| :100300000030832901308316A2008312BD0803192F |
| :100310008B2900308C29013083162205003A0319FD |
| :10032000A4292108A20003108312BB0CBA0C0308F5 |
| :10033000013983162206013C031DA429843083124F |
| :10034000BB060830BA068316A108031DAB29831229 |
| :100350002E21C72983168312BD080319BC0ABD08C4 |
| :100360000319B4290030B52901308316A200831285 |
| :100370003C08053C0319BE290030BF290130831613 |
| :100380002205003A0319C829831235212E2183162C |
| :10039000831235210310FE0C8316A00A75298312DF |
| :1003A0000034831686158312861D022B0130F4005B |
| :1003B000F430F3007408033C031CF429031DE42902 |
| :1003C00073081F3C031CF4297408FD007308FC002B |
| :1003D00074088316A1007308A00083127120643092 |
| :1003E000F3070318F40ADA290430FC00FA30FD00A0 |
| :1003F0009D20FC0BF6298316061383120613831621 |
| :10040000861383128613831606128312061283162E |
| :100410008612831286128316861283128612831620 |
| :100420000612831206160430FC00FA30FD009D20EF |
| :10043000FC0B152A831606128312061283168612E7 |
| :10044000831286120430FC00FA30FD009D20FC0B64 |
| :10045000242A83160612831206128316861283122A |
| :1004600086160430FC00FA30FD009D20FC0B332A78 |
| :1004700083160612831206128316861283128612C0 |
| :100480000430FC00FA30FD009D20FC0B422A0330B2 |
| :10049000FD007030FC008316A1016430A0008312BF |
| :1004A00071200430FC00FA30FD009D20FC0B532A23 |
| :1004B0008316861383128613831606138312061778 |
| :1004C0000430FC00FA30FD009D20FC0B622A8316EC |
| :1004D00006138312061383168613831286130430C1 |
| :1004E000FC00FA30FD009D20FC0B712A83160613D8 |
| :1004F0008312061383168613831286170430FC00BA |
| :10050000FA30FD009D20FC0B802A8316061383120F |
| :10051000061383168613831286130430FC00FA3008 |
| :10052000FD009D20FC0B8F2A0330FD007030FC0085 |
| :100530008316A1016430A000831271200430FC00F6 |
| :10054000FA30FD009D20FC0BA02A8316861383122F |
| :1005500086138316061383120617831686128312D8 |
| :10056000861283160612831206160430FC00FA3037 |
| :10057000FD009D20FC0BB72A831606138312061379 |
| :1005800083168613831286138316061283120612AD |
| :1005900083168612831286120430FC00FA30FD00A6 |
| :1005A0009D20FC0BCE2A8316061383120613831696 |
| :1005B0008613831286178316061283120612831679 |
| :1005C0008612831286160430FC00FA30FD009D204E |
| :1005D000FC0BE52A83160613831206138316861373 |
| :1005E000831286138316061283120612831686124E |
| :1005F000831286120430FC00FA30FD009D20FC0BB3 |
| :10060000FC2AD129831606158312061DC22B8316D8 |
| :1006100005168312051A1A2B0430FD004C30FC001D |
| :100620008316A1016430A000831271203230FD00D6 |
| :100630009D20072B003083169C1B0130FC007C0D95 |
| :10064000F700F70DF70DF830F70583121F08C739CB |
| :1006500077049F000630F700F70B2C2B00001F15C6 |
| :100660001F19302B1E08F600003083161C1B0130AA |
| :10067000FC007C0DF700F70DF70DF830F70583123D |
| :100680001F08C73977049F000630F700F70B462B89 |
| :1006900000001F151F194A2B1E08F5004830F000F6 |
| :1006A0004C308316A0008312B2203A308316A0008B |
| :1006B0008312B22020308316A0008312B220750866 |
| :1006C000FD001830FE00D3200530FC007C083720E8 |
| :1006D000FC0AF7008316A0008312B2200A307C02C5 |
| :1006E000031D662B7608FD001830FE00D32048302D |
| :1006F000FC003910FF30BB00BA00BC010130BD0066 |
| :10070000BE01BF013F08093C031C8B2B7E30FE005D |
| :100710007321BF0A822BBD01BF013F080F3C031CA0 |
| :100720009A2B29303F0784000008FD00FE0073214A |
| :10073000BF0A8D2BBF017C08840000080319A92B78 |
| :100740007C0884000008FD00FE007321FC0ABF0A3B |
| :100750009B2B0130BE00FF30BA06BB063A08FE00F4 |
| :1007600073213B08FE007321BE010130BD007E30C5 |
| :10077000FE0073210430FC00FA30FD009D20FC0BCC |
| :10078000BC2B022B8A15BA28C10183169C1FCB2BC8 |
| :100790008312C10A831600301C1B0130F7000310BE |
| :1007A000F70D77088312C104C108031DB12CF601AF |
| :1007B000F5014508023A0319E42B033A0319F72B14 |
| :1007C000023A03190A2C212C8316861383128613EE |
| :1007D0008316061383120617831606128312061257 |
| :1007E00083168612831286160130C500212C8316CB |
| :1007F0008612831286128316061283120616831639 |
| :10080000061383120613831686138312861702308B |
| :10081000C500212C831686128312861283160612B7 |
| :100820008312061683160613831206138316861385 |
| :10083000831286170230C5003A30F6009830F50072 |
| :10084000212C003083169C1B0130FC0000301C1B47 |
| :1008500001307C04003A031D6D2C7508303C031DEB |
| :10086000672C7608753C031D672CF601F501831291 |
| :100870004508023A0319402C033A0319532C662CFD |
| :1008800083168613831286138316061383120617A4 |
| :100890008316061283120612831686128312861698 |
| :1008A0000130C500662C83168612831286128316C9 |
| :1008B0000612831206168316061383120613831676 |
| :1008C0008613831286170230C500662C8316F50A3C |
| :1008D0000319F60A8312212C831683124508023A63 |
| :1008E0000319762C033A0319892C9C2C8316861342 |
| :1008F00083128613831606138312061783160612B5 |
| :100900008312061283168612831286160130C500E2 |
| :100910009C2C83168612831286128316061283126B |
| :100920000616831606138312061383168613831284 |
| :1009300086170230C5009C2C3230FD009D208316A6 |
| :1009400006138312061383168613831286138316E7 |
| :100950000612831206128316861283128612033041 |
| :10096000C100003483160613831206138316861300 |
| :1009700083128617831606128312061283168612B6 |
| :1009800083128616C830FD009D208316061283123E |
| :10099000061283168612831286128316061383129A |
| :1009A000061383168613831286130330FD008430EA |
| :1009B000FC0003308316A100E830A00083127120F0 |
| :1009C0000330C500C4238316061283120612831651 |
| :1009D0008612831286168316861383128613831655 |
| :1009E000061383120617D730FD009D20831686124A |
| :1009F0008312861283160612831206168316861336 |
| :100A00008312861383160613831206170330F5002C |
| :100A1000C830FD009D20F50B082D831606138312A8 |
| :100A2000061383168613831286173230FD009D202D |
| :100A300083160613831206138316861383128613F6 |
| :100A400083168612831286128316061283120616E6 |
| :100A50000530F5006E30FD009D20F50B2A2D831624 |
| :100A600086128312861283160612831206168316C6 |
| :100A700086138312861383160613831206176430B7 |
| :100A8000FD009D200230F4005830F300F308031DF0 |
| :100A90004C2DF40803196B2DC10183169C1F532D97 |
| :100AA0008312C10A831600301C1B0130F7000310AB |
| :100AB000F70D77088312C104C1080319632D323082 |
| :100AC000FD009D206B2D0130FD009D207308031952 |
| :100AD000F403F303462D83160612831206128316BF |
| :100AE0008612831286160230F4005830F300F308A1 |
| :100AF000031D7D2DF4080319982DC10183169C1F39 |
| :100B0000842D8312C10A831600301C1B0130F700AC |
| :100B10000310F70D77088312C104C108031D982D37 |
| :100B20000130FD009D2073080319F403F303772DB2 |
| :100B300083160612831206128316861283128612F9 |
| :100B400083160613831206138316861383128613E5 |
| :100B50000130C500C4235530C700C6018A15F728E7 |
| :100B600083160613831206138316861383128613C5 |
| :100B700083160612831206128316861283128612B9 |
| :100B80000330FD002030FC0001308316A100F4305A |
| :100B9000A000831271204508023A0319D62D033AAA |
| :100BA00003190E2E023A0319462E482E0230F40085 |
| :100BB0008A30F300F308031DE02DF4080319FD2D1E |
| :100BC00001084202031CED2D831606128312061241 |
| :100BD0008316861283128616F52D8316061283124B |
| :100BE000061283168612831286120130FD009D20A4 |
| :100BF00073080319F403F303DA2D83160613831223 |
| :100C00000613831686138312861383160612831225 |
| :100C100006128316861283128612482E0230F400C2 |
| :100C20008A30F300F308031D182EF4080319352E3B |
| :100C300001084202031C252E831606138312061395 |
| :100C400083168613831286172D2E8316061383129E |
| :100C5000061383168613831286130130FD009D2030 |
| :100C600073080319F403F303122E83160613831279 |
| :100C700006138316861383128613831606128312B5 |
| :100C800006128316861283128612482E6A2E482E6A |
| :100C90000330FD002030FC0001308316A100F43049 |
| :100CA000A000831271208316861283128612831687 |
| :100CB0000612831206168316861383128613831672 |
| :100CC0000613831206170230F500AF30FD009D2099 |
| :100CD000F50B652E831606138312061383168613EF |
| :100CE0008312861383160612831206128316861247 |
| :100CF000831286120330C500C4235530C700C601D5 |
| :040D00008A15902997 |
| :1010000084011F30830583161F129F121B0880392D |
| :101010009B0007309C001C0883120D136030831660 |
| :101020008F0082308312A9009830AA00AB004030B4 |
| :10103000AC00AD00AE006030AF008630B000B43020 |
| :10104000B1006030B200A430B300B400B50061302C |
| :10105000B6000330B700F030B800F0018316061375 |
| :1010600083120613831686138312861383160612C1 |
| :10107000831206128316861283128612623083163A |
| :101080008F008113831294128316061186140612A0 |
| :10109000003083129400831694000108C739083881 |
| :1010A00081004830F800053883129200FF30831623 |
| :1010B00092001F129F121B08803904389B001F13D7 |
| :1010C00083121F179F1783169F1383121F1410304C |
| :1010D000F8001F08C73978049F00853090008316F8 |
| :1010E00086150B3083129700960107309500023069 |
| :1010F00083169C000508033885000330F700F70BC2 |
| :101100007F281C0883120D138A3083169D0003303C |
| :10111000FD00E830FC00A101C830A0008A11831254 |
| :1011200071208A153230FD008A119D208A15033006 |
| :10113000FD00E830FC008316A101C830A0008A1130 |
| :10114000831271208A150430F300FA30FD008A11F1 |
| :101150009D208A15F30BA52883168C14C0308312AA |
| :101160008B040330C000C100C400C500E630C200DB |
| :101170008A11D1298A158A11C4238A150230F300F5 |
| :10118000FA30FD008A119D208A15F30BC028033028 |
| :10119000FD00E830FC008316A101C830A0008A11D0 |
| :1011A000831271208A150230F300FA30FD008A1193 |
| :1011B0009D208A15F30BD528C00183169C1FE328B8 |
| :1011C0008312C00A831600301C1B0130F700031085 |
| :1011D000F70D77088312C0041F19EC281E087F3C06 |
| :1011E000031CF828C708031DF8288A11B22C8A1599 |
| :1011F0004008033A03190329013A03191729033A4E |
| :10120000031950298929831686138312861383169E |
| :10121000061383120617831686128312861283160C |
| :10122000061283120616C6010330C500DC28010829 |
| :10123000F300E63043077302031920290318292914 |
| :1012400083168613831286138316061383120617DA |
| :10125000312983160613831206138316861383120D |
| :1012600086130108F300F0304307730203193A298B |
| :1012700003184329831686128312861283160612D8 |
| :10128000831206164B298316061283120612831642 |
| :101290008612831286120230C100C601C500DC2806 |
| :1012A0000108F300E63043077302031959290318B4 |
| :1012B00062298316861283128612831606128312FF |
| :1012C00006166A29831606128312061283168612E0 |
| :1012D000831286120108F300F030430773020319EA |
| :1012E000732903187C2983168613831286138316A9 |
| :1012F0000613831206178429831606138312061316 |
| :1013000083168613831286130130C100C601C500FF |
| :10131000DC28C3014608543C031891298A11B02DDA |
| :101320008A1541084402031999294108C400C830AC |
| :10133000C2004108023C031DBD2983160613831217 |
| :101340000613831686138312861301084202031CB8 |
| :10135000B22983168612831286128316061283120E |
| :101360000616BA29831606128312061283168612EF |
| :10137000831286120230C500DC29831606128312FE |
| :101380000612831686128312861201084202031C7B |
| :10139000D2298316861383128613831606138312AB |
| :1013A0000617DA298316061383120613831686138B |
| :0C13B000831286130130C500DC286300A6 |
| :04400E00383FFC3FFC |
| :00000001FF |
| ;PIC16F88 |
| /roboti/merkur/PIC16F88/tank.LST |
|---|
| 0,0 → 1,2134 |
| CCS PCM C Compiler, Version 3.221, 27853 26-IV-05 01:22 |
| Filename: D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.LST |
| ROM used: 2144 words (52%) |
| Largest free fragment is 1570 |
| RAM used: 89 (51%) at main() level |
| 101 (58%) worst case |
| Stack: 4 worst case (3 in main + 1 for interrupts) |
| * |
| 0000: MOVLW 08 |
| 0001: MOVWF 0A |
| 0002: GOTO 000 |
| 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 049 |
| .................... #include "tank.h" |
| .................... #include <16F88.h> |
| .................... //////// Standard Header file for the PIC16F88 device //////////////// |
| .................... #device PIC16F88 |
| .................... #list |
| .................... |
| .................... #device adc=8 |
| .................... #fuses NOWDT,INTRC_IO, NOPUT, MCLR, NOBROWNOUT, NOLVP, NOCPD, NOWRT, NODEBUG, NOPROTECT, NOFCMEN, NOIESO |
| .................... #use delay(clock=4000000) |
| * |
| 005C: MOVLW 12 |
| 005D: BSF 03.5 |
| 005E: SUBWF 24,F |
| 005F: BTFSS 03.0 |
| 0060: GOTO 06F |
| 0061: MOVLW A4 |
| 0062: MOVWF 04 |
| 0063: MOVLW FC |
| 0064: ANDWF 00,F |
| 0065: BCF 03.0 |
| 0066: RRF 00,F |
| 0067: RRF 00,F |
| 0068: MOVF 00,W |
| 0069: BTFSC 03.2 |
| 006A: GOTO 06F |
| 006B: GOTO 06D |
| 006C: NOP |
| 006D: DECFSZ 00,F |
| 006E: GOTO 06C |
| 006F: BCF 03.5 |
| 0070: RETLW 00 |
| * |
| 009D: MOVLW 7D |
| 009E: MOVWF 04 |
| 009F: MOVF 00,W |
| 00A0: BTFSC 03.2 |
| 00A1: GOTO 0B1 |
| 00A2: MOVLW 01 |
| 00A3: MOVWF 78 |
| 00A4: CLRF 77 |
| 00A5: DECFSZ 77,F |
| 00A6: GOTO 0A5 |
| 00A7: DECFSZ 78,F |
| 00A8: GOTO 0A4 |
| 00A9: MOVLW 4A |
| 00AA: MOVWF 77 |
| 00AB: DECFSZ 77,F |
| 00AC: GOTO 0AB |
| 00AD: NOP |
| 00AE: NOP |
| 00AF: DECFSZ 00,F |
| 00B0: GOTO 0A2 |
| 00B1: RETLW 00 |
| .................... |
| .................... |
| .................... |
| .................... #define DEBUG |
| .................... |
| .................... #define TXo PIN_A3 // To the transmitter modulator |
| .................... #include "AX25.c" // podprogram pro prenos telemetrie |
| .................... #list |
| .................... |
| .................... |
| .................... unsigned int8 sensors; // pomocna promenna pro cteni cidel na caru |
| .................... unsigned int8 line; // na ktere strane byla detekovana cara |
| .................... unsigned int8 speed; // rychlost zataceni |
| .................... unsigned int8 rovinka; // pocitadlo pro zjisteni rovneho useku |
| .................... unsigned int8 last; // kde byla cara, kdyz byly minule cidla mimo |
| .................... unsigned int8 movement; // obsahuje aktualni smer zataceni |
| .................... unsigned int8 dira; // pocita dobu po kterou je ztracena cara |
| .................... unsigned int8 cihla; // urcuje za jak dlouho muze byt znova detekovana cihla |
| .................... |
| .................... // Konstanty pro dynamiku pohybu |
| .................... #define T_DIRA 85 // po jakem case zataceni se detekuje dira |
| .................... #define INC_SPEED 1 // prirustek rychlosti v jednom kroku |
| .................... #define FW_POMALU 230 // trochu mimo caru vnitrni pas |
| .................... #define FW_ZATACKA 200 // rychlost vnejsiho kola pri zataceni |
| .................... #define FW_STREDNE 240 // trochu mimo caru vnejsi pas |
| .................... #define COUVANI 650 // couvnuti zpet na caru, po detekci diry |
| .................... #define PRES_DIRU 350 |
| .................... #define MAX_ROVINKA (255-FW_STREDNE) |
| .................... #define TRESHOLD 10 // rozhodovaci uroven komparatoru, 0xF = 0.75*Vdd |
| .................... #define BUMPER_TRESHOLD 128 |
| .................... #define CIK_CAK 30000 |
| .................... #define T_CIHLA 100 // perioda detekce cihly |
| .................... |
| .................... //motory //Napred vypnout potom zapnout! |
| .................... #define FR output_low(PIN_B5); output_high(PIN_B4) // Vpred |
| .................... #define FL output_low(PIN_B7); output_high(PIN_B6) |
| .................... #define BR output_low(PIN_B4); output_high(PIN_B5) // Vzad |
| .................... #define BL output_low(PIN_B6); output_high(PIN_B7) |
| .................... #define STOPR output_low(PIN_B4);output_low(PIN_B5) // Zastav |
| .................... #define STOPL output_low(PIN_B6);output_low(PIN_B7) |
| .................... |
| .................... #define L 0b10 // left |
| .................... #define R 0b01 // right |
| .................... #define S 0b11 // straight |
| .................... |
| .................... //cidla |
| .................... #define RSENSOR C2OUT // Senzory na caru |
| .................... #define LSENSOR C1OUT |
| .................... #define BUMPER PIN_A4 // Senzor na cihlu |
| .................... |
| .................... #define DIAG_SERVO PIN_B3 // Propojka pro diagnosticky mod |
| .................... #define DIAG_SENSORS PIN_B2 // Propojka pro diagnosticky mod |
| .................... |
| .................... #DEFINE SOUND_HI PIN_A6 // komplementarni vystupy pro piezo pipak |
| .................... #DEFINE SOUND_LO PIN_A7 |
| .................... |
| .................... char AXstring[40]; // Buffer pro prenos telemetrie |
| .................... |
| .................... // makro pro PWM |
| .................... #define GO(motor, direction, power) if(get_timer0()<=power) \ |
| .................... {direction##motor;} else {stop##motor;} |
| .................... |
| .................... #int_TIMER2 |
| .................... void TIMER2_isr() |
| .................... { |
| .................... if (speed<255) speed+=INC_SPEED; |
| * |
| 0049: INCFSZ 42,W |
| 004A: GOTO 04C |
| 004B: GOTO 04E |
| 004C: MOVLW 01 |
| 004D: ADDWF 42,F |
| .................... if (rovinka<MAX_ROVINKA) rovinka++; |
| 004E: MOVF 43,W |
| 004F: SUBLW 0E |
| 0050: BTFSC 03.0 |
| 0051: INCF 43,F |
| .................... if (dira<=T_DIRA) dira++; |
| 0052: MOVF 46,W |
| 0053: SUBLW 55 |
| 0054: BTFSC 03.0 |
| 0055: INCF 46,F |
| .................... if (cihla>0) cihla--; |
| 0056: MOVF 47,F |
| 0057: BTFSS 03.2 |
| 0058: DECF 47,F |
| .................... } |
| .................... // Primitivni Pipani |
| 0059: BCF 0C.1 |
| 005A: BCF 0A.3 |
| 005B: GOTO 022 |
| .................... void beep(unsigned int16 period, unsigned int16 length) |
| .................... { |
| .................... unsigned int16 nn; |
| .................... |
| .................... for(nn=length; nn>0; nn--) |
| * |
| 0071: BSF 03.5 |
| 0072: MOVF 21,W |
| 0073: MOVWF 23 |
| 0074: MOVF 20,W |
| 0075: MOVWF 22 |
| 0076: MOVF 22,F |
| 0077: BTFSS 03.2 |
| 0078: GOTO 07C |
| 0079: MOVF 23,F |
| 007A: BTFSC 03.2 |
| 007B: GOTO 09B |
| .................... { |
| .................... output_high(SOUND_HI);output_low(SOUND_LO); |
| 007C: BCF 05.6 |
| 007D: BCF 03.5 |
| 007E: BSF 05.6 |
| 007F: BSF 03.5 |
| 0080: BCF 05.7 |
| 0081: BCF 03.5 |
| 0082: BCF 05.7 |
| .................... delay_us(period); |
| 0083: MOVF 7C,W |
| 0084: BSF 03.5 |
| 0085: MOVWF 24 |
| 0086: BCF 03.5 |
| 0087: CALL 05C |
| .................... output_high(SOUND_LO);output_low(SOUND_HI); |
| 0088: BSF 03.5 |
| 0089: BCF 05.7 |
| 008A: BCF 03.5 |
| 008B: BSF 05.7 |
| 008C: BSF 03.5 |
| 008D: BCF 05.6 |
| 008E: BCF 03.5 |
| 008F: BCF 05.6 |
| .................... delay_us(period); |
| 0090: MOVF 7C,W |
| 0091: BSF 03.5 |
| 0092: MOVWF 24 |
| 0093: BCF 03.5 |
| 0094: CALL 05C |
| .................... } |
| 0095: BSF 03.5 |
| 0096: MOVF 22,W |
| 0097: BTFSC 03.2 |
| 0098: DECF 23,F |
| 0099: DECF 22,F |
| 009A: GOTO 076 |
| .................... } |
| 009B: BCF 03.5 |
| 009C: RETLW 00 |
| .................... /******************************************************************************/ |
| .................... void diagnostika() |
| .................... { |
| .................... unsigned int16 n; |
| .................... |
| .................... while (input(DIAG_SERVO)) // Propojka, ktera spousti diagnostiku |
| .................... { |
| * |
| 01D1: BSF 03.5 |
| 01D2: BSF 06.3 |
| 01D3: BCF 03.5 |
| 01D4: BTFSS 06.3 |
| 01D5: GOTO 302 |
| .................... for (n=500; n<800; n+=100) |
| 01D6: MOVLW 01 |
| 01D7: MOVWF 74 |
| 01D8: MOVLW F4 |
| 01D9: MOVWF 73 |
| 01DA: MOVF 74,W |
| 01DB: SUBLW 03 |
| 01DC: BTFSS 03.0 |
| 01DD: GOTO 1F4 |
| 01DE: BTFSS 03.2 |
| 01DF: GOTO 1E4 |
| 01E0: MOVF 73,W |
| 01E1: SUBLW 1F |
| 01E2: BTFSS 03.0 |
| 01E3: GOTO 1F4 |
| .................... { |
| .................... beep(n,n); //beep UP |
| 01E4: MOVF 74,W |
| 01E5: MOVWF 7D |
| 01E6: MOVF 73,W |
| 01E7: MOVWF 7C |
| 01E8: MOVF 74,W |
| 01E9: BSF 03.5 |
| 01EA: MOVWF 21 |
| 01EB: MOVF 73,W |
| 01EC: MOVWF 20 |
| 01ED: BCF 03.5 |
| 01EE: CALL 071 |
| .................... }; |
| 01EF: MOVLW 64 |
| 01F0: ADDWF 73,F |
| 01F1: BTFSC 03.0 |
| 01F2: INCF 74,F |
| 01F3: GOTO 1DA |
| .................... Delay_ms(1000); |
| 01F4: MOVLW 04 |
| 01F5: MOVWF 7C |
| 01F6: MOVLW FA |
| 01F7: MOVWF 7D |
| 01F8: CALL 09D |
| 01F9: DECFSZ 7C,F |
| 01FA: GOTO 1F6 |
| .................... //zastav vse |
| .................... STOPL; STOPR; |
| 01FB: BSF 03.5 |
| 01FC: BCF 06.6 |
| 01FD: BCF 03.5 |
| 01FE: BCF 06.6 |
| 01FF: BSF 03.5 |
| 0200: BCF 06.7 |
| 0201: BCF 03.5 |
| 0202: BCF 06.7 |
| 0203: BSF 03.5 |
| 0204: BCF 06.4 |
| 0205: BCF 03.5 |
| 0206: BCF 06.4 |
| 0207: BSF 03.5 |
| 0208: BCF 06.5 |
| 0209: BCF 03.5 |
| 020A: BCF 06.5 |
| .................... //pravy pas |
| .................... FR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| 020B: BSF 03.5 |
| 020C: BCF 06.5 |
| 020D: BCF 03.5 |
| 020E: BCF 06.5 |
| 020F: BSF 03.5 |
| 0210: BCF 06.4 |
| 0211: BCF 03.5 |
| 0212: BSF 06.4 |
| 0213: MOVLW 04 |
| 0214: MOVWF 7C |
| 0215: MOVLW FA |
| 0216: MOVWF 7D |
| 0217: CALL 09D |
| 0218: DECFSZ 7C,F |
| 0219: GOTO 215 |
| 021A: BSF 03.5 |
| 021B: BCF 06.4 |
| 021C: BCF 03.5 |
| 021D: BCF 06.4 |
| 021E: BSF 03.5 |
| 021F: BCF 06.5 |
| 0220: BCF 03.5 |
| 0221: BCF 06.5 |
| 0222: MOVLW 04 |
| 0223: MOVWF 7C |
| 0224: MOVLW FA |
| 0225: MOVWF 7D |
| 0226: CALL 09D |
| 0227: DECFSZ 7C,F |
| 0228: GOTO 224 |
| .................... BR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| 0229: BSF 03.5 |
| 022A: BCF 06.4 |
| 022B: BCF 03.5 |
| 022C: BCF 06.4 |
| 022D: BSF 03.5 |
| 022E: BCF 06.5 |
| 022F: BCF 03.5 |
| 0230: BSF 06.5 |
| 0231: MOVLW 04 |
| 0232: MOVWF 7C |
| 0233: MOVLW FA |
| 0234: MOVWF 7D |
| 0235: CALL 09D |
| 0236: DECFSZ 7C,F |
| 0237: GOTO 233 |
| 0238: BSF 03.5 |
| 0239: BCF 06.4 |
| 023A: BCF 03.5 |
| 023B: BCF 06.4 |
| 023C: BSF 03.5 |
| 023D: BCF 06.5 |
| 023E: BCF 03.5 |
| 023F: BCF 06.5 |
| 0240: MOVLW 04 |
| 0241: MOVWF 7C |
| 0242: MOVLW FA |
| 0243: MOVWF 7D |
| 0244: CALL 09D |
| 0245: DECFSZ 7C,F |
| 0246: GOTO 242 |
| .................... Beep(880,100); Delay_ms(1000); |
| 0247: MOVLW 03 |
| 0248: MOVWF 7D |
| 0249: MOVLW 70 |
| 024A: MOVWF 7C |
| 024B: BSF 03.5 |
| 024C: CLRF 21 |
| 024D: MOVLW 64 |
| 024E: MOVWF 20 |
| 024F: BCF 03.5 |
| 0250: CALL 071 |
| 0251: MOVLW 04 |
| 0252: MOVWF 7C |
| 0253: MOVLW FA |
| 0254: MOVWF 7D |
| 0255: CALL 09D |
| 0256: DECFSZ 7C,F |
| 0257: GOTO 253 |
| .................... //levy pas |
| .................... FL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| 0258: BSF 03.5 |
| 0259: BCF 06.7 |
| 025A: BCF 03.5 |
| 025B: BCF 06.7 |
| 025C: BSF 03.5 |
| 025D: BCF 06.6 |
| 025E: BCF 03.5 |
| 025F: BSF 06.6 |
| 0260: MOVLW 04 |
| 0261: MOVWF 7C |
| 0262: MOVLW FA |
| 0263: MOVWF 7D |
| 0264: CALL 09D |
| 0265: DECFSZ 7C,F |
| 0266: GOTO 262 |
| 0267: BSF 03.5 |
| 0268: BCF 06.6 |
| 0269: BCF 03.5 |
| 026A: BCF 06.6 |
| 026B: BSF 03.5 |
| 026C: BCF 06.7 |
| 026D: BCF 03.5 |
| 026E: BCF 06.7 |
| 026F: MOVLW 04 |
| 0270: MOVWF 7C |
| 0271: MOVLW FA |
| 0272: MOVWF 7D |
| 0273: CALL 09D |
| 0274: DECFSZ 7C,F |
| 0275: GOTO 271 |
| .................... BL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| 0276: BSF 03.5 |
| 0277: BCF 06.6 |
| 0278: BCF 03.5 |
| 0279: BCF 06.6 |
| 027A: BSF 03.5 |
| 027B: BCF 06.7 |
| 027C: BCF 03.5 |
| 027D: BSF 06.7 |
| 027E: MOVLW 04 |
| 027F: MOVWF 7C |
| 0280: MOVLW FA |
| 0281: MOVWF 7D |
| 0282: CALL 09D |
| 0283: DECFSZ 7C,F |
| 0284: GOTO 280 |
| 0285: BSF 03.5 |
| 0286: BCF 06.6 |
| 0287: BCF 03.5 |
| 0288: BCF 06.6 |
| 0289: BSF 03.5 |
| 028A: BCF 06.7 |
| 028B: BCF 03.5 |
| 028C: BCF 06.7 |
| 028D: MOVLW 04 |
| 028E: MOVWF 7C |
| 028F: MOVLW FA |
| 0290: MOVWF 7D |
| 0291: CALL 09D |
| 0292: DECFSZ 7C,F |
| 0293: GOTO 28F |
| .................... Beep(880,100); Delay_ms(1000); |
| 0294: MOVLW 03 |
| 0295: MOVWF 7D |
| 0296: MOVLW 70 |
| 0297: MOVWF 7C |
| 0298: BSF 03.5 |
| 0299: CLRF 21 |
| 029A: MOVLW 64 |
| 029B: MOVWF 20 |
| 029C: BCF 03.5 |
| 029D: CALL 071 |
| 029E: MOVLW 04 |
| 029F: MOVWF 7C |
| 02A0: MOVLW FA |
| 02A1: MOVWF 7D |
| 02A2: CALL 09D |
| 02A3: DECFSZ 7C,F |
| 02A4: GOTO 2A0 |
| .................... //oba pasy |
| .................... FL; FR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| 02A5: BSF 03.5 |
| 02A6: BCF 06.7 |
| 02A7: BCF 03.5 |
| 02A8: BCF 06.7 |
| 02A9: BSF 03.5 |
| 02AA: BCF 06.6 |
| 02AB: BCF 03.5 |
| 02AC: BSF 06.6 |
| 02AD: BSF 03.5 |
| 02AE: BCF 06.5 |
| 02AF: BCF 03.5 |
| 02B0: BCF 06.5 |
| 02B1: BSF 03.5 |
| 02B2: BCF 06.4 |
| 02B3: BCF 03.5 |
| 02B4: BSF 06.4 |
| 02B5: MOVLW 04 |
| 02B6: MOVWF 7C |
| 02B7: MOVLW FA |
| 02B8: MOVWF 7D |
| 02B9: CALL 09D |
| 02BA: DECFSZ 7C,F |
| 02BB: GOTO 2B7 |
| 02BC: BSF 03.5 |
| 02BD: BCF 06.6 |
| 02BE: BCF 03.5 |
| 02BF: BCF 06.6 |
| 02C0: BSF 03.5 |
| 02C1: BCF 06.7 |
| 02C2: BCF 03.5 |
| 02C3: BCF 06.7 |
| 02C4: BSF 03.5 |
| 02C5: BCF 06.4 |
| 02C6: BCF 03.5 |
| 02C7: BCF 06.4 |
| 02C8: BSF 03.5 |
| 02C9: BCF 06.5 |
| 02CA: BCF 03.5 |
| 02CB: BCF 06.5 |
| 02CC: MOVLW 04 |
| 02CD: MOVWF 7C |
| 02CE: MOVLW FA |
| 02CF: MOVWF 7D |
| 02D0: CALL 09D |
| 02D1: DECFSZ 7C,F |
| 02D2: GOTO 2CE |
| .................... BL; BR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| 02D3: BSF 03.5 |
| 02D4: BCF 06.6 |
| 02D5: BCF 03.5 |
| 02D6: BCF 06.6 |
| 02D7: BSF 03.5 |
| 02D8: BCF 06.7 |
| 02D9: BCF 03.5 |
| 02DA: BSF 06.7 |
| 02DB: BSF 03.5 |
| 02DC: BCF 06.4 |
| 02DD: BCF 03.5 |
| 02DE: BCF 06.4 |
| 02DF: BSF 03.5 |
| 02E0: BCF 06.5 |
| 02E1: BCF 03.5 |
| 02E2: BSF 06.5 |
| 02E3: MOVLW 04 |
| 02E4: MOVWF 7C |
| 02E5: MOVLW FA |
| 02E6: MOVWF 7D |
| 02E7: CALL 09D |
| 02E8: DECFSZ 7C,F |
| 02E9: GOTO 2E5 |
| 02EA: BSF 03.5 |
| 02EB: BCF 06.6 |
| 02EC: BCF 03.5 |
| 02ED: BCF 06.6 |
| 02EE: BSF 03.5 |
| 02EF: BCF 06.7 |
| 02F0: BCF 03.5 |
| 02F1: BCF 06.7 |
| 02F2: BSF 03.5 |
| 02F3: BCF 06.4 |
| 02F4: BCF 03.5 |
| 02F5: BCF 06.4 |
| 02F6: BSF 03.5 |
| 02F7: BCF 06.5 |
| 02F8: BCF 03.5 |
| 02F9: BCF 06.5 |
| 02FA: MOVLW 04 |
| 02FB: MOVWF 7C |
| 02FC: MOVLW FA |
| 02FD: MOVWF 7D |
| 02FE: CALL 09D |
| 02FF: DECFSZ 7C,F |
| 0300: GOTO 2FC |
| .................... }; |
| 0301: GOTO 1D1 |
| .................... while (input(DIAG_SENSORS)) |
| .................... { |
| 0302: BSF 03.5 |
| 0303: BSF 06.2 |
| 0304: BCF 03.5 |
| 0305: BTFSS 06.2 |
| 0306: GOTO 3C2 |
| .................... int ls, rs; |
| .................... while(!input(BUMPER)){beep(1100,100); Delay_ms(50);} |
| 0307: BSF 03.5 |
| 0308: BSF 05.4 |
| 0309: BCF 03.5 |
| 030A: BTFSC 05.4 |
| 030B: GOTO 31A |
| 030C: MOVLW 04 |
| 030D: MOVWF 7D |
| 030E: MOVLW 4C |
| 030F: MOVWF 7C |
| 0310: BSF 03.5 |
| 0311: CLRF 21 |
| 0312: MOVLW 64 |
| 0313: MOVWF 20 |
| 0314: BCF 03.5 |
| 0315: CALL 071 |
| 0316: MOVLW 32 |
| 0317: MOVWF 7D |
| 0318: CALL 09D |
| 0319: GOTO 307 |
| .................... set_adc_channel(RSENSOR); |
| 031A: MOVLW 00 |
| 031B: BSF 03.5 |
| 031C: BTFSC 1C.7 |
| 031D: MOVLW 01 |
| 031E: MOVWF 7C |
| 031F: RLF 7C,W |
| 0320: MOVWF 77 |
| 0321: RLF 77,F |
| 0322: RLF 77,F |
| 0323: MOVLW F8 |
| 0324: ANDWF 77,F |
| 0325: BCF 03.5 |
| 0326: MOVF 1F,W |
| 0327: ANDLW C7 |
| 0328: IORWF 77,W |
| 0329: MOVWF 1F |
| .................... Delay_us(20); |
| 032A: MOVLW 06 |
| 032B: MOVWF 77 |
| 032C: DECFSZ 77,F |
| 032D: GOTO 32C |
| 032E: NOP |
| .................... rs=read_adc(); |
| 032F: BSF 1F.2 |
| 0330: BTFSC 1F.2 |
| 0331: GOTO 330 |
| 0332: MOVF 1E,W |
| 0333: MOVWF 76 |
| .................... set_adc_channel(LSENSOR); |
| 0334: MOVLW 00 |
| 0335: BSF 03.5 |
| 0336: BTFSC 1C.6 |
| 0337: MOVLW 01 |
| 0338: MOVWF 7C |
| 0339: RLF 7C,W |
| 033A: MOVWF 77 |
| 033B: RLF 77,F |
| 033C: RLF 77,F |
| 033D: MOVLW F8 |
| 033E: ANDWF 77,F |
| 033F: BCF 03.5 |
| 0340: MOVF 1F,W |
| 0341: ANDLW C7 |
| 0342: IORWF 77,W |
| 0343: MOVWF 1F |
| .................... Delay_us(20); |
| 0344: MOVLW 06 |
| 0345: MOVWF 77 |
| 0346: DECFSZ 77,F |
| 0347: GOTO 346 |
| 0348: NOP |
| .................... ls=read_adc(); |
| 0349: BSF 1F.2 |
| 034A: BTFSC 1F.2 |
| 034B: GOTO 34A |
| 034C: MOVF 1E,W |
| 034D: MOVWF 75 |
| .................... sprintf(AXstring,"L: %U R: %U\0", ls, rs); // Convert DATA to String. |
| 034E: MOVLW 48 |
| 034F: MOVWF 70 |
| 0350: MOVLW 4C |
| 0351: BSF 03.5 |
| 0352: MOVWF 20 |
| 0353: BCF 03.5 |
| 0354: CALL 0B2 |
| 0355: MOVLW 3A |
| 0356: BSF 03.5 |
| 0357: MOVWF 20 |
| 0358: BCF 03.5 |
| 0359: CALL 0B2 |
| 035A: MOVLW 20 |
| 035B: BSF 03.5 |
| 035C: MOVWF 20 |
| 035D: BCF 03.5 |
| 035E: CALL 0B2 |
| 035F: MOVF 75,W |
| 0360: MOVWF 7D |
| 0361: MOVLW 18 |
| 0362: MOVWF 7E |
| 0363: CALL 0D3 |
| 0364: MOVLW 05 |
| 0365: MOVWF 7C |
| 0366: MOVF 7C,W |
| 0367: CALL 037 |
| 0368: INCF 7C,F |
| 0369: MOVWF 77 |
| 036A: BSF 03.5 |
| 036B: MOVWF 20 |
| 036C: BCF 03.5 |
| 036D: CALL 0B2 |
| 036E: MOVLW 0A |
| 036F: SUBWF 7C,W |
| 0370: BTFSS 03.2 |
| 0371: GOTO 366 |
| 0372: MOVF 76,W |
| 0373: MOVWF 7D |
| 0374: MOVLW 18 |
| 0375: MOVWF 7E |
| 0376: CALL 0D3 |
| * |
| 082D: CLRF 70 |
| .................... SendPacket(&AXstring[0]); |
| * |
| 0377: MOVLW 48 |
| 0378: MOVWF 7C |
| .................... delay_ms(1000); |
| * |
| 03BA: MOVLW 04 |
| 03BB: MOVWF 7C |
| 03BC: MOVLW FA |
| 03BD: MOVWF 7D |
| 03BE: CALL 09D |
| 03BF: DECFSZ 7C,F |
| 03C0: GOTO 3BC |
| .................... }; |
| 03C1: GOTO 302 |
| .................... } |
| 03C2: BSF 0A.3 |
| 03C3: GOTO 0BA (RETURN) |
| .................... /////////////////////////////////////////////////////////////////////////////// |
| .................... void cikcak() |
| .................... { |
| .................... unsigned int16 n; |
| .................... |
| .................... line = RSENSOR; // cteni senzoru na caru |
| 03C4: CLRF 41 |
| 03C5: BSF 03.5 |
| 03C6: BTFSS 1C.7 |
| 03C7: GOTO 3CB |
| 03C8: BCF 03.5 |
| 03C9: INCF 41,F |
| 03CA: BSF 03.5 |
| .................... line |= LSENSOR << 1; |
| 03CB: MOVLW 00 |
| 03CC: BTFSC 1C.6 |
| 03CD: MOVLW 01 |
| 03CE: MOVWF 77 |
| 03CF: BCF 03.0 |
| 03D0: RLF 77,F |
| 03D1: MOVF 77,W |
| 03D2: BCF 03.5 |
| 03D3: IORWF 41,F |
| .................... if (line!=0) return; |
| 03D4: MOVF 41,F |
| 03D5: BTFSS 03.2 |
| 03D6: GOTO 4B1 |
| .................... |
| .................... n=0; |
| 03D7: CLRF 76 |
| 03D8: CLRF 75 |
| .................... switch(movement) // podivej se na druhou stranu nez se jelo |
| .................... { |
| 03D9: MOVF 45,W |
| 03DA: XORLW 02 |
| 03DB: BTFSC 03.2 |
| 03DC: GOTO 3E4 |
| 03DD: XORLW 03 |
| 03DE: BTFSC 03.2 |
| 03DF: GOTO 3F7 |
| 03E0: XORLW 02 |
| 03E1: BTFSC 03.2 |
| 03E2: GOTO 40A |
| 03E3: GOTO 421 |
| .................... case L: |
| .................... FL;BR; |
| 03E4: BSF 03.5 |
| 03E5: BCF 06.7 |
| 03E6: BCF 03.5 |
| 03E7: BCF 06.7 |
| 03E8: BSF 03.5 |
| 03E9: BCF 06.6 |
| 03EA: BCF 03.5 |
| 03EB: BSF 06.6 |
| 03EC: BSF 03.5 |
| 03ED: BCF 06.4 |
| 03EE: BCF 03.5 |
| 03EF: BCF 06.4 |
| 03F0: BSF 03.5 |
| 03F1: BCF 06.5 |
| 03F2: BCF 03.5 |
| 03F3: BSF 06.5 |
| .................... movement=R; |
| 03F4: MOVLW 01 |
| 03F5: MOVWF 45 |
| .................... break; |
| 03F6: GOTO 421 |
| .................... case R: |
| .................... FR;BL; |
| 03F7: BSF 03.5 |
| 03F8: BCF 06.5 |
| 03F9: BCF 03.5 |
| 03FA: BCF 06.5 |
| 03FB: BSF 03.5 |
| 03FC: BCF 06.4 |
| 03FD: BCF 03.5 |
| 03FE: BSF 06.4 |
| 03FF: BSF 03.5 |
| 0400: BCF 06.6 |
| 0401: BCF 03.5 |
| 0402: BCF 06.6 |
| 0403: BSF 03.5 |
| 0404: BCF 06.7 |
| 0405: BCF 03.5 |
| 0406: BSF 06.7 |
| .................... movement=L; |
| 0407: MOVLW 02 |
| 0408: MOVWF 45 |
| .................... break; |
| 0409: GOTO 421 |
| .................... case S: |
| .................... FR;BL; |
| 040A: BSF 03.5 |
| 040B: BCF 06.5 |
| 040C: BCF 03.5 |
| 040D: BCF 06.5 |
| 040E: BSF 03.5 |
| 040F: BCF 06.4 |
| 0410: BCF 03.5 |
| 0411: BSF 06.4 |
| 0412: BSF 03.5 |
| 0413: BCF 06.6 |
| 0414: BCF 03.5 |
| 0415: BCF 06.6 |
| 0416: BSF 03.5 |
| 0417: BCF 06.7 |
| 0418: BCF 03.5 |
| 0419: BSF 06.7 |
| .................... movement=L; |
| 041A: MOVLW 02 |
| 041B: MOVWF 45 |
| .................... n=CIK_CAK/2; |
| 041C: MOVLW 3A |
| 041D: MOVWF 76 |
| 041E: MOVLW 98 |
| 041F: MOVWF 75 |
| .................... break; |
| 0420: GOTO 421 |
| .................... } |
| .................... while (0==(RSENSOR|LSENSOR)) // zkontroluj caru |
| .................... { |
| 0421: MOVLW 00 |
| 0422: BSF 03.5 |
| 0423: BTFSC 1C.7 |
| 0424: MOVLW 01 |
| 0425: MOVWF 7C |
| 0426: MOVLW 00 |
| 0427: BTFSC 1C.6 |
| 0428: MOVLW 01 |
| 0429: IORWF 7C,W |
| 042A: XORLW 00 |
| 042B: BTFSS 03.2 |
| 042C: GOTO 46D |
| .................... if (n==CIK_CAK) // zmen smer zataceni |
| 042D: MOVF 75,W |
| 042E: SUBLW 30 |
| 042F: BTFSS 03.2 |
| 0430: GOTO 467 |
| 0431: MOVF 76,W |
| 0432: SUBLW 75 |
| 0433: BTFSS 03.2 |
| 0434: GOTO 467 |
| .................... { |
| .................... n=0; |
| 0435: CLRF 76 |
| 0436: CLRF 75 |
| .................... switch(movement) |
| .................... { |
| 0437: BCF 03.5 |
| 0438: MOVF 45,W |
| 0439: XORLW 02 |
| 043A: BTFSC 03.2 |
| 043B: GOTO 440 |
| 043C: XORLW 03 |
| 043D: BTFSC 03.2 |
| 043E: GOTO 453 |
| 043F: GOTO 466 |
| .................... case L: |
| .................... FL;BR; |
| 0440: BSF 03.5 |
| 0441: BCF 06.7 |
| 0442: BCF 03.5 |
| 0443: BCF 06.7 |
| 0444: BSF 03.5 |
| 0445: BCF 06.6 |
| 0446: BCF 03.5 |
| 0447: BSF 06.6 |
| 0448: BSF 03.5 |
| 0449: BCF 06.4 |
| 044A: BCF 03.5 |
| 044B: BCF 06.4 |
| 044C: BSF 03.5 |
| 044D: BCF 06.5 |
| 044E: BCF 03.5 |
| 044F: BSF 06.5 |
| .................... movement=R; |
| 0450: MOVLW 01 |
| 0451: MOVWF 45 |
| .................... break; |
| 0452: GOTO 466 |
| .................... case R: |
| .................... FR;BL; |
| 0453: BSF 03.5 |
| 0454: BCF 06.5 |
| 0455: BCF 03.5 |
| 0456: BCF 06.5 |
| 0457: BSF 03.5 |
| 0458: BCF 06.4 |
| 0459: BCF 03.5 |
| 045A: BSF 06.4 |
| 045B: BSF 03.5 |
| 045C: BCF 06.6 |
| 045D: BCF 03.5 |
| 045E: BCF 06.6 |
| 045F: BSF 03.5 |
| 0460: BCF 06.7 |
| 0461: BCF 03.5 |
| 0462: BSF 06.7 |
| .................... movement=L; |
| 0463: MOVLW 02 |
| 0464: MOVWF 45 |
| .................... break; |
| 0465: GOTO 466 |
| 0466: BSF 03.5 |
| .................... } |
| .................... } |
| .................... n++; |
| 0467: INCF 75,F |
| 0468: BTFSC 03.2 |
| 0469: INCF 76,F |
| .................... } |
| 046A: BCF 03.5 |
| 046B: GOTO 421 |
| 046C: BSF 03.5 |
| .................... switch(movement) |
| .................... { |
| 046D: BCF 03.5 |
| 046E: MOVF 45,W |
| 046F: XORLW 02 |
| 0470: BTFSC 03.2 |
| 0471: GOTO 476 |
| 0472: XORLW 03 |
| 0473: BTFSC 03.2 |
| 0474: GOTO 489 |
| 0475: GOTO 49C |
| .................... case L: |
| .................... FL;BR; |
| 0476: BSF 03.5 |
| 0477: BCF 06.7 |
| 0478: BCF 03.5 |
| 0479: BCF 06.7 |
| 047A: BSF 03.5 |
| 047B: BCF 06.6 |
| 047C: BCF 03.5 |
| 047D: BSF 06.6 |
| 047E: BSF 03.5 |
| 047F: BCF 06.4 |
| 0480: BCF 03.5 |
| 0481: BCF 06.4 |
| 0482: BSF 03.5 |
| 0483: BCF 06.5 |
| 0484: BCF 03.5 |
| 0485: BSF 06.5 |
| .................... movement=R; |
| 0486: MOVLW 01 |
| 0487: MOVWF 45 |
| .................... break; |
| 0488: GOTO 49C |
| .................... case R: |
| .................... FR;BL; |
| 0489: BSF 03.5 |
| 048A: BCF 06.5 |
| 048B: BCF 03.5 |
| 048C: BCF 06.5 |
| 048D: BSF 03.5 |
| 048E: BCF 06.4 |
| 048F: BCF 03.5 |
| 0490: BSF 06.4 |
| 0491: BSF 03.5 |
| 0492: BCF 06.6 |
| 0493: BCF 03.5 |
| 0494: BCF 06.6 |
| 0495: BSF 03.5 |
| 0496: BCF 06.7 |
| 0497: BCF 03.5 |
| 0498: BSF 06.7 |
| .................... movement=L; |
| 0499: MOVLW 02 |
| 049A: MOVWF 45 |
| .................... break; |
| 049B: GOTO 49C |
| .................... } |
| .................... Delay_ms(50); |
| 049C: MOVLW 32 |
| 049D: MOVWF 7D |
| 049E: CALL 09D |
| .................... STOPL;STOPR; // nasli jsme caru |
| 049F: BSF 03.5 |
| 04A0: BCF 06.6 |
| 04A1: BCF 03.5 |
| 04A2: BCF 06.6 |
| 04A3: BSF 03.5 |
| 04A4: BCF 06.7 |
| 04A5: BCF 03.5 |
| 04A6: BCF 06.7 |
| 04A7: BSF 03.5 |
| 04A8: BCF 06.4 |
| 04A9: BCF 03.5 |
| 04AA: BCF 06.4 |
| 04AB: BSF 03.5 |
| 04AC: BCF 06.5 |
| 04AD: BCF 03.5 |
| 04AE: BCF 06.5 |
| .................... line=S; |
| 04AF: MOVLW 03 |
| 04B0: MOVWF 41 |
| .................... } |
| 04B1: RETLW 00 |
| .................... /////////////////////////////////////////////////////////////////////////////// |
| .................... void objizdka() // objede cihlu |
| .................... { |
| .................... unsigned int16 n; |
| .................... |
| .................... BL;BR;Delay_ms(200); |
| 04B2: BSF 03.5 |
| 04B3: BCF 06.6 |
| 04B4: BCF 03.5 |
| 04B5: BCF 06.6 |
| 04B6: BSF 03.5 |
| 04B7: BCF 06.7 |
| 04B8: BCF 03.5 |
| 04B9: BSF 06.7 |
| 04BA: BSF 03.5 |
| 04BB: BCF 06.4 |
| 04BC: BCF 03.5 |
| 04BD: BCF 06.4 |
| 04BE: BSF 03.5 |
| 04BF: BCF 06.5 |
| 04C0: BCF 03.5 |
| 04C1: BSF 06.5 |
| 04C2: MOVLW C8 |
| 04C3: MOVWF 7D |
| 04C4: CALL 09D |
| .................... STOPR;STOPL; |
| 04C5: BSF 03.5 |
| 04C6: BCF 06.4 |
| 04C7: BCF 03.5 |
| 04C8: BCF 06.4 |
| 04C9: BSF 03.5 |
| 04CA: BCF 06.5 |
| 04CB: BCF 03.5 |
| 04CC: BCF 06.5 |
| 04CD: BSF 03.5 |
| 04CE: BCF 06.6 |
| 04CF: BCF 03.5 |
| 04D0: BCF 06.6 |
| 04D1: BSF 03.5 |
| 04D2: BCF 06.7 |
| 04D3: BCF 03.5 |
| 04D4: BCF 06.7 |
| .................... beep(900,1000); |
| 04D5: MOVLW 03 |
| 04D6: MOVWF 7D |
| 04D7: MOVLW 84 |
| 04D8: MOVWF 7C |
| 04D9: MOVLW 03 |
| 04DA: BSF 03.5 |
| 04DB: MOVWF 21 |
| 04DC: MOVLW E8 |
| 04DD: MOVWF 20 |
| 04DE: BCF 03.5 |
| 04DF: CALL 071 |
| .................... movement=S; |
| 04E0: MOVLW 03 |
| 04E1: MOVWF 45 |
| .................... cikcak(); |
| 04E2: CALL 3C4 |
| .................... |
| .................... BR; FL; Delay_ms(215); // otoc se 70° do prava |
| 04E3: BSF 03.5 |
| 04E4: BCF 06.4 |
| 04E5: BCF 03.5 |
| 04E6: BCF 06.4 |
| 04E7: BSF 03.5 |
| 04E8: BCF 06.5 |
| 04E9: BCF 03.5 |
| 04EA: BSF 06.5 |
| 04EB: BSF 03.5 |
| 04EC: BCF 06.7 |
| 04ED: BCF 03.5 |
| 04EE: BCF 06.7 |
| 04EF: BSF 03.5 |
| 04F0: BCF 06.6 |
| 04F1: BCF 03.5 |
| 04F2: BSF 06.6 |
| 04F3: MOVLW D7 |
| 04F4: MOVWF 7D |
| 04F5: CALL 09D |
| .................... |
| .................... FR; FL; Delay_ms(600); // popojed rovne |
| 04F6: BSF 03.5 |
| 04F7: BCF 06.5 |
| 04F8: BCF 03.5 |
| 04F9: BCF 06.5 |
| 04FA: BSF 03.5 |
| 04FB: BCF 06.4 |
| 04FC: BCF 03.5 |
| 04FD: BSF 06.4 |
| 04FE: BSF 03.5 |
| 04FF: BCF 06.7 |
| 0500: BCF 03.5 |
| 0501: BCF 06.7 |
| 0502: BSF 03.5 |
| 0503: BCF 06.6 |
| 0504: BCF 03.5 |
| 0505: BSF 06.6 |
| 0506: MOVLW 03 |
| 0507: MOVWF 75 |
| 0508: MOVLW C8 |
| 0509: MOVWF 7D |
| 050A: CALL 09D |
| 050B: DECFSZ 75,F |
| 050C: GOTO 508 |
| .................... |
| .................... BL; Delay_ms(50); // otoc se 90° do leva |
| 050D: BSF 03.5 |
| 050E: BCF 06.6 |
| 050F: BCF 03.5 |
| 0510: BCF 06.6 |
| 0511: BSF 03.5 |
| 0512: BCF 06.7 |
| 0513: BCF 03.5 |
| 0514: BSF 06.7 |
| 0515: MOVLW 32 |
| 0516: MOVWF 7D |
| 0517: CALL 09D |
| .................... STOPL; FR; Delay_ms(550); |
| 0518: BSF 03.5 |
| 0519: BCF 06.6 |
| 051A: BCF 03.5 |
| 051B: BCF 06.6 |
| 051C: BSF 03.5 |
| 051D: BCF 06.7 |
| 051E: BCF 03.5 |
| 051F: BCF 06.7 |
| 0520: BSF 03.5 |
| 0521: BCF 06.5 |
| 0522: BCF 03.5 |
| 0523: BCF 06.5 |
| 0524: BSF 03.5 |
| 0525: BCF 06.4 |
| 0526: BCF 03.5 |
| 0527: BSF 06.4 |
| 0528: MOVLW 05 |
| 0529: MOVWF 75 |
| 052A: MOVLW 6E |
| 052B: MOVWF 7D |
| 052C: CALL 09D |
| 052D: DECFSZ 75,F |
| 052E: GOTO 52A |
| .................... |
| .................... FR; FL; Delay_ms(100); // popojed rovne na slepo |
| 052F: BSF 03.5 |
| 0530: BCF 06.5 |
| 0531: BCF 03.5 |
| 0532: BCF 06.5 |
| 0533: BSF 03.5 |
| 0534: BCF 06.4 |
| 0535: BCF 03.5 |
| 0536: BSF 06.4 |
| 0537: BSF 03.5 |
| 0538: BCF 06.7 |
| 0539: BCF 03.5 |
| 053A: BCF 06.7 |
| 053B: BSF 03.5 |
| 053C: BCF 06.6 |
| 053D: BCF 03.5 |
| 053E: BSF 06.6 |
| 053F: MOVLW 64 |
| 0540: MOVWF 7D |
| 0541: CALL 09D |
| .................... for(n=600;n>0;n--) // popojed rovne ale kontroluj caru |
| 0542: MOVLW 02 |
| 0543: MOVWF 74 |
| 0544: MOVLW 58 |
| 0545: MOVWF 73 |
| 0546: MOVF 73,F |
| 0547: BTFSS 03.2 |
| 0548: GOTO 54C |
| 0549: MOVF 74,F |
| 054A: BTFSC 03.2 |
| 054B: GOTO 56B |
| .................... { |
| .................... line = RSENSOR; // cteni senzoru na caru |
| 054C: CLRF 41 |
| 054D: BSF 03.5 |
| 054E: BTFSS 1C.7 |
| 054F: GOTO 553 |
| 0550: BCF 03.5 |
| 0551: INCF 41,F |
| 0552: BSF 03.5 |
| .................... line |= LSENSOR << 1; |
| 0553: MOVLW 00 |
| 0554: BTFSC 1C.6 |
| 0555: MOVLW 01 |
| 0556: MOVWF 77 |
| 0557: BCF 03.0 |
| 0558: RLF 77,F |
| 0559: MOVF 77,W |
| 055A: BCF 03.5 |
| 055B: IORWF 41,F |
| .................... if (line!=0) {Delay_ms(50); break;} |
| 055C: MOVF 41,F |
| 055D: BTFSC 03.2 |
| 055E: GOTO 563 |
| 055F: MOVLW 32 |
| 0560: MOVWF 7D |
| 0561: CALL 09D |
| 0562: GOTO 56B |
| .................... Delay_ms(1); |
| 0563: MOVLW 01 |
| 0564: MOVWF 7D |
| 0565: CALL 09D |
| .................... } |
| 0566: MOVF 73,W |
| 0567: BTFSC 03.2 |
| 0568: DECF 74,F |
| 0569: DECF 73,F |
| 056A: GOTO 546 |
| .................... |
| .................... BR; // otoc se 60° do prava |
| 056B: BSF 03.5 |
| 056C: BCF 06.4 |
| 056D: BCF 03.5 |
| 056E: BCF 06.4 |
| 056F: BSF 03.5 |
| 0570: BCF 06.5 |
| 0571: BCF 03.5 |
| 0572: BSF 06.5 |
| .................... for(n=600;n>0;n--) |
| 0573: MOVLW 02 |
| 0574: MOVWF 74 |
| 0575: MOVLW 58 |
| 0576: MOVWF 73 |
| 0577: MOVF 73,F |
| 0578: BTFSS 03.2 |
| 0579: GOTO 57D |
| 057A: MOVF 74,F |
| 057B: BTFSC 03.2 |
| 057C: GOTO 598 |
| .................... { |
| .................... line = RSENSOR; // cteni senzoru na caru |
| 057D: CLRF 41 |
| 057E: BSF 03.5 |
| 057F: BTFSS 1C.7 |
| 0580: GOTO 584 |
| 0581: BCF 03.5 |
| 0582: INCF 41,F |
| 0583: BSF 03.5 |
| .................... line |= LSENSOR << 1; |
| 0584: MOVLW 00 |
| 0585: BTFSC 1C.6 |
| 0586: MOVLW 01 |
| 0587: MOVWF 77 |
| 0588: BCF 03.0 |
| 0589: RLF 77,F |
| 058A: MOVF 77,W |
| 058B: BCF 03.5 |
| 058C: IORWF 41,F |
| .................... if (line!=0) break; |
| 058D: MOVF 41,F |
| 058E: BTFSS 03.2 |
| 058F: GOTO 598 |
| .................... Delay_ms(1); |
| 0590: MOVLW 01 |
| 0591: MOVWF 7D |
| 0592: CALL 09D |
| .................... } |
| 0593: MOVF 73,W |
| 0594: BTFSC 03.2 |
| 0595: DECF 74,F |
| 0596: DECF 73,F |
| 0597: GOTO 577 |
| .................... STOPR; STOPL; |
| 0598: BSF 03.5 |
| 0599: BCF 06.4 |
| 059A: BCF 03.5 |
| 059B: BCF 06.4 |
| 059C: BSF 03.5 |
| 059D: BCF 06.5 |
| 059E: BCF 03.5 |
| 059F: BCF 06.5 |
| 05A0: BSF 03.5 |
| 05A1: BCF 06.6 |
| 05A2: BCF 03.5 |
| 05A3: BCF 06.6 |
| 05A4: BSF 03.5 |
| 05A5: BCF 06.7 |
| 05A6: BCF 03.5 |
| 05A7: BCF 06.7 |
| .................... |
| .................... movement=R; |
| 05A8: MOVLW 01 |
| 05A9: MOVWF 45 |
| .................... cikcak(); |
| 05AA: CALL 3C4 |
| .................... cihla=T_DIRA; |
| 05AB: MOVLW 55 |
| 05AC: MOVWF 47 |
| .................... dira=0; |
| 05AD: CLRF 46 |
| .................... } |
| 05AE: BSF 0A.3 |
| 05AF: GOTO 0F7 (RETURN) |
| .................... /////////////////////////////////////////////////////////////////////////////// |
| .................... void prejeddiru() // vyresi diru |
| .................... { |
| .................... unsigned int16 n; |
| .................... |
| .................... STOPL;STOPR; |
| 05B0: BSF 03.5 |
| 05B1: BCF 06.6 |
| 05B2: BCF 03.5 |
| 05B3: BCF 06.6 |
| 05B4: BSF 03.5 |
| 05B5: BCF 06.7 |
| 05B6: BCF 03.5 |
| 05B7: BCF 06.7 |
| 05B8: BSF 03.5 |
| 05B9: BCF 06.4 |
| 05BA: BCF 03.5 |
| 05BB: BCF 06.4 |
| 05BC: BSF 03.5 |
| 05BD: BCF 06.5 |
| 05BE: BCF 03.5 |
| 05BF: BCF 06.5 |
| .................... beep(800,500); |
| 05C0: MOVLW 03 |
| 05C1: MOVWF 7D |
| 05C2: MOVLW 20 |
| 05C3: MOVWF 7C |
| 05C4: MOVLW 01 |
| 05C5: BSF 03.5 |
| 05C6: MOVWF 21 |
| 05C7: MOVLW F4 |
| 05C8: MOVWF 20 |
| 05C9: BCF 03.5 |
| 05CA: CALL 071 |
| .................... switch (movement) //vrat se zpet na caru |
| .................... { |
| 05CB: MOVF 45,W |
| 05CC: XORLW 02 |
| 05CD: BTFSC 03.2 |
| 05CE: GOTO 5D6 |
| 05CF: XORLW 03 |
| 05D0: BTFSC 03.2 |
| 05D1: GOTO 60E |
| 05D2: XORLW 02 |
| 05D3: BTFSC 03.2 |
| 05D4: GOTO 646 |
| 05D5: GOTO 648 |
| .................... case L: |
| .................... for (n=COUVANI;n>0;n--) {GO(R,B,speed); Delay_ms(1);} |
| 05D6: MOVLW 02 |
| 05D7: MOVWF 74 |
| 05D8: MOVLW 8A |
| 05D9: MOVWF 73 |
| 05DA: MOVF 73,F |
| 05DB: BTFSS 03.2 |
| 05DC: GOTO 5E0 |
| 05DD: MOVF 74,F |
| 05DE: BTFSC 03.2 |
| 05DF: GOTO 5FD |
| 05E0: MOVF 01,W |
| 05E1: SUBWF 42,W |
| 05E2: BTFSS 03.0 |
| 05E3: GOTO 5ED |
| 05E4: BSF 03.5 |
| 05E5: BCF 06.4 |
| 05E6: BCF 03.5 |
| 05E7: BCF 06.4 |
| 05E8: BSF 03.5 |
| 05E9: BCF 06.5 |
| 05EA: BCF 03.5 |
| 05EB: BSF 06.5 |
| 05EC: GOTO 5F5 |
| 05ED: BSF 03.5 |
| 05EE: BCF 06.4 |
| 05EF: BCF 03.5 |
| 05F0: BCF 06.4 |
| 05F1: BSF 03.5 |
| 05F2: BCF 06.5 |
| 05F3: BCF 03.5 |
| 05F4: BCF 06.5 |
| 05F5: MOVLW 01 |
| 05F6: MOVWF 7D |
| 05F7: CALL 09D |
| 05F8: MOVF 73,W |
| 05F9: BTFSC 03.2 |
| 05FA: DECF 74,F |
| 05FB: DECF 73,F |
| 05FC: GOTO 5DA |
| .................... STOPL;STOPR; |
| 05FD: BSF 03.5 |
| 05FE: BCF 06.6 |
| 05FF: BCF 03.5 |
| 0600: BCF 06.6 |
| 0601: BSF 03.5 |
| 0602: BCF 06.7 |
| 0603: BCF 03.5 |
| 0604: BCF 06.7 |
| 0605: BSF 03.5 |
| 0606: BCF 06.4 |
| 0607: BCF 03.5 |
| 0608: BCF 06.4 |
| 0609: BSF 03.5 |
| 060A: BCF 06.5 |
| 060B: BCF 03.5 |
| 060C: BCF 06.5 |
| .................... break; |
| 060D: GOTO 648 |
| .................... case R: |
| .................... for (n=COUVANI;n>0;n--) {GO(L,B,speed); Delay_ms(1);} |
| 060E: MOVLW 02 |
| 060F: MOVWF 74 |
| 0610: MOVLW 8A |
| 0611: MOVWF 73 |
| 0612: MOVF 73,F |
| 0613: BTFSS 03.2 |
| 0614: GOTO 618 |
| 0615: MOVF 74,F |
| 0616: BTFSC 03.2 |
| 0617: GOTO 635 |
| 0618: MOVF 01,W |
| 0619: SUBWF 42,W |
| 061A: BTFSS 03.0 |
| 061B: GOTO 625 |
| 061C: BSF 03.5 |
| 061D: BCF 06.6 |
| 061E: BCF 03.5 |
| 061F: BCF 06.6 |
| 0620: BSF 03.5 |
| 0621: BCF 06.7 |
| 0622: BCF 03.5 |
| 0623: BSF 06.7 |
| 0624: GOTO 62D |
| 0625: BSF 03.5 |
| 0626: BCF 06.6 |
| 0627: BCF 03.5 |
| 0628: BCF 06.6 |
| 0629: BSF 03.5 |
| 062A: BCF 06.7 |
| 062B: BCF 03.5 |
| 062C: BCF 06.7 |
| 062D: MOVLW 01 |
| 062E: MOVWF 7D |
| 062F: CALL 09D |
| 0630: MOVF 73,W |
| 0631: BTFSC 03.2 |
| 0632: DECF 74,F |
| 0633: DECF 73,F |
| 0634: GOTO 612 |
| .................... STOPL;STOPR; |
| 0635: BSF 03.5 |
| 0636: BCF 06.6 |
| 0637: BCF 03.5 |
| 0638: BCF 06.6 |
| 0639: BSF 03.5 |
| 063A: BCF 06.7 |
| 063B: BCF 03.5 |
| 063C: BCF 06.7 |
| 063D: BSF 03.5 |
| 063E: BCF 06.4 |
| 063F: BCF 03.5 |
| 0640: BCF 06.4 |
| 0641: BSF 03.5 |
| 0642: BCF 06.5 |
| 0643: BCF 03.5 |
| 0644: BCF 06.5 |
| .................... break; |
| 0645: GOTO 648 |
| .................... case S: |
| .................... goto sem; |
| 0646: GOTO 66A |
| .................... break; |
| 0647: GOTO 648 |
| .................... } |
| .................... beep(800,500); |
| 0648: MOVLW 03 |
| 0649: MOVWF 7D |
| 064A: MOVLW 20 |
| 064B: MOVWF 7C |
| 064C: MOVLW 01 |
| 064D: BSF 03.5 |
| 064E: MOVWF 21 |
| 064F: MOVLW F4 |
| 0650: MOVWF 20 |
| 0651: BCF 03.5 |
| 0652: CALL 071 |
| .................... FR;FL; Delay_ms(PRES_DIRU); // popojedem dopredu mozna tam bude cara |
| 0653: BSF 03.5 |
| 0654: BCF 06.5 |
| 0655: BCF 03.5 |
| 0656: BCF 06.5 |
| 0657: BSF 03.5 |
| 0658: BCF 06.4 |
| 0659: BCF 03.5 |
| 065A: BSF 06.4 |
| 065B: BSF 03.5 |
| 065C: BCF 06.7 |
| 065D: BCF 03.5 |
| 065E: BCF 06.7 |
| 065F: BSF 03.5 |
| 0660: BCF 06.6 |
| 0661: BCF 03.5 |
| 0662: BSF 06.6 |
| 0663: MOVLW 02 |
| 0664: MOVWF 75 |
| 0665: MOVLW AF |
| 0666: MOVWF 7D |
| 0667: CALL 09D |
| 0668: DECFSZ 75,F |
| 0669: GOTO 665 |
| .................... sem: |
| .................... STOPL; STOPR; |
| 066A: BSF 03.5 |
| 066B: BCF 06.6 |
| 066C: BCF 03.5 |
| 066D: BCF 06.6 |
| 066E: BSF 03.5 |
| 066F: BCF 06.7 |
| 0670: BCF 03.5 |
| 0671: BCF 06.7 |
| 0672: BSF 03.5 |
| 0673: BCF 06.4 |
| 0674: BCF 03.5 |
| 0675: BCF 06.4 |
| 0676: BSF 03.5 |
| 0677: BCF 06.5 |
| 0678: BCF 03.5 |
| 0679: BCF 06.5 |
| .................... movement=S; |
| 067A: MOVLW 03 |
| 067B: MOVWF 45 |
| .................... cikcak(); // najdi caru |
| 067C: CALL 3C4 |
| .................... cihla=T_DIRA; |
| 067D: MOVLW 55 |
| 067E: MOVWF 47 |
| .................... dira=0; |
| 067F: CLRF 46 |
| .................... } |
| 0680: BSF 0A.3 |
| 0681: GOTO 190 (RETURN) |
| .................... /////////////////////////////////////////////////////////////////////////////// |
| .................... void main() |
| .................... { |
| * |
| 0800: CLRF 04 |
| 0801: MOVLW 1F |
| 0802: ANDWF 03,F |
| 0803: BSF 03.5 |
| 0804: BCF 1F.4 |
| 0805: BCF 1F.5 |
| 0806: MOVF 1B,W |
| 0807: ANDLW 80 |
| 0808: MOVWF 1B |
| 0809: MOVLW 07 |
| 080A: MOVWF 1C |
| 080B: MOVF 1C,W |
| 080C: BCF 03.5 |
| 080D: BCF 0D.6 |
| 080E: MOVLW 60 |
| 080F: BSF 03.5 |
| 0810: MOVWF 0F |
| .................... unsigned int16 n; // pro FOR |
| .................... |
| .................... STOPL; STOPR; // prepne vystupy na ovladani motoru na output a zastavi |
| * |
| 082E: BSF 03.5 |
| 082F: BCF 06.6 |
| 0830: BCF 03.5 |
| 0831: BCF 06.6 |
| 0832: BSF 03.5 |
| 0833: BCF 06.7 |
| 0834: BCF 03.5 |
| 0835: BCF 06.7 |
| 0836: BSF 03.5 |
| 0837: BCF 06.4 |
| 0838: BCF 03.5 |
| 0839: BCF 06.4 |
| 083A: BSF 03.5 |
| 083B: BCF 06.5 |
| 083C: BCF 03.5 |
| 083D: BCF 06.5 |
| .................... |
| .................... setup_oscillator(OSC_4MHZ|OSC_INTRC); // 4 MHz interni RC oscilator |
| 083E: MOVLW 62 |
| 083F: BSF 03.5 |
| 0840: MOVWF 0F |
| .................... |
| .................... port_b_pullups(TRUE); // pullups pro piano na diagnostiku |
| 0841: BCF 01.7 |
| .................... setup_spi(FALSE); |
| 0842: BCF 03.5 |
| 0843: BCF 14.5 |
| 0844: BSF 03.5 |
| 0845: BCF 06.2 |
| 0846: BSF 06.1 |
| 0847: BCF 06.4 |
| 0848: MOVLW 00 |
| 0849: BCF 03.5 |
| 084A: MOVWF 14 |
| 084B: BSF 03.5 |
| 084C: MOVWF 14 |
| .................... setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1); // Casovac pro PWM |
| 084D: MOVF 01,W |
| 084E: ANDLW C7 |
| 084F: IORLW 08 |
| 0850: MOVWF 01 |
| .................... |
| .................... setup_timer_2(T2_DIV_BY_4,255,10); // Casovac pro regulaci |
| 0851: MOVLW 48 |
| 0852: MOVWF 78 |
| 0853: IORLW 05 |
| 0854: BCF 03.5 |
| 0855: MOVWF 12 |
| 0856: MOVLW FF |
| 0857: BSF 03.5 |
| 0858: MOVWF 12 |
| .................... // preruseni kazdych 10ms |
| .................... setup_adc_ports(sAN2|VSS_VDD); // nastaveni A/D prevodniku pro naraznik |
| 0859: BCF 1F.4 |
| 085A: BCF 1F.5 |
| 085B: MOVF 1B,W |
| 085C: ANDLW 80 |
| 085D: IORLW 04 |
| 085E: MOVWF 1B |
| .................... setup_adc(ADC_CLOCK_INTERNAL); |
| 085F: BCF 1F.6 |
| 0860: BCF 03.5 |
| 0861: BSF 1F.6 |
| 0862: BSF 1F.7 |
| 0863: BSF 03.5 |
| 0864: BCF 1F.7 |
| 0865: BCF 03.5 |
| 0866: BSF 1F.0 |
| .................... set_adc_channel(2); |
| 0867: MOVLW 10 |
| 0868: MOVWF 78 |
| 0869: MOVF 1F,W |
| 086A: ANDLW C7 |
| 086B: IORWF 78,W |
| 086C: MOVWF 1F |
| .................... setup_timer_1(T1_INTERNAL|T1_DIV_BY_1); // Casovac pro naraznik |
| 086D: MOVLW 85 |
| 086E: MOVWF 10 |
| .................... setup_ccp1(CCP_COMPARE_RESET_TIMER); |
| 086F: BSF 03.5 |
| 0870: BSF 06.3 |
| 0871: MOVLW 0B |
| 0872: BCF 03.5 |
| 0873: MOVWF 17 |
| .................... CCP_1=(2^10)-1; // prevod kazdou 1ms |
| 0874: CLRF 16 |
| 0875: MOVLW 07 |
| 0876: MOVWF 15 |
| .................... |
| .................... setup_comparator(A0_VR_A1_VR); // inicializace komparatoru pro cidla cary |
| 0877: MOVLW 02 |
| 0878: BSF 03.5 |
| 0879: MOVWF 1C |
| 087A: MOVF 05,W |
| 087B: IORLW 03 |
| 087C: MOVWF 05 |
| 087D: MOVLW 03 |
| 087E: MOVWF 77 |
| 087F: DECFSZ 77,F |
| 0880: GOTO 07F |
| 0881: MOVF 1C,W |
| 0882: BCF 03.5 |
| 0883: BCF 0D.6 |
| .................... setup_vref(VREF_HIGH|TRESHOLD); // 32 kroku od 0.25 do 0.75 Vdd |
| 0884: MOVLW 8A |
| 0885: BSF 03.5 |
| 0886: MOVWF 1D |
| .................... |
| .................... Beep(1000,200); //double beep |
| 0887: MOVLW 03 |
| 0888: MOVWF 7D |
| 0889: MOVLW E8 |
| 088A: MOVWF 7C |
| 088B: CLRF 21 |
| 088C: MOVLW C8 |
| 088D: MOVWF 20 |
| 088E: BCF 0A.3 |
| 088F: BCF 03.5 |
| 0890: CALL 071 |
| 0891: BSF 0A.3 |
| .................... Delay_ms(50); |
| 0892: MOVLW 32 |
| 0893: MOVWF 7D |
| 0894: BCF 0A.3 |
| 0895: CALL 09D |
| 0896: BSF 0A.3 |
| .................... Beep(1000,200); |
| 0897: MOVLW 03 |
| 0898: MOVWF 7D |
| 0899: MOVLW E8 |
| 089A: MOVWF 7C |
| 089B: BSF 03.5 |
| 089C: CLRF 21 |
| 089D: MOVLW C8 |
| 089E: MOVWF 20 |
| 089F: BCF 0A.3 |
| 08A0: BCF 03.5 |
| 08A1: CALL 071 |
| 08A2: BSF 0A.3 |
| .................... Delay_ms(1000); // 1s |
| 08A3: MOVLW 04 |
| 08A4: MOVWF 73 |
| 08A5: MOVLW FA |
| 08A6: MOVWF 7D |
| 08A7: BCF 0A.3 |
| 08A8: CALL 09D |
| 08A9: BSF 0A.3 |
| 08AA: DECFSZ 73,F |
| 08AB: GOTO 0A5 |
| .................... |
| .................... // povoleni rizeni rychlosti zataceni pres preruseni |
| .................... enable_interrupts(INT_TIMER2); |
| 08AC: BSF 03.5 |
| 08AD: BSF 0C.1 |
| .................... enable_interrupts(GLOBAL); |
| 08AE: MOVLW C0 |
| 08AF: BCF 03.5 |
| 08B0: IORWF 0B,F |
| .................... |
| .................... /*---------------------------------------------------------------------------*/ |
| .................... sensors=S; |
| 08B1: MOVLW 03 |
| 08B2: MOVWF 40 |
| .................... line=S; |
| 08B3: MOVWF 41 |
| .................... last=S; |
| 08B4: MOVWF 44 |
| .................... movement=S; |
| 08B5: MOVWF 45 |
| .................... speed=FW_POMALU; |
| 08B6: MOVLW E6 |
| 08B7: MOVWF 42 |
| .................... |
| .................... diagnostika(); |
| 08B8: BCF 0A.3 |
| 08B9: GOTO 1D1 |
| 08BA: BSF 0A.3 |
| .................... cikcak(); // toc se, abys nasel caru |
| 08BB: BCF 0A.3 |
| 08BC: CALL 3C4 |
| 08BD: BSF 0A.3 |
| .................... Delay_ms(500); |
| 08BE: MOVLW 02 |
| 08BF: MOVWF 73 |
| 08C0: MOVLW FA |
| 08C1: MOVWF 7D |
| 08C2: BCF 0A.3 |
| 08C3: CALL 09D |
| 08C4: BSF 0A.3 |
| 08C5: DECFSZ 73,F |
| 08C6: GOTO 0C0 |
| .................... Beep(1000,200); |
| 08C7: MOVLW 03 |
| 08C8: MOVWF 7D |
| 08C9: MOVLW E8 |
| 08CA: MOVWF 7C |
| 08CB: BSF 03.5 |
| 08CC: CLRF 21 |
| 08CD: MOVLW C8 |
| 08CE: MOVWF 20 |
| 08CF: BCF 0A.3 |
| 08D0: BCF 03.5 |
| 08D1: CALL 071 |
| 08D2: BSF 0A.3 |
| .................... Delay_ms(500); |
| 08D3: MOVLW 02 |
| 08D4: MOVWF 73 |
| 08D5: MOVLW FA |
| 08D6: MOVWF 7D |
| 08D7: BCF 0A.3 |
| 08D8: CALL 09D |
| 08D9: BSF 0A.3 |
| 08DA: DECFSZ 73,F |
| 08DB: GOTO 0D5 |
| .................... |
| .................... while(true) // hlavni smycka (jizda podle cary) |
| .................... { |
| .................... sensors = RSENSOR; // cteni senzoru na caru |
| 08DC: CLRF 40 |
| 08DD: BSF 03.5 |
| 08DE: BTFSS 1C.7 |
| 08DF: GOTO 0E3 |
| 08E0: BCF 03.5 |
| 08E1: INCF 40,F |
| 08E2: BSF 03.5 |
| .................... sensors |= LSENSOR << 1; |
| 08E3: MOVLW 00 |
| 08E4: BTFSC 1C.6 |
| 08E5: MOVLW 01 |
| 08E6: MOVWF 77 |
| 08E7: BCF 03.0 |
| 08E8: RLF 77,F |
| 08E9: MOVF 77,W |
| 08EA: BCF 03.5 |
| 08EB: IORWF 40,F |
| .................... |
| .................... if ((read_adc(ADC_READ_ONLY)<BUMPER_TRESHOLD) && (cihla==0)) objizdka(); |
| 08EC: BTFSC 1F.2 |
| 08ED: GOTO 0EC |
| 08EE: MOVF 1E,W |
| 08EF: SUBLW 7F |
| 08F0: BTFSS 03.0 |
| 08F1: GOTO 0F8 |
| 08F2: MOVF 47,F |
| 08F3: BTFSS 03.2 |
| 08F4: GOTO 0F8 |
| 08F5: BCF 0A.3 |
| 08F6: GOTO 4B2 |
| 08F7: BSF 0A.3 |
| .................... |
| .................... switch (sensors) // zatacej podle toho, kde vidis caru |
| .................... { |
| 08F8: MOVF 40,W |
| 08F9: XORLW 03 |
| 08FA: BTFSC 03.2 |
| 08FB: GOTO 103 |
| 08FC: XORLW 01 |
| 08FD: BTFSC 03.2 |
| 08FE: GOTO 117 |
| 08FF: XORLW 03 |
| 0900: BTFSC 03.2 |
| 0901: GOTO 150 |
| 0902: GOTO 189 |
| .................... case S: // rovne |
| .................... FL; FR; // pokud se jede dlouho rovne, tak pridej |
| 0903: BSF 03.5 |
| 0904: BCF 06.7 |
| 0905: BCF 03.5 |
| 0906: BCF 06.7 |
| 0907: BSF 03.5 |
| 0908: BCF 06.6 |
| 0909: BCF 03.5 |
| 090A: BSF 06.6 |
| 090B: BSF 03.5 |
| 090C: BCF 06.5 |
| 090D: BCF 03.5 |
| 090E: BCF 06.5 |
| 090F: BSF 03.5 |
| 0910: BCF 06.4 |
| 0911: BCF 03.5 |
| 0912: BSF 06.4 |
| .................... dira=0; |
| 0913: CLRF 46 |
| .................... movement=S; |
| 0914: MOVLW 03 |
| 0915: MOVWF 45 |
| .................... continue; |
| 0916: GOTO 0DC |
| .................... case L: // trochu vlevo |
| .................... GO(L, F, FW_POMALU+rovinka); GO(R, F, FW_STREDNE+rovinka); |
| 0917: MOVF 01,W |
| 0918: MOVWF 73 |
| 0919: MOVLW E6 |
| 091A: ADDWF 43,W |
| 091B: SUBWF 73,W |
| 091C: BTFSC 03.2 |
| 091D: GOTO 120 |
| 091E: BTFSC 03.0 |
| 091F: GOTO 129 |
| 0920: BSF 03.5 |
| 0921: BCF 06.7 |
| 0922: BCF 03.5 |
| 0923: BCF 06.7 |
| 0924: BSF 03.5 |
| 0925: BCF 06.6 |
| 0926: BCF 03.5 |
| 0927: BSF 06.6 |
| 0928: GOTO 131 |
| 0929: BSF 03.5 |
| 092A: BCF 06.6 |
| 092B: BCF 03.5 |
| 092C: BCF 06.6 |
| 092D: BSF 03.5 |
| 092E: BCF 06.7 |
| 092F: BCF 03.5 |
| 0930: BCF 06.7 |
| 0931: MOVF 01,W |
| 0932: MOVWF 73 |
| 0933: MOVLW F0 |
| 0934: ADDWF 43,W |
| 0935: SUBWF 73,W |
| 0936: BTFSC 03.2 |
| 0937: GOTO 13A |
| 0938: BTFSC 03.0 |
| 0939: GOTO 143 |
| 093A: BSF 03.5 |
| 093B: BCF 06.5 |
| 093C: BCF 03.5 |
| 093D: BCF 06.5 |
| 093E: BSF 03.5 |
| 093F: BCF 06.4 |
| 0940: BCF 03.5 |
| 0941: BSF 06.4 |
| 0942: GOTO 14B |
| 0943: BSF 03.5 |
| 0944: BCF 06.4 |
| 0945: BCF 03.5 |
| 0946: BCF 06.4 |
| 0947: BSF 03.5 |
| 0948: BCF 06.5 |
| 0949: BCF 03.5 |
| 094A: BCF 06.5 |
| .................... line=L; |
| 094B: MOVLW 02 |
| 094C: MOVWF 41 |
| .................... dira=0; |
| 094D: CLRF 46 |
| .................... movement=L; |
| 094E: MOVWF 45 |
| .................... continue; |
| 094F: GOTO 0DC |
| .................... case R: // trochu vpravo |
| .................... GO(R, F, FW_POMALU+rovinka); GO(L, F, FW_STREDNE+rovinka); |
| 0950: MOVF 01,W |
| 0951: MOVWF 73 |
| 0952: MOVLW E6 |
| 0953: ADDWF 43,W |
| 0954: SUBWF 73,W |
| 0955: BTFSC 03.2 |
| 0956: GOTO 159 |
| 0957: BTFSC 03.0 |
| 0958: GOTO 162 |
| 0959: BSF 03.5 |
| 095A: BCF 06.5 |
| 095B: BCF 03.5 |
| 095C: BCF 06.5 |
| 095D: BSF 03.5 |
| 095E: BCF 06.4 |
| 095F: BCF 03.5 |
| 0960: BSF 06.4 |
| 0961: GOTO 16A |
| 0962: BSF 03.5 |
| 0963: BCF 06.4 |
| 0964: BCF 03.5 |
| 0965: BCF 06.4 |
| 0966: BSF 03.5 |
| 0967: BCF 06.5 |
| 0968: BCF 03.5 |
| 0969: BCF 06.5 |
| 096A: MOVF 01,W |
| 096B: MOVWF 73 |
| 096C: MOVLW F0 |
| 096D: ADDWF 43,W |
| 096E: SUBWF 73,W |
| 096F: BTFSC 03.2 |
| 0970: GOTO 173 |
| 0971: BTFSC 03.0 |
| 0972: GOTO 17C |
| 0973: BSF 03.5 |
| 0974: BCF 06.7 |
| 0975: BCF 03.5 |
| 0976: BCF 06.7 |
| 0977: BSF 03.5 |
| 0978: BCF 06.6 |
| 0979: BCF 03.5 |
| 097A: BSF 06.6 |
| 097B: GOTO 184 |
| 097C: BSF 03.5 |
| 097D: BCF 06.6 |
| 097E: BCF 03.5 |
| 097F: BCF 06.6 |
| 0980: BSF 03.5 |
| 0981: BCF 06.7 |
| 0982: BCF 03.5 |
| 0983: BCF 06.7 |
| .................... line=R; |
| 0984: MOVLW 01 |
| 0985: MOVWF 41 |
| .................... dira=0; |
| 0986: CLRF 46 |
| .................... movement=R; |
| 0987: MOVWF 45 |
| .................... continue; |
| 0988: GOTO 0DC |
| .................... default: // kdyz jsou obe cidla mimo caru, tak pokracuj dal |
| .................... } |
| .................... rovinka=0; |
| 0989: CLRF 43 |
| .................... if (dira>=T_DIRA) prejeddiru(); |
| 098A: MOVF 46,W |
| 098B: SUBLW 54 |
| 098C: BTFSC 03.0 |
| 098D: GOTO 191 |
| 098E: BCF 0A.3 |
| 098F: GOTO 5B0 |
| 0990: BSF 0A.3 |
| .................... if (last!=line) // pokud si prejel caru z jedne strany na druhou stranu, tak zabrzdi |
| 0991: MOVF 41,W |
| 0992: SUBWF 44,W |
| 0993: BTFSC 03.2 |
| 0994: GOTO 199 |
| .................... { |
| .................... last=line; |
| 0995: MOVF 41,W |
| 0996: MOVWF 44 |
| .................... speed=FW_ZATACKA; |
| 0997: MOVLW C8 |
| 0998: MOVWF 42 |
| .................... } |
| .................... if (L==line) // kdyz jsou obe cidla mimo caru, zatoc na caru |
| 0999: MOVF 41,W |
| 099A: SUBLW 02 |
| 099B: BTFSS 03.2 |
| 099C: GOTO 1BD |
| .................... { |
| .................... STOPL; |
| 099D: BSF 03.5 |
| 099E: BCF 06.6 |
| 099F: BCF 03.5 |
| 09A0: BCF 06.6 |
| 09A1: BSF 03.5 |
| 09A2: BCF 06.7 |
| 09A3: BCF 03.5 |
| 09A4: BCF 06.7 |
| .................... GO(R, F, speed); |
| 09A5: MOVF 01,W |
| 09A6: SUBWF 42,W |
| 09A7: BTFSS 03.0 |
| 09A8: GOTO 1B2 |
| 09A9: BSF 03.5 |
| 09AA: BCF 06.5 |
| 09AB: BCF 03.5 |
| 09AC: BCF 06.5 |
| 09AD: BSF 03.5 |
| 09AE: BCF 06.4 |
| 09AF: BCF 03.5 |
| 09B0: BSF 06.4 |
| 09B1: GOTO 1BA |
| 09B2: BSF 03.5 |
| 09B3: BCF 06.4 |
| 09B4: BCF 03.5 |
| 09B5: BCF 06.4 |
| 09B6: BSF 03.5 |
| 09B7: BCF 06.5 |
| 09B8: BCF 03.5 |
| 09B9: BCF 06.5 |
| .................... movement=L; |
| 09BA: MOVLW 02 |
| 09BB: MOVWF 45 |
| .................... } |
| .................... else |
| 09BC: GOTO 1DC |
| .................... { |
| .................... STOPR; |
| 09BD: BSF 03.5 |
| 09BE: BCF 06.4 |
| 09BF: BCF 03.5 |
| 09C0: BCF 06.4 |
| 09C1: BSF 03.5 |
| 09C2: BCF 06.5 |
| 09C3: BCF 03.5 |
| 09C4: BCF 06.5 |
| .................... GO(L, F, speed); |
| 09C5: MOVF 01,W |
| 09C6: SUBWF 42,W |
| 09C7: BTFSS 03.0 |
| 09C8: GOTO 1D2 |
| 09C9: BSF 03.5 |
| 09CA: BCF 06.7 |
| 09CB: BCF 03.5 |
| 09CC: BCF 06.7 |
| 09CD: BSF 03.5 |
| 09CE: BCF 06.6 |
| 09CF: BCF 03.5 |
| 09D0: BSF 06.6 |
| 09D1: GOTO 1DA |
| 09D2: BSF 03.5 |
| 09D3: BCF 06.6 |
| 09D4: BCF 03.5 |
| 09D5: BCF 06.6 |
| 09D6: BSF 03.5 |
| 09D7: BCF 06.7 |
| 09D8: BCF 03.5 |
| 09D9: BCF 06.7 |
| .................... movement=R; |
| 09DA: MOVLW 01 |
| 09DB: MOVWF 45 |
| .................... } |
| .................... } // while(true) |
| 09DC: GOTO 0DC |
| .................... } |
| .................... |
| .................... |
| 09DD: SLEEP |
| Configuration Fuses: |
| Word 1: 3F38 NOWDT NOPUT MCLR NOBROWNOUT NOLVP NOCPD NOWRT NODEBUG CCPB0 NOPROTECT INTRC_IO |
| Word 2: 3FFC NOFCMEN NOIESO |
| /roboti/merkur/PIC16F88/tank.PJT |
|---|
| 0,0 → 1,40 |
| [PROJECT] |
| Target=tank.HEX |
| Development_Mode= |
| Processor=0x688F |
| ToolSuite=CCS |
| [Directories] |
| Include=C:\Program Files\PICC\devices\;C:\Program Files\PICC\drivers\;C:\library\CCS; |
| Library= |
| LinkerScript= |
| [Target Data] |
| FileList=tank.c; |
| BuildTool=C-COMPILER |
| OptionString=+FM |
| AdditionalOptionString= |
| BuildRequired=1 |
| [tank.c] |
| Type=4 |
| Path= |
| FileList= |
| BuildTool= |
| OptionString= |
| AdditionalOptionString= |
| [mru-list] |
| 1=tank.c |
| [Windows] |
| 0=0000 tank.c 0 0 796 451 3 0 |
| [Opened Files] |
| 1=D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.c |
| 2=C:\Program Files\PICC\devices\16F88.h |
| 3= |
| 4=C:\Program Files\PICC\devices\16F88.h |
| 5= |
| 6= |
| 7= |
| /roboti/merkur/PIC16F88/tank.SYM |
|---|
| 0,0 → 1,114 |
| 003 STATUS |
| 015 CCP_1_LOW |
| 015-016 CCP_1 |
| 016 CCP_1_HIGH |
| 020 @INTERRUPT_AREA |
| 021 @INTERRUPT_AREA |
| 022 @INTERRUPT_AREA |
| 023 @INTERRUPT_AREA |
| 024 @INTERRUPT_AREA |
| 025 @INTERRUPT_AREA |
| 026 @INTERRUPT_AREA |
| 027 @INTERRUPT_AREA |
| 028 @INTERRUPT_AREA |
| 029-038 SendData |
| 039.0 bit |
| 03A fcslo |
| 03B fcshi |
| 03C stuff |
| 03D flag_flag |
| 03E fcs_flag |
| 03F i |
| 040 sensors |
| 041 line |
| 042 speed |
| 043 rovinka |
| 044 last |
| 045 movement |
| 046 dira |
| 047 cihla |
| 048-06F AXstring |
| 070 @sprintf_string |
| 071-072 main.n |
| 073-074 prejeddiru.n |
| 073-074 diagnostika.n |
| 073-074 objizdka.n |
| 073 main.@SCRATCH |
| 075-076 cikcak.n |
| 075 ls |
| 075 objizdka.@SCRATCH |
| 075 prejeddiru.@SCRATCH |
| 076 rs |
| 077 @SCRATCH |
| 078 @SCRATCH |
| 078 _RETURN_ |
| 079 @SCRATCH |
| 07A @SCRATCH |
| 07B @SCRATCH |
| 07C-07D beep.period |
| 07C SendPacket.data |
| 07C diagnostika.@SCRATCH |
| 07C cikcak.@SCRATCH |
| 07D @delay_ms1.P1 |
| 07D @PRINTF_U_331.P2 |
| 07D SendPacket.@SCRATCH |
| 07E @PRINTF_U_331.P1 |
| 07E SendByte.inbyte |
| 09C.6 C1OUT |
| 09C.7 C2OUT |
| 0A0 @DIV88.P1 |
| 0A0 SendByte.k |
| 0A0 @SPRINTF.P1 |
| 0A0-0A1 beep.length |
| 0A1 SendByte.bt |
| 0A1 @DIV88.P1 |
| 0A2 fcsbit.tbyte |
| 0A2-0A3 beep.nn |
| 0A2 SendByte.@SCRATCH |
| 0A2 @DIV88.@SCRATCH |
| 0A3 fcsbit.@SCRATCH |
| 0A4 @delay_us1.P1 |
| 0A4 fcsbit.@SCRATCH |
| 009D @delay_ms1 |
| 005C @delay_us1 |
| 012E flipout |
| 0193 fcsbit |
| 0135 SendBit |
| 0173 SendByte |
| 0379 SendPacket |
| 0049 TIMER2_isr |
| 0071 beep |
| 01D1 diagnostika |
| 0037 @const10190 |
| 00B2 @SPRINTF |
| 00BC @DIV88 |
| 00D3 @PRINTF_U_331 |
| 03C4 cikcak |
| 04B2 objizdka |
| 05B0 prejeddiru |
| 0800 main |
| 0800 @cinit |
| 066A sem |
| Project Files: |
| D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.c |
| D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.h |
| C:\Program Files\PICC\devices\16F88.h |
| D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\AX25.c |
| Compiler Settings: |
| Processor: PIC16F88 |
| Pointer Size: 8 |
| ADC Range: 0-255 |
| Opt Level: 9 |
| Short,Int,Long: 1,8,16 |
| Output Files: |
| Errors: D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.err |
| INHX8: D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.HEX |
| Symbols: D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.SYM |
| List: D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.LST |
| Debug/COFF: D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.cof |
| Call Tree: D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.tre |
| Statistics: D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.sta |
| /roboti/merkur/PIC16F88/tank.c |
|---|
| 0,0 → 1,350 |
| #include "tank.h" |
| #define DEBUG |
| #define TXo PIN_A3 // To the transmitter modulator |
| #include "AX25.c" // podprogram pro prenos telemetrie |
| unsigned int8 sensors; // pomocna promenna pro cteni cidel na caru |
| unsigned int8 line; // na ktere strane byla detekovana cara |
| unsigned int8 speed; // rychlost zataceni |
| unsigned int8 rovinka; // pocitadlo pro zjisteni rovneho useku |
| unsigned int8 last; // kde byla cara, kdyz byly minule cidla mimo |
| unsigned int8 movement; // obsahuje aktualni smer zataceni |
| unsigned int8 dira; // pocita dobu po kterou je ztracena cara |
| unsigned int8 cihla; // urcuje za jak dlouho muze byt znova detekovana cihla |
| // Konstanty pro dynamiku pohybu |
| #define T_DIRA 85 // po jakem case zataceni se detekuje dira |
| #define INC_SPEED 1 // prirustek rychlosti v jednom kroku |
| #define FW_POMALU 230 // trochu mimo caru vnitrni pas |
| #define FW_ZATACKA 200 // rychlost vnejsiho kola pri zataceni |
| #define FW_STREDNE 240 // trochu mimo caru vnejsi pas |
| #define COUVANI 650 // couvnuti zpet na caru, po detekci diry |
| #define PRES_DIRU 350 |
| #define MAX_ROVINKA (255-FW_STREDNE) |
| #define TRESHOLD 10 // rozhodovaci uroven komparatoru, 0xF = 0.75*Vdd |
| #define BUMPER_TRESHOLD 128 |
| #define CIK_CAK 30000 |
| #define T_CIHLA 100 // perioda detekce cihly |
| //motory //Napred vypnout potom zapnout! |
| #define FR output_low(PIN_B5); output_high(PIN_B4) // Vpred |
| #define FL output_low(PIN_B7); output_high(PIN_B6) |
| #define BR output_low(PIN_B4); output_high(PIN_B5) // Vzad |
| #define BL output_low(PIN_B6); output_high(PIN_B7) |
| #define STOPR output_low(PIN_B4);output_low(PIN_B5) // Zastav |
| #define STOPL output_low(PIN_B6);output_low(PIN_B7) |
| #define L 0b10 // left |
| #define R 0b01 // right |
| #define S 0b11 // straight |
| //cidla |
| #define RSENSOR C2OUT // Senzory na caru |
| #define LSENSOR C1OUT |
| #define BUMPER PIN_A4 // Senzor na cihlu |
| #define DIAG_SERVO PIN_B3 // Propojka pro diagnosticky mod |
| #define DIAG_SENSORS PIN_B2 // Propojka pro diagnosticky mod |
| #DEFINE SOUND_HI PIN_A6 // komplementarni vystupy pro piezo pipak |
| #DEFINE SOUND_LO PIN_A7 |
| char AXstring[40]; // Buffer pro prenos telemetrie |
| // makro pro PWM |
| #define GO(motor, direction, power) if(get_timer0()<=power) \ |
| {direction##motor;} else {stop##motor;} |
| #int_TIMER2 |
| void TIMER2_isr() |
| { |
| if (speed<255) speed+=INC_SPEED; |
| if (rovinka<MAX_ROVINKA) rovinka++; |
| if (dira<=T_DIRA) dira++; |
| if (cihla>0) cihla--; |
| } |
| // Primitivni Pipani |
| void beep(unsigned int16 period, unsigned int16 length) |
| { |
| unsigned int16 nn; |
| for(nn=length; nn>0; nn--) |
| { |
| output_high(SOUND_HI);output_low(SOUND_LO); |
| delay_us(period); |
| output_high(SOUND_LO);output_low(SOUND_HI); |
| delay_us(period); |
| } |
| } |
| /******************************************************************************/ |
| void diagnostika() |
| { |
| unsigned int16 n; |
| while (input(DIAG_SERVO)) // Propojka, ktera spousti diagnostiku |
| { |
| for (n=500; n<800; n+=100) |
| { |
| beep(n,n); //beep UP |
| }; |
| Delay_ms(1000); |
| //zastav vse |
| STOPL; STOPR; |
| //pravy pas |
| FR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| BR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //levy pas |
| FL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| BL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //oba pasy |
| FL; FR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| BL; BR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| }; |
| while (input(DIAG_SENSORS)) |
| { |
| int ls, rs; |
| while(!input(BUMPER)){beep(1100,100); Delay_ms(50);} |
| set_adc_channel(RSENSOR); |
| Delay_us(20); |
| rs=read_adc(); |
| set_adc_channel(LSENSOR); |
| Delay_us(20); |
| ls=read_adc(); |
| sprintf(AXstring,"L: %U R: %U\0", ls, rs); // Convert DATA to String. |
| SendPacket(&AXstring[0]); |
| delay_ms(1000); |
| }; |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void cikcak() |
| { |
| unsigned int16 n; |
| line = RSENSOR; // cteni senzoru na caru |
| line |= LSENSOR << 1; |
| if (line!=0) return; |
| n=0; |
| switch(movement) // podivej se na druhou stranu nez se jelo |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| case S: |
| FR;BL; |
| movement=L; |
| n=CIK_CAK/2; |
| break; |
| } |
| while (0==(RSENSOR|LSENSOR)) // zkontroluj caru |
| { |
| if (n==CIK_CAK) // zmen smer zataceni |
| { |
| n=0; |
| switch(movement) |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| } |
| n++; |
| } |
| switch(movement) |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| Delay_ms(50); |
| STOPL;STOPR; // nasli jsme caru |
| line=S; |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void objizdka() // objede cihlu |
| { |
| unsigned int16 n; |
| BL;BR;Delay_ms(200); |
| STOPR;STOPL; |
| beep(900,1000); |
| movement=S; |
| cikcak(); |
| BR; FL; Delay_ms(215); // otoc se 70° do prava |
| FR; FL; Delay_ms(600); // popojed rovne |
| BL; Delay_ms(50); // otoc se 90° do leva |
| STOPL; FR; Delay_ms(550); |
| FR; FL; Delay_ms(100); // popojed rovne na slepo |
| for(n=600;n>0;n--) // popojed rovne ale kontroluj caru |
| { |
| line = RSENSOR; // cteni senzoru na caru |
| line |= LSENSOR << 1; |
| if (line!=0) {Delay_ms(50); break;} |
| Delay_ms(1); |
| } |
| BR; // otoc se 60° do prava |
| for(n=600;n>0;n--) |
| { |
| line = RSENSOR; // cteni senzoru na caru |
| line |= LSENSOR << 1; |
| if (line!=0) break; |
| Delay_ms(1); |
| } |
| STOPR; STOPL; |
| movement=R; |
| cikcak(); |
| cihla=T_DIRA; |
| dira=0; |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void prejeddiru() // vyresi diru |
| { |
| unsigned int16 n; |
| STOPL;STOPR; |
| beep(800,500); |
| switch (movement) //vrat se zpet na caru |
| { |
| case L: |
| for (n=COUVANI;n>0;n--) {GO(R,B,speed); Delay_ms(1);} |
| STOPL;STOPR; |
| break; |
| case R: |
| for (n=COUVANI;n>0;n--) {GO(L,B,speed); Delay_ms(1);} |
| STOPL;STOPR; |
| break; |
| case S: |
| goto sem; |
| break; |
| } |
| beep(800,500); |
| FR;FL; Delay_ms(PRES_DIRU); // popojedem dopredu mozna tam bude cara |
| sem: |
| STOPL; STOPR; |
| movement=S; |
| cikcak(); // najdi caru |
| cihla=T_DIRA; |
| dira=0; |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void main() |
| { |
| unsigned int16 n; // pro FOR |
| STOPL; STOPR; // prepne vystupy na ovladani motoru na output a zastavi |
| setup_oscillator(OSC_4MHZ|OSC_INTRC); // 4 MHz interni RC oscilator |
| port_b_pullups(TRUE); // pullups pro piano na diagnostiku |
| setup_spi(FALSE); |
| setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1); // Casovac pro PWM |
| setup_timer_2(T2_DIV_BY_4,255,10); // Casovac pro regulaci |
| // preruseni kazdych 10ms |
| setup_adc_ports(sAN2|VSS_VDD); // nastaveni A/D prevodniku pro naraznik |
| setup_adc(ADC_CLOCK_INTERNAL); |
| set_adc_channel(2); |
| setup_timer_1(T1_INTERNAL|T1_DIV_BY_1); // Casovac pro naraznik |
| setup_ccp1(CCP_COMPARE_RESET_TIMER); |
| CCP_1=(2^10)-1; // prevod kazdou 1ms |
| setup_comparator(A0_VR_A1_VR); // inicializace komparatoru pro cidla cary |
| setup_vref(VREF_HIGH|TRESHOLD); // 32 kroku od 0.25 do 0.75 Vdd |
| Beep(1000,200); //double beep |
| Delay_ms(50); |
| Beep(1000,200); |
| Delay_ms(1000); // 1s |
| // povoleni rizeni rychlosti zataceni pres preruseni |
| enable_interrupts(INT_TIMER2); |
| enable_interrupts(GLOBAL); |
| /*---------------------------------------------------------------------------*/ |
| sensors=S; |
| line=S; |
| last=S; |
| movement=S; |
| speed=FW_POMALU; |
| diagnostika(); |
| cikcak(); // toc se, abys nasel caru |
| Delay_ms(500); |
| Beep(1000,200); |
| Delay_ms(500); |
| while(true) // hlavni smycka (jizda podle cary) |
| { |
| sensors = RSENSOR; // cteni senzoru na caru |
| sensors |= LSENSOR << 1; |
| if ((read_adc(ADC_READ_ONLY)<BUMPER_TRESHOLD) && (cihla==0)) objizdka(); |
| switch (sensors) // zatacej podle toho, kde vidis caru |
| { |
| case S: // rovne |
| FL; FR; // pokud se jede dlouho rovne, tak pridej |
| dira=0; |
| movement=S; |
| continue; |
| case L: // trochu vlevo |
| GO(L, F, FW_POMALU+rovinka); GO(R, F, FW_STREDNE+rovinka); |
| line=L; |
| dira=0; |
| movement=L; |
| continue; |
| case R: // trochu vpravo |
| GO(R, F, FW_POMALU+rovinka); GO(L, F, FW_STREDNE+rovinka); |
| line=R; |
| dira=0; |
| movement=R; |
| continue; |
| default: // kdyz jsou obe cidla mimo caru, tak pokracuj dal |
| } |
| rovinka=0; |
| if (dira>=T_DIRA) prejeddiru(); |
| if (last!=line) // pokud si prejel caru z jedne strany na druhou stranu, tak zabrzdi |
| { |
| last=line; |
| speed=FW_ZATACKA; |
| } |
| if (L==line) // kdyz jsou obe cidla mimo caru, zatoc na caru |
| { |
| STOPL; |
| GO(R, F, speed); |
| movement=L; |
| } |
| else |
| { |
| STOPR; |
| GO(L, F, speed); |
| movement=R; |
| } |
| } // while(true) |
| } |
| /roboti/merkur/PIC16F88/tank.cof |
|---|
| Cannot display: file marked as a binary type. |
| svn:mime-type = application/octet-stream |
| Property changes: |
| Added: svn:mime-type |
| +application/octet-stream |
| \ No newline at end of property |
| /roboti/merkur/PIC16F88/tank.err |
|---|
| 0,0 → 1,0 |
| No Errors |
| /roboti/merkur/PIC16F88/tank.h |
|---|
| 0,0 → 1,5 |
| #include <16F88.h> |
| #device adc=8 |
| #fuses NOWDT,INTRC_IO, NOPUT, MCLR, NOBROWNOUT, NOLVP, NOCPD, NOWRT, NODEBUG, NOPROTECT, NOFCMEN, NOIESO |
| #use delay(clock=4000000) |
| /roboti/merkur/PIC16F88/tank.sta |
|---|
| 0,0 → 1,45 |
| ROM used: 2144 (52%) |
| 2526 (62%) including unused fragments |
| 3 Average locations per line |
| 5 Average locations per statement |
| RAM used: 89 (51%) at main() level |
| 101 (58%) worst case |
| Lines Stmts % Files |
| ----- ----- --- ----- |
| 351 390 85 D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.c |
| 6 0 0 D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\tank.h |
| 275 0 0 C:\Program Files\PICC\devices\16F88.h |
| 136 67 8 D:\KAKLIK\programy\PIC_C\roboti\merkur\PIC16F88\AX25.c |
| ----- ----- |
| 1536 914 Total |
| Page ROM % RAM Functions: |
| ---- --- --- --- ---------- |
| 0 21 1 1 @delay_ms1 |
| 0 21 1 1 @delay_us1 |
| 0 7 0 0 flipout |
| 0 62 3 0 SendBit |
| 0 94 4 4 SendByte |
| 0 19 1 0 TIMER2_isr |
| 0 44 2 6 beep |
| 0 499 23 3 diagnostika |
| 0 18 1 0 @const10190 |
| 0 10 0 1 @SPRINTF |
| 0 23 1 3 @DIV88 |
| 0 91 4 2 @PRINTF_U_331 |
| 0 238 11 3 cikcak |
| 0 254 12 3 objizdka |
| 0 210 10 3 prejeddiru |
| 1 478 22 3 main |
| Segment Used Free |
| --------- ---- ---- |
| 00000-00003 4 0 |
| 00004-00036 51 0 |
| 00037-007FF 1611 382 |
| 00800-00FFF 478 1570 |
| /roboti/merkur/PIC16F88/tank.tre |
|---|
| 0,0 → 1,136 |
| ÀÄtank |
| ÃÄmain 1/478 Ram=3 |
| ³ ÃÄ??0?? |
| ³ ÃÄbeep 0/44 Ram=6 |
| ³ ³ ÃÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ÀÄ@delay_us1 0/21 Ram=1 |
| ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ÃÄbeep 0/44 Ram=6 |
| ³ ³ ÃÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ÀÄ@delay_us1 0/21 Ram=1 |
| ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ÃÄdiagnostika 0/499 Ram=3 |
| ³ ³ ÃÄbeep 0/44 Ram=6 |
| ³ ³ ³ ÃÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ³ ÀÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄbeep 0/44 Ram=6 |
| ³ ³ ³ ÃÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ³ ÀÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄbeep 0/44 Ram=6 |
| ³ ³ ³ ÃÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ³ ÀÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄbeep 0/44 Ram=6 |
| ³ ³ ³ ÃÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ³ ÀÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ÃÄ@PRINTF_U_331 0/91 Ram=2 |
| ³ ³ ³ ÃÄ@DIV88 0/23 Ram=3 |
| ³ ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ³ ÃÄ@DIV88 0/23 Ram=3 |
| ³ ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ³ ÀÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ÃÄ@const10190 0/18 Ram=0 |
| ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ÃÄ@PRINTF_U_331 0/91 Ram=2 |
| ³ ³ ³ ÃÄ@DIV88 0/23 Ram=3 |
| ³ ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ³ ÃÄ@DIV88 0/23 Ram=3 |
| ³ ³ ³ ÃÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ³ ÀÄ@SPRINTF 0/10 Ram=1 |
| ³ ³ ÃÄSendPacket (Inline) Ram=2 |
| ³ ³ ³ ÃÄSendByte 0/94 Ram=4 |
| ³ ³ ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ³ ÃÄSendBit 0/62 Ram=0 |
| ³ ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ³ ÀÄSendBit 0/62 Ram=0 |
| ³ ³ ³ ÃÄSendByte 0/94 Ram=4 |
| ³ ³ ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ³ ÃÄSendBit 0/62 Ram=0 |
| ³ ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ³ ÀÄSendBit 0/62 Ram=0 |
| ³ ³ ³ ÃÄSendByte 0/94 Ram=4 |
| ³ ³ ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ³ ÃÄSendBit 0/62 Ram=0 |
| ³ ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ³ ÀÄSendBit 0/62 Ram=0 |
| ³ ³ ³ ÃÄSendByte 0/94 Ram=4 |
| ³ ³ ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ³ ÃÄSendBit 0/62 Ram=0 |
| ³ ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ³ ÀÄSendBit 0/62 Ram=0 |
| ³ ³ ³ ÃÄSendByte 0/94 Ram=4 |
| ³ ³ ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ³ ÃÄSendBit 0/62 Ram=0 |
| ³ ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ³ ÀÄSendBit 0/62 Ram=0 |
| ³ ³ ³ ÀÄSendByte 0/94 Ram=4 |
| ³ ³ ³ ÃÄfcsbit (Inline) Ram=3 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÃÄSendBit 0/62 Ram=0 |
| ³ ³ ³ ÃÄflipout 0/7 Ram=0 |
| ³ ³ ³ ÀÄSendBit 0/62 Ram=0 |
| ³ ³ ÀÄ@delay_ms1 0/21 Ram=1 |
| ³ ÃÄcikcak 0/238 Ram=3 |
| ³ ³ ÀÄ@delay_ms1 0/21 Ram=1 |
| ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ÃÄbeep 0/44 Ram=6 |
| ³ ³ ÃÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ÀÄ@delay_us1 0/21 Ram=1 |
| ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ÃÄobjizdka 0/254 Ram=3 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄbeep 0/44 Ram=6 |
| ³ ³ ³ ÃÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ³ ÀÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ÃÄcikcak 0/238 Ram=3 |
| ³ ³ ³ ÀÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ³ ÀÄcikcak 0/238 Ram=3 |
| ³ ³ ÀÄ@delay_ms1 0/21 Ram=1 |
| ³ ÀÄprejeddiru 0/210 Ram=3 |
| ³ ÃÄbeep 0/44 Ram=6 |
| ³ ³ ÃÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ÀÄ@delay_us1 0/21 Ram=1 |
| ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ÃÄbeep 0/44 Ram=6 |
| ³ ³ ÃÄ@delay_us1 0/21 Ram=1 |
| ³ ³ ÀÄ@delay_us1 0/21 Ram=1 |
| ³ ÃÄ@delay_ms1 0/21 Ram=1 |
| ³ ÀÄcikcak 0/238 Ram=3 |
| ³ ÀÄ@delay_ms1 0/21 Ram=1 |
| ÀÄTIMER2_isr 0/19 Ram=0 |
| /roboti/merkur/PIC16F88/verze/1 tank.c |
|---|
| 0,0 → 1,313 |
| #include "tank.h" |
| #define TXo PIN_B1 // To the transmitter modulator |
| #include "AX25.c" // podprogram pro prenos telemetrie |
| //motory //Napred vypnout potom zapnout! |
| #define FR output_low(PIN_B5); output_high(PIN_B4) // Vpred |
| #define FL output_low(PIN_B7); output_high(PIN_B6) |
| #define BR output_low(PIN_B4); output_high(PIN_B5) // Vzad |
| #define BL output_low(PIN_B6); output_high(PIN_B7) |
| #define STOPR output_low(PIN_B4);output_low(PIN_B5) |
| #define STOPL output_low(PIN_B6);output_low(PIN_B7) |
| #define L 0b10 // left |
| #define R 0b01 // right |
| #define S 0b11 // straight |
| #define COUVANI 1600 // couvnuti po zjisteni diry |
| #define MEZERA 5400 // za jak dlouho bude ztracena cara |
| #define PRES_DIRU 1000 // velikost mezery v care |
| #define BRZDENI 5000 // doba ptrebna k zastaveni jednoho motoru |
| //cidla |
| #define RSENSOR C2OUT // Senzory na caru |
| #define LSENSOR C1OUT |
| #define BUMPER PIN_A4 // sensor na cihlu |
| #define DIAG_SERVO PIN_B2 // Propojka pro diagnosticky mod |
| #define DIAG_SENSORS PIN_B3 // Propojka pro diagnosticky mod |
| #DEFINE SOUND_HI PIN_A7 |
| #DEFINE SOUND_LO PIN_A6 |
| char AXstring[40]; // Buffer pro prenos telemetrie |
| #define GO(motor, direction, power) if(get_timer0()<=power) \ |
| {direction##motor;} \ |
| else \ |
| {stop##motor;} |
| int movement; // smer minuleho pohybu |
| int line; // na ktere strane byla detekovana cara |
| unsigned int16 dira; // pocitadlo pro nalezeni preruseni cary |
| int speed,speedL,speedR; |
| // Primitivni Pipani |
| void beep(unsigned int16 period, unsigned int16 length) |
| { |
| unsigned int16 nn; |
| for(nn=length; nn>0; nn--) |
| { |
| output_high(SOUND_HI);output_low(SOUND_LO); |
| delay_us(period); |
| output_high(SOUND_LO);output_low(SOUND_HI); |
| delay_us(period); |
| } |
| } |
| #int_TIMER2 |
| void TIMER2_isr() |
| { |
| switch(line) // upravime smer |
| { |
| case S: //obe cidla na care |
| if(speedL<200)speedL++; |
| if(speedR<200)speedR++; |
| break; // vrat se zpet na cteni cidel |
| case L: // cara je pod levym cidlem, trochu zatocime |
| if (speedL>100)speedL -- ; |
| if (speedR<200)speedR ++ ; |
| break; |
| case R: // cara pod pravym cidlem |
| if (speedR>100)speedR -- ; |
| if (speedL<200)speedL ++ ; |
| break; |
| default: |
| } |
| } |
| // Diagnostika pohonu, hejbne vsema motorama ve vsech smerech |
| void diagnostika() |
| { |
| unsigned int16 n; |
| while (input(DIAG_SERVO)) // Propojka, ktera spousti diagnostiku |
| { |
| for (n=500; n<800; n+=100) |
| { |
| beep(n,n); //beep UP |
| }; |
| Delay_ms(1000); |
| //zastav vse |
| STOPL; STOPR; |
| //pravy pas |
| FR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| BR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //levy pas |
| FL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| BL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //oba pasy |
| FL; FR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| BL; BR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| }; |
| while (input(DIAG_SENSORS)) |
| { |
| int ls, rs; |
| while(!input(BUMPER)){beep(1100,100); Delay_ms(50);} |
| set_adc_channel(RSENSOR); |
| Delay_us(20); |
| rs=read_adc(); |
| set_adc_channel(LSENSOR); |
| Delay_us(20); |
| ls=read_adc(); |
| sprintf(AXstring,"L: %U R: %U\0", ls, rs); // Convert DATA to String. |
| SendPacket(&AXstring[0]); |
| delay_ms(1000); |
| }; |
| } |
| void cikcak() |
| { |
| int n; |
| switch(movement) // podivej se na jednu stranu |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| case S: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| while (0==(RSENSOR|LSENSOR)) |
| { |
| if (n==50) // asi bude na druhe strane |
| { |
| STOPR;STOPL; |
| n=0; |
| switch(movement) |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| } |
| Delay_ms(5); |
| n++; |
| } |
| STOPL;STOPR; // nasli jsme caru |
| line=S; |
| } |
| void objizdka() |
| { |
| BL;BR;Delay_ms(300); |
| STOPR;STOPL; |
| beep(1000,1000); |
| Delay_ms(500); |
| beep(1000,1000); |
| Delay_ms(1000); |
| } |
| void pozordira() |
| { |
| beep(800,500); |
| Delay_ms(50); |
| beep(800,500); |
| switch (movement) //vrat se zpet na caru |
| { |
| case L: |
| STOPL;STOPR; |
| BR;Delay_ms(COUVANI);STOPR; |
| break; |
| case R: |
| STOPL;STOPR; |
| BL;Delay_ms(COUVANI);STOPL; |
| break; |
| case S: |
| BL; BR; Delay_ms(COUVANI); |
| STOPL; STOPR; |
| break; |
| } |
| FR;FL; Delay_ms(PRES_DIRU); // popojedem dopredu mozna tam bude cara |
| STOPL; STOPR; movement=S; |
| cikcak(); // najdi caru |
| dira=0; |
| } |
| void main() |
| { |
| unsigned int16 rovinka; |
| int last; |
| STOPL; STOPR; |
| setup_oscillator(OSC_4MHZ|OSC_INTRC); // 4 MHz interni RC oscilator |
| port_b_pullups(true); |
| setup_adc_ports(NO_ANALOGS|VSS_VDD); |
| setup_adc(ADC_OFF); |
| setup_spi(FALSE); |
| setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1); // Casovac pro PWM |
| setup_timer_1(T1_DISABLED); // Casovac pro regulaci |
| setup_timer_2(T2_DIV_BY_16,50,16); |
| setup_ccp1(CCP_OFF); |
| setup_comparator(A0_VR_A1_VR); |
| setup_vref(VREF_HIGH|15); |
| enable_interrupts(INT_TIMER2); |
| enable_interrupts(GLOBAL); |
| diagnostika(); |
| Beep(1000,200); //double beep |
| Delay_ms(50); |
| Beep(1000,200); |
| Delay_ms(1000); // 1s |
| // FL; FR; |
| movement=S; |
| line=S; |
| dira=0; |
| last=0; |
| rovinka=0; |
| speed=speedL=speedR=200; |
| while(true) |
| { |
| line = RSENSOR; // precteni cidel |
| line |= LSENSOR << 1; // sestav informaci o care |
| if(line!=0) |
| { |
| GO(L, F, speedL); GO(R,F, speedR); |
| } |
| else{STOPR; STOPL;} |
| //sem: |
| /* switch(line) // upravime smer |
| { |
| case S: //obe cidla na care |
| // if (speedL<speedR) speedL=speedR; |
| // else speedR=speedL; |
| GO(L,F,speedL); GO(R,F,speedR) // jedeme rovne |
| // if(rovinka<BRZDENI) rovinka++; //cara je rovne |
| // dira=0; // videli jsme caru, proto neni dira |
| continue; // vrat se zpet na cteni cidel |
| case L: // cara je pod levym cidlem, trochu zatocime |
| GO(L, F, speedL); GO(R,F, speedR); |
| // if(rovinka<BRZDENI) rovinka++; //cara je celkem rovne |
| // dira=0; |
| continue; |
| case R: // cara pod pravym cidlem |
| GO(R, F, speedR); GO(L, F, speedL); |
| // if(rovinka<BRZDENI) rovinka++; |
| // dira=0; |
| continue; |
| default: // cara neni pod zadnym cidlem |
| }*/ |
| /*switch (last) // zatacka |
| { |
| case L: // do leva |
| BL;STOPR; //zabrzdeni leveho motoru |
| for(;rovinka>0;rovinka--) //chvili pockej |
| { |
| line = RSENSOR; // precteni cidel |
| line |= LSENSOR << 1; // sestav informaci o care |
| if(line!=0) goto sem; //kdyz najdes caru, zastav |
| } |
| STOPL; FR; // pokracuj v zataceni |
| while(line==0) |
| { |
| line = RSENSOR; // precteni cidel |
| line |= LSENSOR << 1; // sestav informaci o care |
| } |
| movement=L; |
| rovinka=0; //zataceli jsme, uz neni rovna cara |
| break; |
| case R: |
| BR; STOPL; // zabrzdeni praveho motoru |
| for(;rovinka>0;rovinka--) |
| { |
| line = RSENSOR; // precteni cidel |
| line |= LSENSOR << 1; // sestav informaci o care |
| if(line!=0) goto sem; |
| } |
| STOPR; FL; |
| while(line==0) |
| { |
| line = RSENSOR; // precteni cidel |
| line |= LSENSOR << 1; // sestav informaci o care |
| } |
| movement=R; |
| rovinka=0; //zataceli jsme, uz neni rovna cara |
| break; |
| }*/ |
| } // while(true) |
| } |
| /roboti/merkur/PIC16F88/verze/2 tank.c |
|---|
| 0,0 → 1,331 |
| #include "tank.h" |
| #define DEBUG |
| #define TXo PIN_A3 // To the transmitter modulator |
| #include "AX25.c" // podprogram pro prenos telemetrie |
| unsigned int8 sensors; // pomocna promenna pro cteni cidel na caru |
| unsigned int8 line; // na ktere strane byla detekovana cara |
| unsigned int8 speed; // rychlost zataceni |
| unsigned int8 rovinka; // pocitadlo pro zjisteni rovneho useku |
| unsigned int8 last; // kde byla cara, kdyz byly minule cidla mimo |
| unsigned int8 movement; // obsahuje aktualni smer zataceni |
| unsigned int8 dira; // pocita dobu po kterou je ztracena cara |
| // Konstanty pro dynamiku pohybu |
| #define T_DIRA 100 // po jakem case zataceni se detekuje dira |
| #define INC_SPEED 1 // prirustek rychlosti v jednom kroku |
| #define FW_POMALU 100 // trochu mimo caru vnitrni pas |
| #define FW_ZATACKA 200 // rychlost vnejsiho kola pri zataceni |
| #define FW_STREDNE 110 // trochu mimo caru vnejsi pas |
| #define COUVANI 600 // couvnuti zpet na caru, po detekci diry |
| #define PRES_DIRU 300 |
| #define MAX_ROVINKA (255-FW_STREDNE) |
| #define TRESHOLD 6 // rozhodovaci uroven komparatoru, 0xF = 0.75*Vdd |
| //motory //Napred vypnout potom zapnout! |
| #define FR output_low(PIN_B5); output_high(PIN_B4) // Vpred |
| #define FL output_low(PIN_B7); output_high(PIN_B6) |
| #define BR output_low(PIN_B4); output_high(PIN_B5) // Vzad |
| #define BL output_low(PIN_B6); output_high(PIN_B7) |
| #define STOPR output_low(PIN_B4);output_low(PIN_B5) // Zastav |
| #define STOPL output_low(PIN_B6);output_low(PIN_B7) |
| #define L 0b10 // left |
| #define R 0b01 // right |
| #define S 0b11 // straight |
| //cidla |
| #define RSENSOR C2OUT // Senzory na caru |
| #define LSENSOR C1OUT |
| #define BUMPER PIN_A4 // Senzor na cihlu |
| #define DIAG_SERVO PIN_B3 // Propojka pro diagnosticky mod |
| #define DIAG_SENSORS PIN_B2 // Propojka pro diagnosticky mod |
| #DEFINE SOUND_HI PIN_A6 // komplementarni vystupy pro piezo pipak |
| #DEFINE SOUND_LO PIN_A7 |
| char AXstring[40]; // Buffer pro prenos telemetrie |
| // makro pro PWM |
| #define GO(motor, direction, power) if(get_timer0()<=power) \ |
| {direction##motor;} \ |
| else \ |
| {stop##motor;} |
| #int_TIMER2 |
| void TIMER2_isr() |
| { |
| if (speed<255) speed+=INC_SPEED; |
| if (rovinka<MAX_ROVINKA) rovinka++; |
| if (dira<T_DIRA) dira++; |
| } |
| // Primitivni Pipani |
| void beep(unsigned int16 period, unsigned int16 length) |
| { |
| unsigned int16 nn; |
| for(nn=length; nn>0; nn--) |
| { |
| output_high(SOUND_HI);output_low(SOUND_LO); |
| delay_us(period); |
| output_high(SOUND_LO);output_low(SOUND_HI); |
| delay_us(period); |
| } |
| } |
| /******************************************************************************/ |
| void diagnostika() |
| { |
| unsigned int16 n; |
| while (input(DIAG_SERVO)) // Propojka, ktera spousti diagnostiku |
| { |
| for (n=500; n<800; n+=100) |
| { |
| beep(n,n); //beep UP |
| }; |
| Delay_ms(1000); |
| //zastav vse |
| STOPL; STOPR; |
| //pravy pas |
| FR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| BR; Delay_ms(1000); STOPR; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //levy pas |
| FL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| BL; Delay_ms(1000); STOPL; Delay_ms(1000); |
| Beep(880,100); Delay_ms(1000); |
| //oba pasy |
| FL; FR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| BL; BR; Delay_ms(1000); STOPL; STOPR; Delay_ms(1000); |
| }; |
| while (input(DIAG_SENSORS)) |
| { |
| int ls, rs; |
| while(!input(BUMPER)){beep(1100,100); Delay_ms(50);} |
| set_adc_channel(RSENSOR); |
| Delay_us(20); |
| rs=read_adc(); |
| set_adc_channel(LSENSOR); |
| Delay_us(20); |
| ls=read_adc(); |
| sprintf(AXstring,"L: %U R: %U\0", ls, rs); // Convert DATA to String. |
| SendPacket(&AXstring[0]); |
| delay_ms(1000); |
| }; |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void cikcak() |
| { |
| int n; |
| switch(movement) // podivej se na jednu stranu |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| case S: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| while (0==(RSENSOR|LSENSOR)) |
| { |
| if (n==50) //cara asi bude na druhe strane |
| { |
| STOPR;STOPL; |
| n=0; |
| switch(movement) |
| { |
| case L: |
| FL;BR; |
| movement=R; |
| break; |
| case R: |
| FR;BL; |
| movement=L; |
| break; |
| } |
| } |
| Delay_ms(5); |
| n++; |
| } |
| STOPL;STOPR; // nasli jsme caru |
| line=S; |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void objizdka() |
| { |
| BL;BR;Delay_ms(300); |
| STOPR;STOPL; |
| beep(1000,1000); |
| Delay_ms(500); |
| beep(1000,1000); |
| Delay_ms(1000); |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void prejeddiru() |
| { |
| STOPL;STOPR; |
| beep(800,500); |
| Delay_ms(50); |
| beep(800,500); |
| switch (movement) //vrat se zpet na caru |
| { |
| case L: |
| BR;Delay_ms(COUVANI);STOPR; |
| STOPL;STOPR; |
| break; |
| case R: |
| BL;Delay_ms(COUVANI);STOPL; |
| STOPL;STOPR; |
| break; |
| case S: |
| BL; BR; Delay_ms(COUVANI); |
| STOPL; STOPR; |
| break; |
| } |
| FR;FL; Delay_ms(PRES_DIRU); // popojedem dopredu mozna tam bude cara |
| STOPL; STOPR; |
| cikcak(); // najdi caru |
| dira=0; |
| } |
| /////////////////////////////////////////////////////////////////////////////// |
| void main() |
| { |
| unsigned int16 n; // pro FOR |
| STOPL; STOPR; // prepne vystupy na ovladani motoru na output a zastavi |
| setup_oscillator(OSC_4MHZ|OSC_INTRC); // 4 MHz interni RC oscilator |
| port_b_pullups(TRUE); // pullups pro piano na diagnostiku |
| setup_spi(FALSE); |
| setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1); // Casovac pro PWM |
| setup_timer_2(T2_DIV_BY_16,255,10); // Casovac pro regulaci |
| // preruseni kazdych 10ms |
| setup_adc_ports(sAN2|VSS_VDD); // nastaveni A/D prevodniku pro naraznik |
| setup_adc(ADC_CLOCK_INTERNAL); |
| set_adc_channel(2); |
| setup_timer_1(T1_INTERNAL|T1_DIV_BY_1); // Casovac pro naraznik |
| setup_ccp1(CCP_COMPARE_RESET_TIMER); |
| CCP_1=(2^10)-1; // prevod kazdou 1ms |
| setup_comparator(A0_VR_A1_VR); // inicializace komparatoru pro cidla cary |
| setup_vref(VREF_HIGH|TRESHOLD); // 32 kroku od 0.25 do 0.75 Vdd |
| Beep(1000,200); //double beep |
| Delay_ms(50); |
| Beep(1000,200); |
| Delay_ms(1000); // 1s |
| // povoleni rizeni rychlosti zataceni pres preruseni |
| enable_interrupts(INT_TIMER2); |
| enable_interrupts(GLOBAL); |
| /*---------------------------------------------------------------------------*/ |
| sensors=S; |
| line=S; |
| last=S; |
| movement=S; |
| speed=FW_POMALU; |
| diagnostika(); |
| cikcak(); // toc se, abys nasel caru |
| Delay_ms(500); |
| Beep(1000,200); |
| Delay_ms(500); |
| while(true) // hlavni smycka (jizda podle cary) |
| { |
| sensors = RSENSOR; // cteni senzoru na caru |
| sensors |= LSENSOR << 1; |
| switch (sensors) // zatacej podle toho, kde vidis caru |
| { |
| case S: // rovne |
| GO(L, F, speed); GO(R, F, speed); |
| // FL; FR; // pokud se jede dlouho rovne, tak pridej |
| dira=0; |
| continue; |
| case L: // trochu vlevo |
| GO(L, F, FW_POMALU+rovinka); GO(R, F, FW_STREDNE+rovinka); |
| line=L; |
| dira=0; |
| continue; |
| case R: // trochu vpravo |
| GO(R, F, FW_POMALU+rovinka); GO(L, F, FW_STREDNE+rovinka); |
| line=R; |
| dira=0; |
| continue; |
| default: // kdyz jsou obe cidla mimo caru, tak pokracuj dal |
| } |
| rovinka=0; |
| // if (dira>=T_DIRA) prejeddiru(); |
| if (last!=line) // pokud si prejel caru z jedne strany na druhou stranu, tak zabrzdi |
| { |
| last=line; |
| speed=FW_ZATACKA; |
| } |
| else speed=255; |
| /* if (dira==0) |
| { |
| if (L==line) // kdyz jsou obe cidla mimo caru, zabrzdi vnitrni kolo |
| { |
| BL; |
| for(n=4000;n>0;n--) // Delay |
| { |
| line = RSENSOR; // precteni cidel |
| line |= LSENSOR << 1; // sestav informaci o care |
| if(line!=0) break; |
| } |
| STOPL; |
| } |
| else |
| { |
| BR; |
| for(n=4000;n>0;n--) // Delay |
| { |
| line = RSENSOR; // precteni cidel |
| line |= LSENSOR << 1; // sestav informaci o care |
| if(line!=0) break; |
| } |
| STOPR; |
| } |
| }*/ |
| if (L==line) // kdyz jsou obe cidla mimo caru, zatoc na caru |
| { |
| STOPL; |
| GO(R, F, speed); |
| movement=L; |
| } |
| else |
| { |
| STOPR; |
| GO(L, F, speed); |
| movement=R; |
| } |
| } // while(true) |
| } |