Subversion Repositories svnkaklik

Rev

Rev 10 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log

Rev 10 Rev 12
Line 71... Line 71...
71 
{
 71 
{
72 
   int8 n;
 72 
   int8 n;
73 
   int8 perioda;
 73 
   int8 perioda;
74 
   int8 razeni;
 74 
   int8 razeni;
75 
   int8 uclanku;
 75 
   int8 uclanku;
- 
 
 76 
   int16 ble;
76 
 
 77 
 
77 
   setup_timer_0(RTCC_INTERNAL);setup_wdt(WDT_1152MS);
 78 
   setup_timer_0(RTCC_INTERNAL);setup_wdt(WDT_1152MS);
78 
   setup_timer_1(T1_DISABLED);
 79 
   setup_timer_1(T1_DISABLED);
79 
   setup_adc_ports(ADC_CLOCK_INTERNAL|sAN0|sAN1|sAN4|VSS_VDD);
 80 
   setup_adc_ports(ADC_CLOCK_INTERNAL|sAN0|sAN1|sAN4|VSS_VDD);
80 
   setup_adc(ADC_CLOCK_INTERNAL);
 81 
   setup_adc(ADC_CLOCK_INTERNAL);
Line 112... Line 113...
112 
//   do
 113 
//   do
113 
//   {
 114 
//   {
114 
      // Precti trimry
 115 
      // Precti trimry
115 
      set_adc_channel(PWM);         // Zjisteni nastaveni PWM
 116 
      set_adc_channel(PWM);         // Zjisteni nastaveni PWM
116 
      delay_us(100);                // Pockej na prepnuti kanalu A/D prevodniku
 117 
      delay_us(100);                // Pockej na prepnuti kanalu A/D prevodniku
117 
      perioda=(read_adc()>>1)+40;   // rozsah: 40 az 167
 118 
      perioda=(read_adc()>>2)+40;   // rozsah: 40 az 103
118 
 
 119 
 
119 
      set_adc_channel(ROZJEZD);     // Zjisteni nastaveni rozjezdu
 120 
      set_adc_channel(ROZJEZD);     // Zjisteni nastaveni rozjezdu
120 
      delay_us(100);                // Pockej na prepnuti kanalu A/D prevodniku
 121 
      delay_us(100);                // Pockej na prepnuti kanalu A/D prevodniku
121 
      razeni=read_adc()>>1;         // rozsah: 0 az 127
 122 
      razeni=read_adc()>>3;         // rozsah: 0 az 31
122 
 
 123 
 
123 
      // Rozjeti menice
 124 
      // Rozjeti menice
124 
      set_pwm1_duty(0);    // Zastav PWM, aby slo nastavit jinou frekvenci
 125 
      set_pwm1_duty(0);    // Zastav PWM, aby slo nastavit jinou frekvenci
125 
      setup_timer_2(T2_DIV_BY_1,perioda,1);    // perioda
 126 
      setup_timer_2(T2_DIV_BY_1,perioda,1);    // perioda
126 
      set_pwm1_duty(DUTY2); // PWM pro zatizeni clanku pri jedne 500W zarovce
 127 
      set_pwm1_duty(DUTY2); // PWM pro zatizeni clanku pri jedne 500W zarovce
Line 129... Line 130...
129 
      delay_ms(500);
 130 
      delay_ms(500);
130 
 
 131 
 
131 
//   } while (input(SW1));      // Je zapnut servisni mod? SW1(OFF)=ANO
 132 
//   } while (input(SW1));      // Je zapnut servisni mod? SW1(OFF)=ANO
132 
//   port_b_pullups(FALSE);     // Vypni pullupy, aby se setrilo energii
 133 
//   port_b_pullups(FALSE);     // Vypni pullupy, aby se setrilo energii
133 
 
 134 
 
134 
// Regulace nabíjení
 135 
   // zmereni napeti na clancich
135 
   output_high(REFPWR);          // Prepni AD na mereni napeti clanku
 136 
   output_high(REFPWR);          // Prepni AD na mereni napeti clanku
136 
   set_adc_channel(NAPETI);      // Prepni Zmer napeti clanku
 137 
   set_adc_channel(NAPETI);      // Prepni Zmer napeti clanku
137 
   delay_us(50);                // Pockej na prepnuti kanalu A/D prevodniku
 138 
   delay_us(50);                // Pockej na prepnuti kanalu A/D prevodniku
138 
   for(n=1;n<=10;n++)
 - 
 
139 
   {
 - 
 
140 
      // Zmer napeti (aktualni zatizeni clanku)
 - 
 
141 
      uclanku=read_adc();
 139 
   uclanku=read_adc();
142 
      // Uprav parametry menice
 - 
 
143 
      if (uclanku>105)
 - 
 
144 
      {
 - 
 
145 
         perioda++;
 - 
 
146 
      }
 - 
 
147 
      else
 - 
 
148 
      {
 - 
 
149 
         perioda--;
 - 
 
150 
      }
 - 
 
151 
      set_pwm1_duty(0);    // Zastav PWM, aby slo nastavit jinou frekvenci
 140 
   output_low(REFPWR);     // odpoj odpor pro mereni napeti
152 
      setup_timer_2(T2_DIV_BY_1,perioda,1);    // perioda
 - 
 
153 
      set_pwm1_duty(DUTY2); // PWM pro zatizeni clanku pri jedne 500W zarovce
 - 
 
154 
      delay_ms(100);
 - 
 
155 
   }
 141 
 
156 
   output_low(REFPWR);
 - 
 
157 
   // posli telemetrii
 142 
   // posli telemetrii
158 
   sprintf(AXstring,"p=%u r=%u u=%u", perioda, razeni, uclanku);  // Convert DATA to String.
 143 
   sprintf(AXstring,"p=%u r=%u u=%u", perioda, razeni, uclanku);  // Convert DATA to String.
159 
   SendPacket(&AXstring[0]);
 144 
   SendPacket(&AXstring[0]);
160 
 
 145 
 
161 
   delay_ms(13000);           // Pockame 14s
 146 
   delay_ms(14000);           // Pockame do 14.5s
162 
 
 147 
 
163 
// rozjezd
 148 
   // rozjezd
164 
   SSPSTAT = 0;                  // inicializace SPI jednotky
 - 
 
165 
   SSPCON1 = 0x22;               // SPI OSC/64
 - 
 
166 
   MotorPattern=0x02;            // prvni data pro vyslani
 - 
 
167 
   SSPBUF=MotorPattern;
 - 
 
168 
   enable_interrupts(global);
 149 
   for(ble=1;ble<=1000;ble++)
169 
   enable_interrupts(INT_SSP);   // az budou vyslana, prijde interrupt od SSP
 - 
 
170 
 
 150 
   {
171 
   for(n=0; n<=7; n++)     // razeni osmi rychlostnich stupnu
 151 
      for(n=0;n<=razeni;n++)
172 
   {
 152 
      {
- 
 
 153 
         output_high(MOTOR);
173 
      MotorPattern=Pattern[n];
 154 
         delay_us(ble);
174 
      delay_ms(razeni);             // Pockej na dalsi razeni
 155 
         output_low(MOTOR);
- 
 
 156 
         delay_us(1000-ble);
175 
   };
 157 
      }
176 
   SSPSTAT = 0;
 158 
   }
177 
   SSPCON1 = 0;                     // SPI stop
 - 
 
178 
   disable_interrupts(INT_SSP);     // zastav preruseni od SSP
 - 
 
179 
 
 159 
 
180 
// jedem co to da
 160 
// jedem co to da
181 
   output_high(MOTOR);
 161 
   output_high(MOTOR);
182 
 
 162 
 
183 
/*
 - 
 
184 
   if (TRUE)         // Venkovni jizda?
 - 
 
185 
   {
 - 
 
186 
      delay_ms(5000);                  // Venku muzeme jet 5s
 - 
 
187 
      set_pwm1_duty(0);                // Zastav menic
 - 
 
188 
//      output_low(MOTOR);               // Zastav motor
 - 
 
189 
      while(TRUE) restart_wdt();       // Cekej porad
 - 
 
190 
   };
 - 
 
191 
   delay_ms(3000);
- 
 
192 
*/
 - 
 
193 
   delay_ms(1300);                  // Nemeli bysme jet dele nez 1,3s :-)
 163 
   delay_ms(1300);                  // Nemeli bysme jet dele nez 1,3s :-)
194 
   output_low(MOTOR);               // Zastav motor
 164 
   output_low(MOTOR);               // Zastav motor
195 
                                    // Menic je stale zapnut a zatezuje clanky
 165 
                                    // Menic je stale zapnut a zatezuje clanky
196 
 
 166 
 
197 
   while(TRUE);            // Cekej, dokud se neztrati svetlo,
 167 
   while(TRUE);            // Cekej, dokud se neztrati svetlo,