Subversion Repositories svnkaklik

Rev

Go to most recent revision | Details | Last modification | View Log

Rev Author Line No. Line
162 kaklik 1
//----------------------------
2
// Sagitta - 9. 9. 2005
3
//----------------------------
4
 
5
#include ".\menic.h"
6
 
7
#define RAZENI    55    // Po kolika ms se bude menit rychlost pri rozjizdeni
8
#define REFSTART  120   // Hodnota komparatoru odpovidajici 1,7V pri
9
                        // nezatizenych solarnich clancich
10
#define DUTY1     2     // Delka sepnuti PWM v us pro sero
11
#define DUTY2     20    // Delka sepnuti PWM v us pro jednu zarovku 500W
12
 
13
// Tabulka napeti vuci referencni LED (cca 1,7V)
14
// hodnota prevodniku / napeti na clancich
15
// 250   1,6V
16
// 200   2,1V
17
// 150   2,8V
18
// 145   2,9V
19
// 120   3,6V
20
// 110   4,0V
21
 
22
#define MENIC  PIN_B3   // Spinani tranzistoru menice
23
#define REFPWR PIN_B1   // Napajeni zdroje referencniho napeti
24
#define MOTOR  PIN_B2   // Spinani tranzistoru motoru
25
 
26
#byte SSPBUF   = 0x13   // Registry jednotky SSP
27
#byte SSPCON1  = 0x14
28
#byte SSPSTAT  = 0x94
29
 
30
// Vzorky pro generovani PWM pomoci SSP
31
unsigned int8 const Pattern[8] = {0x02,0x06,0x0e,0x1e,0x3e,0x7e,0xfe,0xff};
32
unsigned int8 MotorPattern;
33
 
34
#INT_SSP
35
void IntSSP()     // Vyvola se po odeslani znaku pres SSP
36
{
37
   SSPBUF=MotorPattern;       // znovu vysli stejnou hodnotu
38
}
39
 
40
void main()
41
{
42
   int8 n;
43
   int8 cekej;
44
   int8 perioda;
45
   int8 rozjezd;
46
 
47
   // Inicializace casovacu a prevodniku
48
   setup_timer_0(RTCC_INTERNAL);setup_wdt(WDT_1152MS);
49
   setup_adc_ports(ADC_CLOCK_INTERNAL|sAN1|sAN4|VSS_VDD);
50
   setup_adc(ADC_CLOCK_INTERNAL);
51
   setup_spi(FALSE);
52
   setup_timer_1(T1_DISABLED);
53
   setup_comparator(NC_NC_NC_NC);
54
   setup_vref(FALSE);
55
 
56
   output_low(MENIC);      // Vsechno zastav
57
   output_low(MOTOR);
58
   output_low(REFPWR);
59
 
60
   set_adc_channel(4);     // Vyber AD kanal pro pomerne mereni napeti
61
   set_pwm1_duty(0);       // Spust PWM, ale zatim s trvalou 0 na vystupu
62
   setup_ccp1(CCP_PWM);             // PWM pro zatizeni clanku v seru
63
   setup_timer_2(T2_DIV_BY_1,100,1); // perioda PWM
64
 
65
   setup_oscillator(OSC_4MHZ|OSC_INTRC); // rozjed PIC (zvysi se odber)
66
 
67
// jsme v depu?
68
   set_pwm1_duty(DUTY1);                     // delka sepnuti
69
   do
70
   {
71
      output_low(REFPWR);
72
      delay_ms(100);
73
      output_high(REFPWR);          // zapni napajeni napetove reference (LED)
74
      delay_ms(20);
75
   } while (read_adc()>REFSTART);   // Odkryl starter clanky?
76
   output_low(REFPWR);
77
 
78
   // Precti trimr
79
   set_adc_channel(1);           // Zjisteni nastaveni trimru PWM
80
   delay_us(100);                // Pockej na prepnuti kanalu A/D prevodniku
81
   perioda=(read_adc()>>1)+40;   // rozsah: 40 az 167
82
   set_pwm1_duty(0);       // Zastav PWM, aby slo zmenit periodu
83
   setup_timer_2(T2_DIV_BY_1,perioda,1); // Zapis nastavenou periodu
84
 
85
// nabíjíme
86
   set_pwm1_duty(DUTY2);            // delka sepnuti PWM
87
   delay_ms(12500);
88
 
89
// rozjezd
90
   SSPSTAT = 0;                  // inicializace SPI jednotky
91
   SSPCON1 = 0x22;               // SPI OSC/64
92
   MotorPattern=Pattern[0];
93
   SSPBUF=MotorPattern;          // 1. data pro vyslani
94
   enable_interrupts(global);
95
   enable_interrupts(INT_SSP);   // az budou vyslana, prijde preruseni
96
 
97
   for(n=0; n<=7; n++)     // razeni osmi rychlostnich stupnu
98
   {
99
      MotorPattern=Pattern[n];
100
      delay_ms(RAZENI);             // Pockej na dalsi razeni
101
   };
102
   SSPSTAT = 0;
103
   SSPCON1 = 0;                     // SPI stop
104
   disable_interrupts(INT_SSP);     // zastav preruseni od SSP
105
 
106
// jedem co to da
107
   output_high(MOTOR);
108
   delay_ms(1300);         // dyl jak 1,3s bysme nemeli jet :)
109
   output_low(MOTOR);      // zastav motor
110
                           // Menic je stale zapnut a zatezuje clanky
111
 
112
   while(TRUE);            // Cekej, dokud se neztrati svetlo,
113
                           // nebo prijde WatchDog
114
}