Subversion Repositories svnkaklik

Rev

Rev 10 | 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,