Rev 3301 Rev 3302
1 #include ".\main.h" 1 #include ".\main.h"
2   2  
3 #define LED1 PIN_C6 //CHANGE PIN_XX TO YOUR LED PIN NUMBER, EX: PIN_A5 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, EX: PIN_A5 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 regreseM (2.02) 35 #define MAX_OUTPUT 706
36 #define regreseN (-451) -  
37   -  
38   -  
39   36  
40 void sound_beep( unsigned int lenght, int16 frequency) 37 void sound_beep( unsigned int lenght, int16 frequency)
41 { 38 {
42 unsigned int i; 39 unsigned int i;
43 40
44 for(i=0;i<=lenght;i++) 41 for(i=0;i<=lenght;i++)
45 { 42 {
46 output_toggle(BEEP); 43 output_toggle(BEEP);
47 delay_us(1/frequency); 44 delay_us(1/frequency);
48 } 45 }
49 } 46 }
50   47  
51 void main() 48 void main()
52 { 49 {
53 unsigned int16 setpoint=43; 50 unsigned int16 setpoint=43;
54 unsigned int16 napeti; 51 unsigned int16 napeti;
55 unsigned int1 button_press; // semafor pro cteni tlacitek 52 unsigned int1 button_press; // semafor pro cteni tlacitek
56   53  
57 setup_adc_ports(sAN0|VSS_VDD); 54 setup_adc_ports(sAN0|VSS_VREF);
58 setup_adc(ADC_CLOCK_DIV_2); 55 setup_adc(ADC_CLOCK_DIV_2);
59 setup_spi(SPI_SS_DISABLED); 56 setup_spi(SPI_SS_DISABLED);
60 setup_timer_0(RTCC_EXT_L_TO_H|RTCC_DIV_1); 57 setup_timer_0(RTCC_EXT_L_TO_H|RTCC_DIV_1);
61 setup_timer_1(T1_DISABLED); 58 setup_timer_1(T1_DISABLED);
62 setup_timer_2(T2_DIV_BY_1,DIVISOR,1); 59 setup_timer_2(T2_DIV_BY_1,DIVISOR,1);
63 setup_ccp1(CCP_PWM); 60 setup_ccp1(CCP_PWM);
64 setup_ccp2(CCP_PWM); 61 setup_ccp2(CCP_PWM);
65 set_pwm1_duty(HALFDUTY); 62 set_pwm1_duty(HALFDUTY);
66 set_pwm2_duty(MAXDUTY); 63 set_pwm2_duty(MAXDUTY);
67 setup_comparator(NC_NC_NC_NC);// This device COMP currently not supported by the PICWizard 64 setup_comparator(NC_NC_NC_NC);// This device COMP currently not supported by the PICWizard
68 setup_oscillator(OSC_8MHZ); 65 setup_oscillator(OSC_8MHZ);
69   66  
70 // set_pwm1_duty(0); -  
71 // set_pwm2_duty(0); -  
72   -  
73 output_high(LED1); 67 output_high(LED1);
74 output_high(LED2); 68 output_high(LED2);
75 output_high(LED3); 69 output_high(LED3);
76 output_high(LED4); 70 output_high(LED4);
77 output_low(BEEP); 71 output_low(BEEP);
78   72  
79 lcd_init(); 73 lcd_init();
80 set_adc_channel(0); 74 set_adc_channel(0);
81 75
82 lcd_gotoxy(1,1); 76 lcd_gotoxy(1,1);
83 lcd_putc("HVPS01A"); 77 lcd_putc("HVPS01A");
84 lcd_gotoxy(1,2); 78 lcd_gotoxy(1,2);
85 lcd_putc(" MLAB.cz"); 79 lcd_putc(" MLAB.cz");
86 Delay_ms(1000); 80 Delay_ms(1000);
87 81
88 lcd_putc("\f"); 82 lcd_putc("\f");
89   83  
90 84
91 while(true) 85 while(true)
92 { 86 {
93 napeti = read_adc(); 87 napeti = read_adc();
94 if(input(OUTPUT_ENABLE)) 88 if(input(OUTPUT_ENABLE))
95 { 89 {
96 if (napeti <= setpoint) 90 if (napeti <= setpoint)
97 { 91 {
98 set_pwm2_duty((int16)255); // zapnuti menice 92 set_pwm2_duty((int16)255); // zapnuti menice
99 output_low(LED2); 93 output_low(LED2);
100 } 94 }
101 else // vypnuti menice 95 else // vypnuti menice
102 { 96 {
103 set_pwm2_duty((int16)MAXDUTY); 97 set_pwm2_duty((int16)MAXDUTY);
104 output_high(LED2); 98 output_high(LED2);
105 } 99 }
106   100  
107 } 101 }
108 else 102 else
109 { 103 {
110 set_pwm2_duty((int16)MAXDUTY); 104 set_pwm2_duty((int16)MAXDUTY);
111 output_high(LED2); 105 output_high(LED2);
112 } 106 }
113 107
114 lcd_gotoxy(1,1); 108 lcd_gotoxy(1,1);
115 printf(lcd_putc,"%4lu",napeti); 109 printf(lcd_putc,"%4lu",napeti);
116 lcd_gotoxy(1,2); 110 lcd_gotoxy(1,2);
117   111  
118 if(input(OUTPUT_ENABLE))printf(lcd_putc,"Set:%lu "setpoint); 112 if(input(OUTPUT_ENABLE))printf(lcd_putc,"Set:%lu "setpoint);
119 else printf(lcd_putc,"DISABLED"); 113 else printf(lcd_putc,"DISABLED");
120   114  
121 if(button_press==false ) // tlacitka se ctou znovu pouze pokud v redchozim cyklu nebyla zmacknuta. 115 if(button_press==false ) // tlacitka se ctou znovu pouze pokud v redchozim cyklu nebyla zmacknuta.
122 { 116 {
123 if(!input(S1)) 117 if(!input(S1))
124 { 118 {
125 delay_ms(20); 119 delay_ms(20);
126 if(!input(S1)) 120 if(!input(S1))
127 { 121 {
128 button_press=true; 122 button_press=true;
129 sound_beep(100,700); 123 sound_beep(100,700);
130 if(setpoint < (1023-5) )setpoint+=5; 124 if(setpoint < (MAX_OUTPUT-5) )setpoint+=5;
131 } 125 }
132 } 126 }
133   127  
134 if(!input(S2)) 128 if(!input(S2))
135 { 129 {
136 delay_ms(20); 130 delay_ms(20);
137 if(!input(S2)) 131 if(!input(S2))
138 { 132 {
139 button_press=true; 133 button_press=true;
140 sound_beep(100,600); 134 sound_beep(100,600);
141 if(setpoint > 0x05 ) setpoint-=5; 135 if(setpoint > 0x05 ) setpoint-=5;
142 } 136 }
143 } 137 }
144   138  
145 if(!input(S3)) 139 if(!input(S3))
146 { 140 {
147 delay_ms(20); 141 delay_ms(20);
148 if(!input(S3)) 142 if(!input(S3))
149 { 143 {
150 button_press=true; 144 button_press=true;
151 sound_beep(100,500); 145 sound_beep(100,500);
152 if(setpoint < 1023 )setpoint++; 146 if(setpoint < MAX_OUTPUT )setpoint++;
153 } 147 }
154 } 148 }
155   149  
156 if(!input(S4)) 150 if(!input(S4))
157 { 151 {
158 delay_ms(20); 152 delay_ms(20);
159 if(!input(S4)) 153 if(!input(S4))
160 { 154 {
161 button_press=true; 155 button_press=true;
162 sound_beep(100,400); 156 sound_beep(100,400);
163 if(setpoint > 0x00 ) setpoint--; 157 if(setpoint > 0x00 ) setpoint--;
164 } 158 }
165 } 159 }
166 } 160 }
167 161
168 if ( input(S1) && input(S2) && input(S3) && input(S4) ) button_press=false; 162 if ( input(S1) && input(S2) && input(S3) && input(S4) ) button_press=false;
169 output_toggle(LED1); 163 output_toggle(LED1);
170 } 164 }
171   165  
172 } 166 }