Go to most recent revision | Blame | Last modification | View Log | Download
CCS PCM C Compiler, Version 3.245, 27853 12-IX-06 23:20Filename: D:\KAKL\roboti\solarni\2006\scamnum\menic.lstROM used: 837 words (20%)Largest free fragment is 2048RAM used: 85 (49%) at main() level91 (52%) worst caseStack: 4 worst case (3 in main + 1 for interrupts)*0000: MOVLW 000001: MOVWF 0A0002: GOTO 1BA0003: NOP0004: MOVWF 7F0005: SWAPF 03,W0006: CLRF 030007: MOVWF 210008: MOVF 7F,W0009: MOVWF 20000A: MOVF 0A,W000B: MOVWF 28000C: CLRF 0A000D: SWAPF 20,F000E: MOVF 04,W000F: MOVWF 220010: MOVF 77,W0011: MOVWF 230012: MOVF 78,W0013: MOVWF 240014: MOVF 79,W0015: MOVWF 250016: MOVF 7A,W0017: MOVWF 260018: MOVF 7B,W0019: MOVWF 27001A: BCF 03.7001B: BCF 03.5001C: MOVLW 8C001D: MOVWF 04001E: BTFSS 00.3001F: GOTO 0220020: BTFSC 0C.30021: GOTO 0350022: MOVF 22,W0023: MOVWF 040024: MOVF 23,W0025: MOVWF 770026: MOVF 24,W0027: MOVWF 780028: MOVF 25,W0029: MOVWF 79002A: MOVF 26,W002B: MOVWF 7A002C: MOVF 27,W002D: MOVWF 7B002E: MOVF 28,W002F: MOVWF 0A0030: SWAPF 21,W0031: MOVWF 030032: SWAPF 7F,F0033: SWAPF 7F,W0034: RETFIE0035: BCF 0A.30036: GOTO 043.................... // *************************************.................... // * Scamnum Specularis ** 20. 9. 2006 *.................... // *************************************........................................ #include ".\menic.h".................... #include <16F88.h>.................... //////// Standard Header file for the PIC16F88 device ////////////////.................... #device PIC16F88.................... #list............................................................ #device adc=8........................................ #fuses WDT,INTRC_IO, NOPUT, MCLR, NOBROWNOUT, NOLVP, NOCPD, \.................... NOWRT, DEBUG, NOPROTECT, NOFCMEN, NOIESO, CCPB3........................................ #use delay(clock=3900000,RESTART_WDT)*0048: MOVLW 6F0049: MOVWF 04004A: MOVF 00,W004B: BTFSC 03.2004C: GOTO 05D004D: MOVLW 01004E: MOVWF 78004F: MOVLW BF0050: MOVWF 770051: CLRWDT0052: DECFSZ 77,F0053: GOTO 0510054: DECFSZ 78,F0055: GOTO 04F0056: MOVLW 420057: MOVWF 770058: DECFSZ 77,F0059: GOTO 058005A: CLRWDT005B: DECFSZ 00,F005C: GOTO 04D005D: RETLW 00................................................................................ #define TXo PIN_B5 // 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(218) // Halfperiod H 222;78/1200 500;430/500.................... //#define TAILH delay_us(74).................... //#define PERIODAL delay_us(408) // Halfperiod L 412;345/1200 1000;880/500.................... //#define TAILL delay_us(341).................... #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};*01C5: MOVLW 8201C6: BCF 03.501C7: MOVWF 2901C8: MOVLW 9801C9: MOVWF 2A01CA: MOVWF 2B01CB: MOVLW 4001CC: MOVWF 2C01CD: MOVWF 2D01CE: MOVWF 2E01CF: MOVLW 6001D0: MOVWF 2F01D1: MOVLW 8601D2: MOVWF 3001D3: MOVLW B401D4: MOVWF 3101D5: MOVLW 6001D6: MOVWF 3201D7: MOVLW A401D8: MOVWF 3301D9: MOVWF 3401DA: MOVWF 3501DB: MOVLW 6101DC: MOVWF 3601DD: MOVLW 0301DE: MOVWF 3701DF: MOVLW F001E0: MOVWF 38........................................ 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*00E7: CLRF 3C.................... if (bit)00E8: BTFSS 39.000E9: GOTO 0EC.................... {.................... bit=FALSE; //if the state of the pin was low, make it high.00EA: BCF 39.0.................... }.................... else00EB: GOTO 0ED.................... {.................... bit=TRUE; //if the state of the pin was high make it low00EC: BSF 39.0.................... }.................... }00ED: RETLW 00........................................ void fcsbit(byte tbyte).................... {.................... #asm.................... BCF STATUS,0*0149: BCF 03.0.................... RRF fcshi,F // rotates the entire 16 bits014A: RRF 3B,F.................... RRF fcslo,F // to the right014B: RRF 3A,F.................... #endasm.................... if (((STATUS & 0x01)^(tbyte)) ==0x01)014C: MOVF 03,W014D: ANDLW 01014E: XORWF 73,W014F: SUBLW 010150: BTFSS 03.20151: GOTO 156.................... {.................... fcshi = fcshi^0x84;0152: MOVLW 840153: XORWF 3B,F.................... fcslo = fcslo^0x08;0154: MOVLW 080155: XORWF 3A,F.................... }.................... }........................................ void SendBit ().................... {.................... if (bit)*00EE: BTFSS 39.000EF: GOTO 11A.................... {.................... output_low(TXo);00F0: BSF 03.500F1: BCF 06.500F2: BCF 03.500F3: BCF 06.5.................... PERIODAH;00F4: CLRWDT00F5: MOVLW 4700F6: MOVWF 7700F7: DECFSZ 77,F00F8: GOTO 0F700F9: NOP.................... output_high(TXo);00FA: BSF 03.500FB: BCF 06.500FC: BCF 03.500FD: BSF 06.5.................... PERIODAH;00FE: CLRWDT00FF: MOVLW 470100: MOVWF 770101: DECFSZ 77,F0102: GOTO 1010103: NOP.................... output_low(TXo);0104: BSF 03.50105: BCF 06.50106: BCF 03.50107: BCF 06.5.................... PERIODAH;0108: CLRWDT0109: MOVLW 47010A: MOVWF 77010B: DECFSZ 77,F010C: GOTO 10B010D: NOP.................... output_high(TXo);010E: BSF 03.5010F: BCF 06.50110: BCF 03.50111: BSF 06.5.................... TAILH;0112: CLRWDT0113: MOVLW 180114: MOVWF 770115: DECFSZ 77,F0116: GOTO 1150117: NOP0118: NOP.................... }.................... else0119: GOTO 12D.................... {.................... output_low(TXo);011A: BSF 03.5011B: BCF 06.5011C: BCF 03.5011D: BCF 06.5.................... PERIODAL;011E: CLRWDT011F: MOVLW 850120: MOVWF 770121: DECFSZ 77,F0122: GOTO 121.................... output_high(TXo);0123: BSF 03.50124: BCF 06.50125: BCF 03.50126: BSF 06.5.................... TAILL;0127: CLRWDT0128: MOVLW 6F0129: MOVWF 77012A: DECFSZ 77,F012B: GOTO 12A012C: NOP.................... };.................... }012D: 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 byte012E: CLRF 71012F: MOVF 71,W0130: SUBLW 070131: BTFSS 03.00132: GOTO 176.................... {.................... bt = inbyte & 0x01; //strip off the rightmost bit of the byte to be sent (inbyte)0133: MOVF 70,W0134: ANDLW 010135: MOVWF 72.................... if ((fcs_flag == FALSE) & (flag_flag == FALSE)) fcsbit(bt); //do FCS calc, but only if this0136: MOVF 3E,F0137: BTFSC 03.20138: GOTO 13B0139: MOVLW 00013A: GOTO 13C013B: MOVLW 01013C: MOVWF 73013D: MOVF 3D,F013E: BTFSC 03.2013F: GOTO 1420140: MOVLW 000141: GOTO 1430142: MOVLW 010143: ANDWF 73,W0144: XORLW 000145: BTFSC 03.20146: GOTO 1560147: MOVF 72,W0148: MOVWF 73.................... //is not a flag or fcs byte.................... if (bt == 0)*0156: MOVF 72,F0157: BTFSS 03.20158: GOTO 15B.................... {.................... flipout();0159: CALL 0E7.................... } // if this bit is a zero, flip the output state.................... else015A: GOTO 171.................... { //otherwise if it is a 1, do the following:.................... if (flag_flag == FALSE) stuff++; //increment the count of consequtive 1's015B: MOVF 3D,F015C: BTFSC 03.2015D: INCF 3C,F.................... if ((flag_flag == FALSE) & (stuff == 5))015E: MOVF 3D,F015F: BTFSC 03.20160: GOTO 1630161: MOVLW 000162: GOTO 1640163: MOVLW 010164: MOVWF 730165: MOVF 3C,W0166: SUBLW 050167: BTFSC 03.20168: GOTO 16B0169: MOVLW 00016A: GOTO 16C016B: MOVLW 01016C: ANDWF 73,W016D: BTFSC 03.2016E: GOTO 171.................... { //stuff an extra 0, if 5 1's in a row.................... SendBit();016F: CALL 0EE.................... flipout(); //flip the output state to stuff a 00170: CALL 0E7.................... }//end of if.................... }//end of else.................... // delay_us(850); //introduces a delay that creates 1200 baud.................... SendBit();0171: CALL 0EE.................... inbyte = inbyte>>1; //go to the next bit in the byte0172: BCF 03.00173: RRF 70,F.................... }//end of for0174: INCF 71,F0175: GOTO 12F.................... }//end of SendByte0176: RETLW 00........................................ void SendPacket(char *data).................... {.................... bit=FALSE;0177: BCF 39.0........................................ fcslo=fcshi=0xFF; //The 2 FCS Bytes are initialized to FF0178: MOVLW FF0179: MOVWF 3B017A: MOVWF 3A.................... stuff = 0; //The variable stuff counts the number of 1's in a row. When it gets to 5017B: CLRF 3C.................... // 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.017C: MOVLW 01017D: MOVWF 3D.................... fcs_flag = FALSE; //The variable fcsflag is true if you are transmitting FCS bytes, false otherwise.017E: CLRF 3E........................................ for(i=0; i<10; i++) SendByte(0x7E); //Sends flag bytes. Adjust length for txdelay017F: CLRF 3F0180: MOVF 3F,W0181: SUBLW 090182: BTFSS 03.00183: GOTO 1890184: MOVLW 7E0185: MOVWF 700186: CALL 12E0187: INCF 3F,F0188: GOTO 180.................... //each flag takes approx 6.7 ms.................... flag_flag = FALSE; //done sending flags0189: CLRF 3D........................................ for(i=0; i<16; i++) SendByte(SendData[i]); //send the packet bytes018A: CLRF 3F018B: MOVF 3F,W018C: SUBLW 0F018D: BTFSS 03.0018E: GOTO 198018F: MOVLW 290190: ADDWF 3F,W0191: MOVWF 040192: MOVF 00,W0193: MOVWF 6F0194: MOVWF 700195: CALL 12E0196: INCF 3F,F0197: GOTO 18B........................................ for(i=0; 0 != *data; i++)0198: CLRF 3F0199: MOVF 6E,W019A: MOVWF 04019B: MOVF 00,W019C: BTFSC 03.2019D: GOTO 1A7.................... {.................... SendByte(*data); //send the packet bytes019E: MOVF 6E,W019F: MOVWF 0401A0: MOVF 00,W01A1: MOVWF 6F01A2: MOVWF 7001A3: CALL 12E.................... data++;01A4: INCF 6E,F.................... };01A5: INCF 3F,F01A6: GOTO 199........................................ fcs_flag = TRUE; //about to send the FCS bytes01A7: MOVLW 0101A8: MOVWF 3E.................... fcslo =fcslo^0xff; //must XOR them with FF before sending01A9: MOVLW FF01AA: XORWF 3A,F.................... fcshi = fcshi^0xff;01AB: XORWF 3B,F.................... SendByte(fcslo); //send the low byte of fcs01AC: MOVF 3A,W01AD: MOVWF 7001AE: CALL 12E.................... SendByte(fcshi); //send the high byte of fcs01AF: MOVF 3B,W01B0: MOVWF 7001B1: CALL 12E.................... fcs_flag = FALSE; //done sending FCS01B2: CLRF 3E.................... flag_flag = TRUE; //about to send flags01B3: MOVLW 0101B4: MOVWF 3D.................... SendByte(0x7e); // Send a flag to end packet01B5: MOVLW 7E01B6: MOVWF 7001B7: CALL 12E.................... }01B8: BCF 0A.301B9: GOTO 30C (RETURN).................................................................................................... char AXstring[40]; // Buffer pro prenos telemetrie........................................ #define REFSTART 95 // Hodnota odpovidajici 1,2V pri nezatizenych clancich.................... #define DUTY1 2 // Delka sepnuti PWM v us pro sero.................... #define DUTY2 19 // Delka sepnuti PWM v us pro jednu zarovku 500W........................................ // Tabulka hodnot prevodniku pro ruzna napajeci napeti.................... // 80 3,99V.................... // 90 3,54V.................... // 100 3,20V.................... // 105 3,04V.................... // 107 2,99V.................... // 110 2,91v.................... // 200 1,61V........................................ #define PIEZO PIN_A6 // Jeden pol piezo reproduktoru.................... #define LED PIN_A7 // LED / druhy pol piezo reproduktoru.................... #define MENIC PIN_B3 // Spinani tranzistoru menice.................... #define REFPWR PIN_B1 // Napajeni zdroje referencniho napeti.................... #define MOTOR PIN_B2 // Spinani tranzistoru motoru.................... #define SW1 PIN_B6 // DIPswitch 1.................... #define SW2 PIN_B7 // DIPswitch 2.................... #define NAPETI 4 // Cislo kanalu DA prevodniku pro mereni napeti.................... #define PWM 0 // Cislo kanalu DA prevodniku pro nastaveni PWM.................... #define ROZJEZD 1 // Cislo kanalu DA prevodniku pro nastaveni rozjezdu........................................ #byte SSPBUF = 0x13 // Adresy registru jednotky SSP.................... #byte SSPCON1 = 0x14.................... #byte SSPSTAT = 0x94........................................ // Vzorky pro generovani PWM pomoci SSP.................... unsigned int8 const Pattern[8] = {0x02,0x06,0x0e,0x1e,0x3e,0x7e,0xfe,0xff};.................... unsigned int8 MotorPattern;........................................ #INT_SSP.................... void IntSSP().................... {.................... SSPBUF=MotorPattern; // znovu vysli stejnou hodnotu*0043: MOVF 68,W0044: MOVWF 13.................... }....................0045: BCF 0C.30046: BCF 0A.30047: GOTO 022.................... void pip() // pipnuti a bliknuti.................... {.................... int1 beep;.................... int i;........................................ for(i=0; i<250; i++)*006B: CLRF 6F006C: MOVF 6F,W006D: SUBLW F9006E: BTFSS 03.0006F: GOTO 08B.................... {.................... output_bit(PIEZO, beep);0070: BTFSC 6E.00071: GOTO 0740072: BCF 05.60073: GOTO 0750074: BSF 05.60075: BSF 03.50076: BCF 05.6.................... beep=~beep;0077: MOVLW 010078: BCF 03.50079: XORWF 6E,F.................... output_bit(LED, beep);007A: BTFSC 6E.0007B: GOTO 07E007C: BCF 05.7007D: GOTO 07F007E: BSF 05.7007F: BSF 03.50080: BCF 05.7.................... delay_us(100);0081: CLRWDT0082: MOVLW 1F0083: MOVWF 770084: DECFSZ 77,F0085: GOTO 0840086: NOP0087: NOP.................... };0088: BCF 03.50089: INCF 6F,F008A: GOTO 06C.................... output_high(PIEZO);008B: BSF 03.5008C: BCF 05.6008D: BCF 03.5008E: BSF 05.6.................... output_high(LED);008F: BSF 03.50090: BCF 05.70091: BCF 03.50092: BSF 05.7.................... }0093: BCF 0A.30094: GOTO 2A3 (RETURN)........................................ void cvak() // pouze cvaknuti piezoelementem bez bliknuti.................... {.................... output_bit(PIEZO,~input(PIEZO));*005E: BSF 03.5005F: BSF 05.60060: BCF 03.50061: BTFSS 05.60062: GOTO 0650063: BCF 05.60064: GOTO 0660065: BSF 05.60066: BSF 03.50067: BCF 05.6.................... }0068: BCF 03.50069: BCF 0A.3006A: GOTO 25A (RETURN)........................................ void main().................... {*01BA: CLRF 0401BB: MOVLW 1F01BC: ANDWF 03,F01BD: BSF 03.501BE: BCF 1F.401BF: BCF 1F.501C0: MOVF 1B,W01C1: ANDLW 8001C2: MOVWF 1B01C3: MOVLW 0701C4: MOVWF 1C.................... int8 n;.................... int8 perioda;.................... int8 razeni;.................... int8 uclanku;........................................ setup_timer_0(RTCC_INTERNAL);setup_wdt(WDT_1152MS);*01E2: BSF 03.501E3: MOVF 01,W01E4: ANDLW C001E5: MOVWF 0101E6: MOVLW 0E01E7: MOVWF 7701E8: MOVLW 0701E9: BCF 03.501EA: CLRF 0101EB: MOVLW 8101EC: MOVWF 0401ED: MOVF 00,W01EE: ANDLW F001EF: IORLW 0701F0: MOVWF 0001F1: CLRWDT01F2: MOVF 00,W01F3: ANDLW F701F4: BTFSC 77.301F5: ANDLW F001F6: IORWF 77,W01F7: MOVWF 00.................... setup_timer_1(T1_DISABLED);01F8: CLRF 10.................... setup_adc_ports(ADC_CLOCK_INTERNAL|sAN0|sAN1|sAN4|VSS_VDD);01F9: BSF 03.501FA: BCF 1F.401FB: BCF 1F.501FC: MOVF 1B,W01FD: ANDLW 8001FE: IORLW D301FF: MOVWF 1B.................... setup_adc(ADC_CLOCK_INTERNAL);0200: BCF 1F.60201: BCF 03.50202: BSF 1F.60203: BSF 1F.70204: BSF 03.50205: BCF 1F.70206: BCF 03.50207: BSF 1F.0.................... setup_spi(FALSE);0208: BCF 14.50209: BSF 03.5020A: BCF 06.2020B: BSF 06.1020C: BCF 06.4020D: MOVLW 00020E: BCF 03.5020F: MOVWF 140210: BSF 03.50211: MOVWF 14.................... setup_comparator(NC_NC_NC_NC);0212: MOVLW 070213: MOVWF 1C0214: MOVF 05,W0215: CLRWDT0216: MOVLW 020217: MOVWF 770218: DECFSZ 77,F0219: GOTO 218021A: NOP021B: MOVF 1C,W021C: BCF 03.5021D: BCF 0D.6.................... setup_vref(FALSE);021E: BSF 03.5021F: CLRF 1D........................................ output_low(MENIC); // Vsechno zastav0220: BCF 06.30221: BCF 03.50222: BCF 06.3.................... output_low(MOTOR);0223: BSF 03.50224: BCF 06.20225: BCF 03.50226: BCF 06.2.................... output_low(REFPWR);0227: BSF 03.50228: BCF 06.10229: BCF 03.5022A: BCF 06.1.................... output_high(LED);022B: BSF 03.5022C: BCF 05.7022D: BCF 03.5022E: BSF 05.7.................... output_high(PIEZO);022F: BSF 03.50230: BCF 05.60231: BCF 03.50232: BSF 05.6........................................ set_adc_channel(NAPETI); // Vyber AD kanal pro pomerne mereni napeti0233: MOVLW 200234: MOVWF 780235: MOVF 1F,W0236: ANDLW C70237: IORWF 78,W0238: MOVWF 1F.................... set_pwm1_duty(0); // Spust PWM, ale zatim s trvalou 0 na vystupu0239: CLRF 15.................... setup_ccp1(CCP_PWM);023A: BSF 03.5023B: BCF 06.3023C: BCF 03.5023D: BCF 06.3023E: MOVLW 0C023F: MOVWF 17.................... setup_timer_2(T2_DIV_BY_1,100,1); // perioda0240: MOVLW 000241: MOVWF 780242: IORLW 040243: MOVWF 120244: MOVLW 640245: BSF 03.50246: MOVWF 12........................................ setup_oscillator(OSC_4MHZ|OSC_INTRC); // rozjed PIC (zvysi se odber)0247: MOVLW 620248: MOVWF 0F........................................ // jsme v depu?.................... set_pwm1_duty(DUTY1); // PWM pro zatizeni clanku pri malem osvetleni0249: MOVLW 02024A: BCF 03.5024B: MOVWF 15.................... n=0;024C: CLRF 6A.................... do.................... {.................... output_low(REFPWR); // Vypni napajeni napetove reference, aby se setrilo024D: BSF 03.5024E: BCF 06.1024F: BCF 03.50250: BCF 06.1.................... delay_ms(100);0251: MOVLW 640252: MOVWF 6F0253: CALL 048.................... if (4==n++) {cvak(); n=0;}; // Kazdy 4. pruchod cvakni0254: MOVF 6A,W0255: INCF 6A,F0256: SUBLW 040257: BTFSS 03.20258: GOTO 25B0259: GOTO 05E025A: CLRF 6A.................... output_high(REFPWR); // Zapni napajeni napetove reference025B: BSF 03.5025C: BCF 06.1025D: BCF 03.5025E: BSF 06.1.................... delay_ms(1); // Pockej na ustaleni napeti025F: MOVLW 010260: MOVWF 6F0261: CALL 048.................... } while (read_adc()>REFSTART); // Odkryl starter clanky?0262: BSF 1F.20263: BTFSC 1F.20264: GOTO 2630265: MOVF 1E,W0266: SUBLW 5F0267: BTFSS 03.00268: GOTO 24D.................... output_low(REFPWR); // Vypni napajeni napetove reference, aby se setrilo0269: BSF 03.5026A: BCF 06.1026B: BCF 03.5026C: BCF 06.1........................................ // port_b_pullups(TRUE); // Zapni pullupy, aby slo cist DIPswitch.................... // do.................... // {.................... // Precti trimry.................... set_adc_channel(PWM); // Zjisteni nastaveni PWM026D: MOVLW 00026E: MOVWF 78026F: MOVF 1F,W0270: ANDLW C70271: IORWF 78,W0272: MOVWF 1F.................... delay_us(100); // Pockej na prepnuti kanalu A/D prevodniku0273: CLRWDT0274: MOVLW 1F0275: MOVWF 770276: DECFSZ 77,F0277: GOTO 2760278: NOP0279: NOP.................... perioda=(read_adc()>>1)+40; // rozsah: 40 az 167027A: BSF 1F.2027B: BTFSC 1F.2027C: GOTO 27B027D: MOVF 1E,W027E: MOVWF 77027F: BCF 03.00280: RRF 77,F0281: MOVF 77,W0282: ADDLW 280283: MOVWF 6B........................................ set_adc_channel(ROZJEZD); // Zjisteni nastaveni rozjezdu0284: MOVLW 080285: MOVWF 780286: MOVF 1F,W0287: ANDLW C70288: IORWF 78,W0289: MOVWF 1F.................... delay_us(100); // Pockej na prepnuti kanalu A/D prevodniku028A: CLRWDT028B: MOVLW 1F028C: MOVWF 77028D: DECFSZ 77,F028E: GOTO 28D028F: NOP0290: NOP.................... razeni=read_adc()>>1; // rozsah: 0 az 1270291: BSF 1F.20292: BTFSC 1F.20293: GOTO 2920294: BCF 03.00295: RRF 1E,W0296: MOVWF 6C........................................ // Rozjeti menice.................... set_pwm1_duty(0); // Zastav PWM, aby slo nastavit jinou frekvenci0297: CLRF 15.................... setup_timer_2(T2_DIV_BY_1,perioda,1); // perioda0298: MOVLW 000299: MOVWF 78029A: IORLW 04029B: MOVWF 12029C: MOVF 6B,W029D: BSF 03.5029E: MOVWF 12.................... set_pwm1_duty(DUTY2); // PWM pro zatizeni clanku pri jedne 500W zarovce029F: MOVLW 1302A0: BCF 03.502A1: MOVWF 15........................................ pip(); // potvrzeni odstartovani / servisni mod02A2: GOTO 06B.................... delay_ms(500);02A3: MOVLW 0202A4: MOVWF 6E02A5: MOVLW FA02A6: MOVWF 6F02A7: CALL 04802A8: DECFSZ 6E,F02A9: GOTO 2A5........................................ // } while (input(SW1)); // Je zapnut servisni mod? SW1(OFF)=ANO.................... // port_b_pullups(FALSE); // Vypni pullupy, aby se setrilo energii........................................ // Regulace nabíjení.................... output_high(REFPWR); // Prepni AD na mereni napeti clanku02AA: BSF 03.502AB: BCF 06.102AC: BCF 03.502AD: BSF 06.1.................... set_adc_channel(NAPETI); // Prepni Zmer napeti clanku02AE: MOVLW 2002AF: MOVWF 7802B0: MOVF 1F,W02B1: ANDLW C702B2: IORWF 78,W02B3: MOVWF 1F.................... delay_us(50); // Pockej na prepnuti kanalu A/D prevodniku02B4: CLRWDT02B5: MOVLW 0F02B6: MOVWF 7702B7: DECFSZ 77,F02B8: GOTO 2B702B9: NOP.................... for(n=1;n<=10;n++)02BA: MOVLW 0102BB: MOVWF 6A02BC: MOVF 6A,W02BD: SUBLW 0A02BE: BTFSS 03.002BF: GOTO 2DC.................... {.................... // Zmer napeti (aktualni zatizeni clanku).................... uclanku=read_adc();02C0: BSF 1F.202C1: BTFSC 1F.202C2: GOTO 2C102C3: MOVF 1E,W02C4: MOVWF 6D.................... // Uprav parametry menice.................... if (uclanku>105)02C5: MOVF 6D,W02C6: SUBLW 6902C7: BTFSC 03.002C8: GOTO 2CB.................... {.................... perioda++;02C9: INCF 6B,F.................... }.................... else02CA: GOTO 2CC.................... {.................... perioda--;02CB: DECF 6B,F.................... }.................... set_pwm1_duty(0); // Zastav PWM, aby slo nastavit jinou frekvenci02CC: CLRF 15.................... setup_timer_2(T2_DIV_BY_1,perioda,1); // perioda02CD: MOVLW 0002CE: MOVWF 7802CF: IORLW 0402D0: MOVWF 1202D1: MOVF 6B,W02D2: BSF 03.502D3: MOVWF 12.................... set_pwm1_duty(DUTY2); // PWM pro zatizeni clanku pri jedne 500W zarovce02D4: MOVLW 1302D5: BCF 03.502D6: MOVWF 15.................... delay_ms(100);02D7: MOVLW 6402D8: MOVWF 6F02D9: CALL 048.................... }02DA: INCF 6A,F02DB: GOTO 2BC.................... output_low(REFPWR);02DC: BSF 03.502DD: BCF 06.102DE: BCF 03.502DF: BCF 06.1.................... // posli telemetrii.................... sprintf(AXstring,"p=%u r=%u u=%u", perioda, razeni, uclanku); // Convert DATA to String.*01E1: CLRF 69*02E0: MOVLW 4002E1: MOVWF 6902E2: MOVLW 7002E3: MOVWF 7002E4: CALL 09502E5: MOVLW 3D02E6: MOVWF 7002E7: CALL 09502E8: MOVF 6B,W02E9: MOVWF 6E02EA: MOVLW 1B02EB: MOVWF 6F02EC: CALL 0B202ED: MOVLW 2002EE: MOVWF 7002EF: CALL 09502F0: MOVLW 7202F1: MOVWF 7002F2: CALL 09502F3: MOVLW 3D02F4: MOVWF 7002F5: CALL 09502F6: MOVF 6C,W02F7: MOVWF 6E02F8: MOVLW 1B02F9: MOVWF 6F02FA: CALL 0B202FB: MOVLW 2002FC: MOVWF 7002FD: CALL 09502FE: MOVLW 7502FF: MOVWF 700300: CALL 0950301: MOVLW 3D0302: MOVWF 700303: CALL 0950304: MOVF 6D,W0305: MOVWF 6E0306: MOVLW 1B0307: MOVWF 6F0308: CALL 0B2.................... SendPacket(&AXstring[0]);0309: MOVLW 40030A: MOVWF 6E030B: GOTO 177........................................ delay_ms(13000); // Pockame 14s030C: MOVLW 34030D: MOVWF 6E030E: MOVLW FA030F: MOVWF 6F0310: CALL 0480311: DECFSZ 6E,F0312: GOTO 30E........................................ // rozjezd.................... SSPSTAT = 0; // inicializace SPI jednotky0313: BSF 03.50314: CLRF 14.................... SSPCON1 = 0x22; // SPI OSC/640315: MOVLW 220316: BCF 03.50317: MOVWF 14.................... MotorPattern=0x02; // prvni data pro vyslani0318: MOVLW 020319: MOVWF 68.................... SSPBUF=MotorPattern;031A: MOVF 68,W031B: MOVWF 13.................... enable_interrupts(global);031C: MOVLW C0031D: IORWF 0B,F.................... enable_interrupts(INT_SSP); // az budou vyslana, prijde interrupt od SSP031E: BSF 03.5031F: BSF 0C.3........................................ for(n=0; n<=7; n++) // razeni osmi rychlostnich stupnu0320: BCF 03.50321: CLRF 6A0322: MOVF 6A,W0323: SUBLW 070324: BTFSS 03.00325: GOTO 32F.................... {.................... MotorPattern=Pattern[n];0326: MOVF 6A,W0327: CALL 0370328: MOVWF 780329: MOVWF 68.................... delay_ms(razeni); // Pockej na dalsi razeni032A: MOVF 6C,W032B: MOVWF 6F032C: CALL 048.................... };032D: INCF 6A,F032E: GOTO 322.................... SSPSTAT = 0;032F: BSF 03.50330: CLRF 14.................... SSPCON1 = 0; // SPI stop0331: BCF 03.50332: CLRF 14.................... disable_interrupts(INT_SSP); // zastav preruseni od SSP0333: BSF 03.50334: BCF 0C.3........................................ // jedem co to da.................... output_high(MOTOR);0335: BCF 06.20336: BCF 03.50337: BSF 06.2........................................ /*.................... if (TRUE) // Venkovni jizda?.................... {.................... delay_ms(5000); // Venku muzeme jet 5s.................... set_pwm1_duty(0); // Zastav menic.................... // output_low(MOTOR); // Zastav motor.................... while(TRUE) restart_wdt(); // Cekej porad.................... };.................... delay_ms(3000);.................... */.................... delay_ms(1300); // Nemeli bysme jet dele nez 1,3s :-)0338: MOVLW 0A0339: MOVWF 6E033A: MOVLW 82033B: MOVWF 6F033C: CALL 048033D: DECFSZ 6E,F033E: GOTO 33A.................... output_low(MOTOR); // Zastav motor033F: BSF 03.50340: BCF 06.20341: BCF 03.50342: BCF 06.2.................... // Menic je stale zapnut a zatezuje clanky........................................ while(TRUE); // Cekej, dokud se neztrati svetlo,0343: GOTO 343.................... // nebo prijde WatchDog........................................ }0344: SLEEPConfiguration Fuses:Word 1: 273C WDT NOPUT MCLR NOBROWNOUT NOLVP NOCPD NOWRT DEBUG CCPB3 NOPROTECT INTRC_IOWord 2: 3FFC NOFCMEN NOIESO