27ae92fe696d4a4637cca35a6a86f713a8cc9cb1
[bertos.git] / phase.c
1 /**
2  * \file
3  * <!--
4  * This file is part of BeRTOS.
5  *
6  * Bertos is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software
18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
19  *
20  * As a special exception, you may use this file as part of a free software
21  * library without restriction.  Specifically, if other files instantiate
22  * templates or use macros or inline functions from this file, or you compile
23  * this file and link it with other files to produce an executable, this
24  * file does not by itself cause the resulting executable to be covered by
25  * the GNU General Public License.  This exception does not however
26  * invalidate any other reasons why the executable file might be covered by
27  * the GNU General Public License.
28  *
29  * Copyright 2005 Develer S.r.l. (http://www.develer.com/)
30  * -->
31  *
32  * \brief Phase control driver (implementation)
33  *
34  * \version $Id$
35  *
36  * \author Francesco Sacchi <batt@develer.com>
37  */
38
39
40 #include "hw/hw_phase.h"
41
42 #include <cfg/macros.h>
43 #include <cfg/compiler.h>
44
45 #include <cpu/irq.h>
46 #include <cpu/types.h>
47
48 #include <drv/timer.h>
49 #include <drv/phase.h>
50
51 #include <math.h>
52
53 #warning TODO:Generalize this moduele for all target supported.
54
55 #if 0
56 /** Array  of triacs */
57 static Triac triacs[TRIAC_CNT];
58
59 DB(bool phase_initialized;)
60
61 /**
62  * Zerocross interrupt, call when 220V cross zero.
63  *
64  * This function turn off all triacs that have duty < 100%
65  * and arm the triac timers for phase control.
66  * This function is frequency adaptive so can work both at 50 or 60Hz.
67  */
68 DEFINE_ZEROCROSS_ISR()
69 {
70         ticks_t period, now;
71         static ticks_t prev_time;
72         TriacDev dev;
73
74         now = timer_clock_unlocked();
75         period = now - prev_time;
76
77         for (dev = 0; dev < TRIAC_CNT; dev++)
78         {
79                 /* Only turn off triac if duty is != 100% */
80                 if (triacs[dev].duty != TRIAC_MAX_DUTY)
81                         TRIAC_OFF(dev);
82                 /* Compute delay from duty */
83                 timer_setDelay(&triacs[dev].timer, DIV_ROUND(period * (TRIAC_MAX_DUTY - triacs[dev].duty), TRIAC_MAX_DUTY));
84
85                 /* This check avoids inserting the same timer twice
86                  * in case of an intempestive zerocross or spike */
87                 if (triacs[dev].running)
88                 {
89                         timer_abort(&triacs[dev].timer);
90                         //kprintf("[%lu]\n", timer_clock());
91                 }
92
93                 triacs[dev].running = true;
94                 timer_add(&triacs[dev].timer);
95         }
96         prev_time = now;
97 }
98
99
100
101 /**
102  * Set duty of the triac channel \a dev (interrupt safe).
103  */
104 void phase_setDuty(TriacDev dev, triac_duty_t duty)
105 {
106         cpuflags_t flags;
107         IRQ_SAVE_DISABLE(flags);
108
109         phase_setDutyUnlock(dev,duty);
110
111         IRQ_RESTORE(flags);
112 }
113
114
115
116 /**
117  * Set duty of the triac channel \a dev (NOT INTERRUPT SAFE).
118  */
119 void phase_setDutyUnlock(TriacDev dev, triac_duty_t duty)
120 {
121         triacs[dev].duty = MIN(duty, (triac_duty_t)TRIAC_MAX_DUTY);
122 }
123
124
125
126 /**
127  * Set power of the triac channel \a dev (interrupt safe).
128  *
129  * This function approsimate the sine wave to a triangular wave to compute
130  * RMS power.
131  */
132 void phase_setPower(TriacDev dev, triac_power_t power)
133 {
134         bool greater_fifty = false;
135         triac_duty_t duty;
136
137         power = MIN(power, (triac_power_t)TRIAC_MAX_POWER);
138
139         if (power > TRIAC_MAX_POWER / 2)
140         {
141                 greater_fifty = true;
142                 power = TRIAC_MAX_POWER - power;
143         }
144
145         duty = TRIAC_POWER_K * sqrt(power);
146
147         if (greater_fifty)
148                 duty = TRIAC_MAX_DUTY - duty;
149         phase_setDuty(dev, duty);
150 }
151
152
153
154 /**
155  * Soft int for each \a _dev triac.
156  *
157  * The triacs are turned on at different time to achieve phase control.
158  */
159 static void phase_softint(void *_dev)
160 {
161         TriacDev dev = (TriacDev)_dev;
162
163         /* Only turn on if duty is !=0 */
164         if (triacs[dev].duty)
165                 TRIAC_ON(dev);
166         triacs[dev].running = false;
167 }
168
169
170
171 /**
172  * Initialize phase control driver
173  */
174 void phase_init(void)
175 {
176         cpuflags_t flags;
177         TriacDev dev;
178
179         /* Init timers and ensure that all triac are off */
180         for (dev = 0; dev < TRIAC_CNT; dev++)
181         {
182                 triacs[dev].duty = 0;
183                 triacs[dev].running = false;
184                 SET_TRIAC_DDR(dev);
185                 TRIAC_OFF(dev);
186                 timer_set_event_softint(&triacs[dev].timer, (Hook)phase_softint, (void *)dev);
187         }
188         IRQ_SAVE_DISABLE(flags);
189
190         /* Init zero cross interrupt */
191         PHASE_HW_INIT;
192         DB(phase_initialized = true;)
193         IRQ_RESTORE(flags);
194 }
195 #endif
196