Rev 3317 Rev 3318
1 #include ".\main.h" 1 #include ".\main.h"
2   2  
3 #define LED1 PIN_C6 //CHANGE PIN_XX TO YOUR LED PIN NUMBER 3 #define LED1 PIN_C6 //CHANGE PIN_XX TO YOUR LED PIN NUMBER
4 #define LED2 PIN_C5 //CHANGE PIN_XX TO YOUR LED PIN NUMBER 4 #define LED2 PIN_C5 //CHANGE PIN_XX TO YOUR LED PIN NUMBER
5 #define LED3 PIN_C4 //CHANGE PIN_XX TO YOUR LED PIN NUMBER 5 #define LED3 PIN_C4 //CHANGE PIN_XX TO YOUR LED PIN NUMBER
6 #define LED4 PIN_D3 //CHANGE PIN_XX TO YOUR LED PIN NUMBER 6 #define LED4 PIN_D3 //CHANGE PIN_XX TO YOUR LED PIN NUMBER
7   7  
8 #define S1 PIN_B0 //Raw up 8 #define S1 PIN_B0 //Raw up
9 #define S2 PIN_B1 //Raw down 9 #define S2 PIN_B1 //Raw down
10 #define S3 PIN_D0 //Fine up 10 #define S3 PIN_D0 //Fine up
11 #define S4 PIN_D1 //Fine down 11 #define S4 PIN_D1 //Fine down
12   12  
13 #define BEEP PIN_D2 //piezo beeper 13 #define BEEP PIN_D2 //piezo beeper
14   14  
15 #define LCD_ENABLE_PIN PIN_E0 //// 15 #define LCD_ENABLE_PIN PIN_E0 ////
16 #define LCD_RS_PIN PIN_E1 //// 16 #define LCD_RS_PIN PIN_E1 ////
17 #define LCD_RW_PIN PIN_E2 //// 17 #define LCD_RW_PIN PIN_E2 ////
18 #define LCD_DATA4 PIN_D4 //// 18 #define LCD_DATA4 PIN_D4 ////
19 #define LCD_DATA5 PIN_D5 //// 19 #define LCD_DATA5 PIN_D5 ////
20 #define LCD_DATA6 PIN_D6 //// 20 #define LCD_DATA6 PIN_D6 ////
21 #define LCD_DATA7 PIN_D7 21 #define LCD_DATA7 PIN_D7
22 #include <lcd.c> 22 #include <lcd.c>
23   23  
24 #define OUTPUT_ENABLE PIN_B5 24 #define OUTPUT_ENABLE PIN_B5
25   25  
26   26  
27 //#define MAXDUTY (int16)160 // 50 kHz 27 //#define MAXDUTY (int16)160 // 50 kHz
28 #define MAXDUTY (int16)400 // 20 kHz 28 #define MAXDUTY (int16)400 // 20 kHz
29 //#define MAXDUTY (int16)800 // 10 kHz 29 //#define MAXDUTY (int16)800 // 10 kHz
30 #define HALFDUTY (int16)MAXDUTY/2 30 #define HALFDUTY (int16)MAXDUTY/2
31 //#define DIVISOR 199 // 10 kHz 31 //#define DIVISOR 199 // 10 kHz
32 #define DIVISOR 99 // 20 kHz 32 #define DIVISOR 99 // 20 kHz
33 //#define DIVISOR 39 // 50 kHz 33 //#define DIVISOR 39 // 50 kHz
34   34  
35 #define MAX_OUTPUT 530 35 #define MAX_OUTPUT 530
-   36 #define MIN_OUTPUT 220
36 #define raw_step 50 37 #define raw_step 50
37 #define fine_step 5 38 #define fine_step 5
38   39  
39   40  
40   41  
41 /// Linear interpolation parameters 42 /// Linear interpolation parameters
42 // 43 //
43   44  
44 #define k 0.333961 45 #define k 0.333961
45 #define q 206.952 46 #define q 206.952
46   47  
47   48  
48 unsigned int16 setpoint=43; 49 unsigned int16 setpoint=43;
49 unsigned int16 adc_value; 50 unsigned int16 adc_value;
50 int1 output_permit=FALSE; 51 int1 output_permit=FALSE;
51   52  
52 #INT_AD 53 #INT_AD
53 void adc_handler() { 54 void adc_handler() {
54   55  
55 adc_value = read_adc(ADC_READ_ONLY); 56 adc_value = read_adc(ADC_READ_ONLY);
56 if(output_permit == TRUE) 57 if(output_permit == TRUE)
57 { 58 {
58 if (adc_value <= setpoint) 59 if (adc_value <= setpoint)
59 { 60 {
60 set_pwm2_duty((int16)255); // zapnuti menice 61 set_pwm2_duty((int16)255); // zapnuti menice
61 output_low(LED2); 62 output_low(LED2);
62 } 63 }
63 else // vypnuti menice 64 else // vypnuti menice
64 { 65 {
65 set_pwm2_duty((int16)MAXDUTY); 66 set_pwm2_duty((int16)MAXDUTY);
66 output_high(LED2); 67 output_high(LED2);
67 } 68 }
68   69  
69 } 70 }
70 else 71 else
71 { 72 {
72 set_pwm2_duty((int16)MAXDUTY); 73 set_pwm2_duty((int16)MAXDUTY);
73 output_high(LED2); 74 output_high(LED2);
74 } 75 }
75 read_adc(ADC_START_ONLY); 76 read_adc(ADC_START_ONLY);
76 } 77 }
77   78  
78 void sound_beep( unsigned int lenght, int16 frequency) 79 void sound_beep( unsigned int lenght, int16 frequency)
79 { 80 {
80 unsigned int i; 81 unsigned int i;
81 82
82 for(i=0;i<=lenght;i++) 83 for(i=0;i<=lenght;i++)
83 { 84 {
84 output_toggle(BEEP); 85 output_toggle(BEEP);
85 delay_us(1/frequency); 86 delay_us(1/frequency);
86 } 87 }
87 } 88 }
88   89  
89 void main() 90 void main()
90 { 91 {
91 unsigned int1 button_press; // semafor pro cteni tlacitek 92 unsigned int1 button_press; // semafor pro cteni tlacitek
92 float output_voltage; 93 float output_voltage;
93 float voltage_setpoint = 300; 94 float voltage_setpoint = 300;
94   95  
95 setup_adc_ports(sAN0|VSS_VREF); 96 setup_adc_ports(sAN0|VSS_VREF);
96 setup_adc(ADC_CLOCK_DIV_32); 97 setup_adc(ADC_CLOCK_DIV_32);
97 setup_spi(SPI_SS_DISABLED); 98 setup_spi(SPI_SS_DISABLED);
98 setup_timer_0(RTCC_EXT_L_TO_H|RTCC_DIV_1); 99 setup_timer_0(RTCC_EXT_L_TO_H|RTCC_DIV_1);
99 setup_timer_1(T1_DISABLED); 100 setup_timer_1(T1_DISABLED);
100 setup_timer_2(T2_DIV_BY_1,DIVISOR,1); 101 setup_timer_2(T2_DIV_BY_1,DIVISOR,1);
101 setup_ccp1(CCP_PWM); 102 setup_ccp1(CCP_PWM);
102 setup_ccp2(CCP_PWM); 103 setup_ccp2(CCP_PWM);
103 set_pwm1_duty(HALFDUTY); 104 set_pwm1_duty(HALFDUTY);
104 set_pwm2_duty(MAXDUTY); 105 set_pwm2_duty(MAXDUTY);
105 setup_comparator(NC_NC_NC_NC);// This device COMP currently not supported by the PICWizard 106 setup_comparator(NC_NC_NC_NC);// This device COMP currently not supported by the PICWizard
106 setup_oscillator(OSC_8MHZ); 107 setup_oscillator(OSC_8MHZ);
107   108  
108 enable_interrupts(INT_AD); 109 enable_interrupts(INT_AD);
109 enable_interrupts(GLOBAL); 110 enable_interrupts(GLOBAL);
110   111  
111 output_high(LED1); 112 output_high(LED1);
112 output_high(LED2); 113 output_high(LED2);
113 output_high(LED3); 114 output_high(LED3);
114 output_high(LED4); 115 output_high(LED4);
115 output_low(BEEP); 116 output_low(BEEP);
116   117  
117 set_pwm2_duty((int16)MAXDUTY); 118 set_pwm2_duty((int16)MAXDUTY);
118   119  
119 lcd_init(); 120 lcd_init();
120 set_adc_channel(0); 121 set_adc_channel(0);
121 122
122 lcd_gotoxy(1,1); 123 lcd_gotoxy(1,1);
123 lcd_putc("HVPS01A"); 124 lcd_putc("HVPS01A");
124 lcd_gotoxy(1,2); 125 lcd_gotoxy(1,2);
125 lcd_putc(" MLAB.cz"); 126 lcd_putc(" MLAB.cz");
126 Delay_ms(1000); 127 Delay_ms(1000);
127 128
128 lcd_putc("\f"); 129 lcd_putc("\f");
129   130  
130 read_adc(ADC_START_ONLY); 131 read_adc(ADC_START_ONLY);
131 132
132 while(true) 133 while(true)
133 { 134 {
134 if(input(OUTPUT_ENABLE)) output_permit=TRUE; 135 if(input(OUTPUT_ENABLE)) output_permit=TRUE;
135 else output_permit=FALSE; 136 else output_permit=FALSE;
136   137  
137 output_voltage = adc_value * k + q; 138 output_voltage = adc_value * k + q;
138   139  
139 lcd_gotoxy(1,1); 140 lcd_gotoxy(1,1);
140 printf(lcd_putc,"%3.0f",output_voltage); 141 printf(lcd_putc,"%3.0f",output_voltage);
141 lcd_gotoxy(1,2); 142 lcd_gotoxy(1,2);
142   143  
143 voltage_setpoint = setpoint * k + q; 144 voltage_setpoint = setpoint * k + q;
144   145  
145 if(input(OUTPUT_ENABLE))printf(lcd_putc,"Set:%3.0f ", voltage_setpoint); 146 if(input(OUTPUT_ENABLE))printf(lcd_putc,"Set:%3.0f ", voltage_setpoint);
146 else printf(lcd_putc,"DISABLED"); 147 else printf(lcd_putc,"DISABLED");
147   148  
148 if(button_press==false ) // tlacitka se ctou znovu pouze pokud v redchozim cyklu nebyla zmacknuta. 149 if(button_press==false ) // tlacitka se ctou znovu pouze pokud v redchozim cyklu nebyla zmacknuta.
149 { 150 {
150   151  
151 if(!input(S1)) 152 if(!input(S1))
152 { 153 {
153 delay_ms(20); 154 delay_ms(20);
154 if(!input(S1)) 155 if(!input(S1))
155 { 156 {
156 button_press=true; 157 button_press=true;
157 sound_beep(100,700); 158 sound_beep(100,700);
158 if(voltage_setpoint < (MAX_OUTPUT - raw_step) ) voltage_setpoint += raw_step; 159 if(voltage_setpoint < (MAX_OUTPUT - raw_step) ) voltage_setpoint += raw_step;
159 } 160 }
160 } 161 }
161   162  
162 if(!input(S2)) 163 if(!input(S2))
163 { 164 {
164 delay_ms(20); 165 delay_ms(20);
165 if(!input(S2)) 166 if(!input(S2))
166 { 167 {
167 button_press=true; 168 button_press=true;
168 sound_beep(100,600); 169 sound_beep(100,600);
169 if(voltage_setpoint > raw_step ) voltage_setpoint -= raw_step; 170 if(voltage_setpoint > (raw_step + MIN_OUTPUT) ) voltage_setpoint -= raw_step;
170 } 171 }
171 } 172 }
172   173  
173 if(!input(S3)) 174 if(!input(S3))
174 { 175 {
175 delay_ms(20); 176 delay_ms(20);
176 if(!input(S3)) 177 if(!input(S3))
177 { 178 {
178 button_press=true; 179 button_press=true;
179 sound_beep(100,500); 180 sound_beep(100,500);
180 if(voltage_setpoint < MAX_OUTPUT - fine_step )voltage_setpoint += fine_step ; 181 if(voltage_setpoint < MAX_OUTPUT - fine_step )voltage_setpoint += fine_step ;
181 } 182 }
182 } 183 }
183   184  
184 if(!input(S4)) 185 if(!input(S4))
185 { 186 {
186 delay_ms(20); 187 delay_ms(20);
187 if(!input(S4)) 188 if(!input(S4))
188 { 189 {
189 button_press=true; 190 button_press=true;
190 sound_beep(100,400); 191 sound_beep(100,400);
191 if(voltage_setpoint > 0 ) voltage_setpoint -= fine_step; 192 if(voltage_setpoint > (fine_step + MIN_OUTPUT) ) voltage_setpoint -= fine_step;
192 } 193 }
193 } 194 }
194   195  
195 setpoint =(int16) ((voltage_setpoint - q) / k); 196 setpoint =(int16) ((voltage_setpoint - q) / k);
196 } 197 }
197 198
198 if ( input(S1) && input(S2) && input(S3) && input(S4) ) button_press=false; 199 if ( input(S1) && input(S2) && input(S3) && input(S4) ) button_press=false;
199 output_toggle(LED1); 200 output_toggle(LED1);
200 } 201 }
201   202  
202 } 203 }