Blame | Last modification | View Log | Download
#include ".\menic.h"
#define TXo PIN_B5 // To the transmitter modulator
#include ".\AX25.c" // Podprogram pro prenos telemetrie
char AXstring[40]; // Buffer pro prenos telemetrie
#define RAZENI 60 // Po kolika ms se bude menit rychlost pro rozjizdeni
#define REFNOM 107 // Hodnota odpovidajici 1,2V pri nominalnim zatizeni
#define REFSTART 80 // Hodnota odpovidajici 1,2V pri nezatizenych clancich
#define PIEZO PIN_A6 // Jeden pol piezo reproduktoru
#define LED PIN_A7 // LED
#define MENIC PIN_B3 // Spinani tranzistoru menice
#define REFPWR PIN_B1 // Napajeni zdroje referencniho napeti
#define MOTOR PIN_B2 // Spinani tranzistoru motoru
#byte SSPBUF = 0x13 // Registry 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
}
void pip() // pipnuti a bliknuti
{
int1 beep;
int i;
for(i=0; i<250; i++)
{
output_bit(PIEZO, beep);
beep=~beep;
output_bit(LED, beep);
delay_us(100);
};
output_high(PIEZO);
output_high(LED);
}
void cvak() // pouze cvaknuti piezoelementem bez bliknuti
{
output_bit(PIEZO,~input(PIEZO));
}
void main()
{
int8 n;
int8 perioda;
setup_adc_ports(ADC_CLOCK_INTERNAL|sAN4|VSS_VDD);
setup_adc(ADC_CLOCK_INTERNAL);
setup_spi(FALSE);
setup_timer_0(RTCC_INTERNAL|RTCC_DIV_256);
setup_timer_1(T1_DISABLED);
setup_comparator(NC_NC_NC_NC);
setup_vref(FALSE);
output_low(MENIC); // Vsechno zastav
output_low(MOTOR);
output_low(REFPWR);
output_high(LED);
output_high(PIEZO);
set_adc_channel(4); // Vyber AD kanal pro pomerne mereni napeti
set_pwm1_duty(0); // Spust PWM, ale zatim s trvalou 0 na vystupu
setup_ccp1(CCP_PWM); // PWM pro zatizeni clanku v seru
setup_timer_2(T2_DIV_BY_1,100,1); // perioda
setup_oscillator(OSC_4MHZ|OSC_INTRC); // rozjed PIC (zvysi se odber)
// jsme v depu?
set_pwm1_duty(2); // PWM pro zatizeni clanku pri malem osvetleni
n=0;
do
{
output_low(REFPWR);
delay_ms(100);
if (4==n++)
{
cvak(); n=0;
sprintf(AXstring,"Ahoj"); // Convert DATA to String.
SendPacket(&AXstring[0]);
};
output_high(REFPWR); // zapni napajeni napetove reference
delay_ms(1);
} while (read_adc()>REFSTART); // Odkryl starter clanky?
output_low(REFPWR);
pip(); // potvrzeni odstartovani
// regulace
perioda=100; // nastav optimalni periodu pri jedne 500W zarovce
for(n=0;n<=7;n++)
{
set_pwm1_duty(0);
setup_timer_2(T2_DIV_BY_1,perioda,1); // perioda
set_pwm1_duty(19); // delka sepnuti
delay_ms(100);
output_high(REFPWR); // zapni napajeni napetove reference
delay_ms(1);
if (read_adc()<REFNOM) perioda--; // zvyseni zatizeni menice
output_low(REFPWR); // konec mereni, odpoj napajeni reference
};
// nabíjíme
delay_ms(14500); // 14,5s
// rozjezd
SSPSTAT = 0;
SSPCON1 = 0x22; // SPI OSC/64
MotorPattern=0x02; // prvni data pro vyslani
SSPBUF=MotorPattern; // data pro vyslani
enable_interrupts(global);
enable_interrupts(INT_SSP); // az budou vyslana, prijde interrupt od SSP
for(n=0; n<=7; n++) // razeni osmi rychlostnich stupnu
{
MotorPattern=Pattern[n];
delay_ms(RAZENI); // Pockej na dalsi razeni
};
SSPSTAT = 0;
SSPCON1 = 0; // SPI stop
disable_interrupts(INT_SSP); // zastav preruseni od SSP
// jedem co to da
output_high(MOTOR);
delay_ms(1000);
output_low(MOTOR);
set_pwm1_duty(0); // zastav menic
// vybiti kondenzatoru pro ucely mereni
pip();
delay_ms(2000);
pip();
output_high(MOTOR);
while(true)
{
output_high(LED);
output_low(PIEZO);
delay_ms(300);
output_low(LED);
output_high(PIEZO);
delay_ms(300);
}
// priprava na dalsi jizdu
delay_ms(5000);
reset_cpu();
}