Add demo application.
[bertos.git] / drv / phase.c
1 /*!
2  * \file
3  * <!--
4  * Copyright 2005 Develer S.r.l. (http://www.develer.com/)
5  * -->
6  *
7  * \version $Id$
8  *
9  * \brief Phase control driver (implementation)
10  *
11  * \version $Id$
12  * \author Francesco Sacchi <batt@develer.com>
13  */
14
15 /*#*
16  *#* $Log$
17  *#* Revision 1.1  2005/11/04 18:06:44  bernie
18  *#* Import into DevLib.
19  *#*
20  *#* Revision 1.1  2005/05/24 09:17:58  batt
21  *#* Move drivers to top-level.
22  *#*
23  *#* Revision 1.14  2005/05/20 12:21:05  batt
24  *#* Reformat.
25  *#*
26  *#* Revision 1.13  2005/05/09 16:34:14  batt
27  *#* Change some function names to accomplish coding standard; Add debug phase_initialized; Change duty_t and power_t to uint16_t.
28  *#*
29  *#* Revision 1.12  2005/05/04 17:22:30  batt
30  *#* Workaround a Doxygen parsing problem.
31  *#*
32  *#* Revision 1.11  2005/05/02 09:05:03  batt
33  *#* Rename duty_t and power_t in triac_duty_t and triac_power_t
34  *#*
35  *#* Revision 1.10  2005/05/02 08:48:55  batt
36  *#* Disable interrupt only when necessary.
37  *#*
38  *#* Revision 1.9  2005/04/29 11:52:51  batt
39  *#* Remove debug printf; Add a comment.
40  *#*
41  *#* Revision 1.8  2005/04/29 10:22:56  batt
42  *#* Avoid retriggering TRIAC on low duty-cycle.
43  *#*
44  *#* Revision 1.7  2005/04/29 09:54:36  batt
45  *#* Convert to new timer.
46  *#*
47  *#* Revision 1.6  2005/04/28 17:11:53  batt
48  *#* Expand abbreviation.
49  *#*
50  *#* Revision 1.5  2005/04/28 15:10:11  batt
51  *#* Use timer API to add and set events.
52  *#*
53  *#* Revision 1.4  2005/04/28 12:04:46  batt
54  *#* Add some comments.
55  *#*
56  *#* Revision 1.3  2005/04/28 10:35:45  batt
57  *#* Complete phase_setpower.
58  *#*
59  *#* Revision 1.2  2005/04/27 19:22:49  batt
60  *#* Add duty_t, power_t, MAX_DUTY and MAX_POWER
61  *#*
62  *#* Revision 1.1  2005/04/27 17:13:56  batt
63  *#* Add triac phase control driver.
64  *#*
65  *#*/
66
67 #include <drv/timer.h>
68
69
70 #include <cfg/macros.h>
71 #include <cfg/cpu.h>
72 #include <cfg/compiler.h>
73
74
75 #include <hw_phase.h>
76 #include <drv/phase.h>
77
78 #include <math.h>
79
80 /*! Array  of triacs */
81 static Triac triacs[TRIAC_CNT];
82
83 DB(bool phase_initialized;)
84
85 /*!
86  * Zerocross interrupt, call when 220V cross zero.
87  *
88  * This function turn off all triacs that have duty < 100%
89  * and arm the triac timers for phase control.
90  * This function is frequency adaptive so can work both at 50 or 60Hz.
91  */
92 DEFINE_ZEROCROSS_ISR()
93 {
94         ticks_t period, now;
95         static ticks_t prev_time;
96         TriacDev dev;
97
98         now = timer_clock_unlocked();
99         period = now - prev_time;
100
101         for (dev = 0; dev < TRIAC_CNT; dev++)
102         {
103                 /* Only turn off triac if duty is != 100% */
104                 if (triacs[dev].duty != TRIAC_MAX_DUTY)
105                         TRIAC_OFF(dev);
106                 /* Compute delay from duty */
107                 timer_setDelay(&triacs[dev].timer, ((period * (TRIAC_MAX_DUTY - triacs[dev].duty) + TRIAC_MAX_DUTY / 2) / TRIAC_MAX_DUTY));
108
109                 /* This check avoids inserting the same timer twice
110                  * in case of an intempestive zerocross or spike */
111                 if (triacs[dev].running)
112                 {
113                         timer_abort(&triacs[dev].timer);
114                         //kprintf("[%lu]\n", timer_clock());
115                 }
116
117                 triacs[dev].running = true;
118                 timer_add(&triacs[dev].timer);
119         }
120         prev_time = now;
121 }
122
123
124
125 /*!
126  * Set duty of the triac channel \a dev (interrupt safe).
127  */
128 void phase_setDuty(TriacDev dev, triac_duty_t duty)
129 {
130         cpuflags_t flags;
131         IRQ_SAVE_DISABLE(flags);
132
133         phase_setDutyUnlock(dev,duty);
134
135         IRQ_RESTORE(flags);
136 }
137
138
139
140 /*!
141  * Set duty of the triac channel \a dev (NOT INTERRUPT SAFE).
142  */
143 void phase_setDutyUnlock(TriacDev dev, triac_duty_t duty)
144 {
145         triacs[dev].duty = MIN(duty, (triac_duty_t)TRIAC_MAX_DUTY);
146 }
147
148
149
150 /*!
151  * Set power of the triac channel \a dev (interrupt safe).
152  *
153  * This function approsimate the sine wave to a triangular wave to compute
154  * RMS power.
155  */
156 void phase_setPower(TriacDev dev, triac_power_t power)
157 {
158         bool greater_fifty = false;
159         triac_duty_t duty;
160
161         power = MIN(power, (triac_power_t)TRIAC_MAX_POWER);
162
163         if (power > TRIAC_MAX_POWER / 2)
164         {
165                 greater_fifty = true;
166                 power = TRIAC_MAX_POWER - power;
167         }
168
169         duty = TRIAC_POWER_K * sqrt(power);
170
171         if (greater_fifty)
172                 duty = TRIAC_MAX_DUTY - duty;
173         phase_setDuty(dev, duty);
174 }
175
176
177
178 /*!
179  * Soft int for each \a _dev triac.
180  *
181  * The triacs are turned on at different time to achieve phase control.
182  */
183 static void phase_softint(void *_dev)
184 {
185         TriacDev dev = (TriacDev)_dev;
186
187         /* Only turn on if duty is !=0 */
188         if (triacs[dev].duty)
189                 TRIAC_ON(dev);
190         triacs[dev].running = false;
191 }
192
193
194
195 /*!
196  * Initialize phase control driver
197  */
198 void phase_init(void)
199 {
200         cpuflags_t flags;
201         TriacDev dev;
202
203         /* Init timers and ensure that all triac are off */
204         for (dev = 0; dev < TRIAC_CNT; dev++)
205         {
206                 triacs[dev].duty = 0;
207                 triacs[dev].running = false;
208                 SET_TRIAC_DDR(dev);
209                 TRIAC_OFF(dev);
210                 timer_set_event_softint(&triacs[dev].timer, (Hook)phase_softint, (void *)dev);
211         }
212         IRQ_SAVE_DISABLE(flags);
213
214         /* Init zero cross interrupt */
215         PHASE_HW_INIT;
216         DB(phase_initialized = true;)
217         IRQ_RESTORE(flags);
218 }