Add module declaration in PWM driver.
[bertos.git] / bertos / drv / pwm.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  *
33  * \brief PWM driver (implementation)
34  *
35  * \version $Id$
36  *
37  * \author Francesco Sacchi <batt@develer.com>
38  * \author Daniele Basile <asterix@develer.com>
39  */
40
41 #include "cfg/cfg_pwm.h"
42
43 #include <cfg/macros.h>
44 #include <cfg/module.h>
45
46 // Define logging setting (for cfg/log.h module).
47 #define LOG_LEVEL         PWM_LOG_LEVEL
48 #define LOG_VERBOSITY     PWM_LOG_FORMAT
49
50 #include <cfg/log.h>
51 #include <cfg/debug.h>
52
53 #include <drv/pwm.h>
54
55 #include CPU_HEADER(pwm)
56
57 #include <cpu/types.h>
58 #include <cpu/irq.h>
59
60
61 /**
62  * Set duty of pwm channel \p dev.
63  */
64 void pwm_setDuty(PwmDev dev, pwm_duty_t duty)
65 {
66         pwm_period_t period = 0;
67         pwm_duty_t real_duty = 0;
68
69         duty = MIN(duty, PWM_MAX_DUTY);
70
71         period = pwm_hw_getPeriod(dev);
72
73         real_duty = (uint64_t)(duty * period) >> (uint64_t)PWM_MAX_PERIOD_LOG2;
74
75         LOG_INFO("real_duty[%d] duty[%d], period[%d]", real_duty, duty, period);
76         pwm_hw_setDutyUnlock(dev, real_duty);
77 }
78
79 /**
80  * Set frequency of pwm channel \p dev at \p freq in Hz.
81  */
82 void pwm_setFrequency(PwmDev dev, pwm_freq_t freq)
83 {
84         pwm_hw_setFrequency(dev, freq);
85 }
86
87 /**
88  * Set duty of pwm channel \p dev.
89  */
90 void pwm_enable(PwmDev dev, bool state)
91 {
92         if (state)
93                 pwm_hw_enable(dev);
94         else
95                 pwm_hw_disable(dev);
96 }
97
98 MOD_DEFINE(pwm);
99
100 /**
101  * Initialize PWM hw.
102  */
103 void pwm_init(void)
104 {
105         cpu_flags_t flags;
106         PwmDev dev;
107
108         IRQ_SAVE_DISABLE(flags);
109
110         pwm_hw_init();
111
112         /* set all pwm to 0 */
113         for (dev = 0; dev < PWM_CNT; dev++)
114                 pwm_setDuty(dev, 0);
115
116         IRQ_RESTORE(flags);
117         MOD_INIT(pwm);
118 }
119
120
121
122