Problem with comparison.
/Designs/Measuring_instruments/GM_counter/SW/HV_source/main.c |
---|
0,0 → 1,209 |
#include ".\main.h" |
#define LED1 PIN_C6 //CHANGE PIN_XX TO YOUR LED PIN NUMBER |
#define LED2 PIN_C5 //CHANGE PIN_XX TO YOUR LED PIN NUMBER |
#define LED3 PIN_C4 //CHANGE PIN_XX TO YOUR LED PIN NUMBER |
#define LED4 PIN_D3 //CHANGE PIN_XX TO YOUR LED PIN NUMBER |
#define S1 PIN_B0 //Raw up |
#define S2 PIN_B1 //Raw down |
#define S3 PIN_D0 //Fine up |
#define S4 PIN_D1 //Fine down |
#define BEEP PIN_D2 //piezo beeper |
#define LCD_ENABLE_PIN PIN_E0 //// |
#define LCD_RS_PIN PIN_E1 //// |
#define LCD_RW_PIN PIN_E2 //// |
#define LCD_DATA4 PIN_D4 //// |
#define LCD_DATA5 PIN_D5 //// |
#define LCD_DATA6 PIN_D6 //// |
#define LCD_DATA7 PIN_D7 |
#include <lcd.c> |
#define OUTPUT_ENABLE PIN_B5 |
//#define MAXDUTY (int16)160 // 50 kHz |
#define MAXDUTY (int16)400 // 20 kHz |
//#define MAXDUTY (int16)800 // 10 kHz |
#define HALFDUTY (int16)MAXDUTY/2 |
//#define DIVISOR 199 // 10 kHz |
#define DIVISOR 99 // 20 kHz |
//#define DIVISOR 39 // 50 kHz |
#define MAX_OUTPUT 530 |
#define MIN_OUTPUT 220 |
#define raw_step 50 |
#define fine_step 5 |
/// Linear interpolation parameters |
// |
#define k 0.333961 |
#define q 206.952 |
unsigned int16 setpoint=43; |
unsigned int16 adc_value; |
int1 output_permit=FALSE; |
#INT_AD |
void adc_handler() { |
adc_value = read_adc(ADC_READ_ONLY); |
if(output_permit == TRUE) |
{ |
if (adc_value <= setpoint) |
{ |
set_pwm2_duty((int16)255); // zapnuti menice |
output_low(LED2); |
} |
else // vypnuti menice |
{ |
set_pwm2_duty((int16)MAXDUTY); |
output_high(LED2); |
} |
} |
else |
{ |
set_pwm2_duty((int16)MAXDUTY); |
output_high(LED2); |
} |
read_adc(ADC_START_ONLY); |
} |
void sound_beep( unsigned int lenght, int16 frequency) |
{ |
unsigned int i; |
for(i=0;i<=lenght;i++) |
{ |
output_toggle(BEEP); |
delay_us(1/frequency); |
} |
} |
void main() |
{ |
unsigned int1 button_press; // semafor pro cteni tlacitek |
float output_voltage; |
float voltage_setpoint = 300; |
setup_adc_ports(sAN0|VSS_VREF); |
setup_adc(ADC_CLOCK_DIV_32); |
setup_spi(SPI_SS_DISABLED); |
setup_timer_0(RTCC_EXT_L_TO_H|RTCC_DIV_1); |
setup_timer_1(T1_DISABLED); |
setup_timer_2(T2_DIV_BY_1,DIVISOR,1); |
setup_ccp1(CCP_PWM); |
setup_ccp2(CCP_PWM); |
set_pwm1_duty(HALFDUTY); |
set_pwm2_duty(MAXDUTY); |
setup_comparator(NC_NC_NC_NC);// This device COMP currently not supported by the PICWizard |
setup_oscillator(OSC_8MHZ); |
enable_interrupts(INT_AD); |
enable_interrupts(GLOBAL); |
output_high(LED1); |
output_high(LED2); |
output_high(LED3); |
output_high(LED4); |
output_low(BEEP); |
set_pwm2_duty((int16)MAXDUTY); |
lcd_init(); |
set_adc_channel(0); |
lcd_gotoxy(1,1); |
lcd_putc("HVPS01A"); |
lcd_gotoxy(1,2); |
lcd_putc(" MLAB.cz"); |
Delay_ms(1000); |
lcd_putc("\f"); |
read_adc(ADC_START_ONLY); |
while(true) |
{ |
if(input(OUTPUT_ENABLE)) output_permit=TRUE; |
else output_permit=FALSE; |
output_voltage = adc_value * k + q; |
lcd_gotoxy(1,1); // output voltage out of range |
if (output_voltage > 215) printf(lcd_putc,"%3.0f",output_voltage); |
else printf(lcd_putc,"---"); |
lcd_gotoxy(1,2); |
voltage_setpoint = setpoint * k + q; |
if(input(OUTPUT_ENABLE))printf(lcd_putc,"Set:%3.0f ", voltage_setpoint); // setpoint print |
else printf(lcd_putc,"DISABLED"); |
if(button_press==false ) // tlacitka se ctou znovu pouze pokud v redchozim cyklu nebyla zmacknuta. |
{ |
if(!input(S1)) |
{ |
delay_ms(20); |
if(!input(S1)) |
{ |
button_press=true; |
sound_beep(100,700); |
if(voltage_setpoint < (MAX_OUTPUT - raw_step) ) voltage_setpoint += raw_step; |
else voltage_setpoint = MAX_OUTPUT; |
} |
} |
if(!input(S2)) |
{ |
delay_ms(20); |
if(!input(S2)) |
{ |
button_press=true; |
sound_beep(100,600); |
if(voltage_setpoint > (raw_step + MIN_OUTPUT) ) voltage_setpoint -= raw_step; |
else voltage_setpoint = MIN_OUTPUT; |
} |
} |
if(!input(S3)) |
{ |
delay_ms(20); |
if(!input(S3)) |
{ |
button_press=true; |
sound_beep(100,500); |
if(voltage_setpoint < MAX_OUTPUT - fine_step )voltage_setpoint += fine_step ; |
else voltage_setpoint = MAX_OUTPUT; |
} |
} |
if(!input(S4)) |
{ |
delay_ms(20); |
if(!input(S4)) |
{ |
button_press=true; |
sound_beep(100,400); |
if(voltage_setpoint > (fine_step + MIN_OUTPUT) ) voltage_setpoint -= fine_step; |
else voltage_setpoint = MIN_OUTPUT; |
} |
} |
setpoint =(int16) ((voltage_setpoint - q) / k); |
} |
if ( input(S1) && input(S2) && input(S3) && input(S4) ) button_press=false; |
output_toggle(LED1); |
} |
} |