gta02: Add battery driver
[kernel.git] / arch / arm / mach-s3c2440 / gta02-fiq.c
1 #include <linux/kernel.h>
2
3 #include <asm/fiq.h>
4 #include <mach/regs-irq.h>
5 #include <plat/regs-timer.h>
6 #include <mach/irqs.h>
7 #include <linux/io.h>
8 #include <linux/pwm.h>
9 #include <linux/err.h>
10 #include <linux/hdq.h>
11
12 /* -------------------------------------------------------------------------------
13  * GTA02 FIQ related
14  *
15  * Calls into vibrator and hdq and based on the return values
16  * determines if we the FIQ source be kept alive
17  */
18
19 #define DIVISOR_FROM_US(x) ((x) << 3)
20
21 #ifdef CONFIG_HDQ_GPIO_BITBANG
22 #define FIQ_DIVISOR_HDQ DIVISOR_FROM_US(HDQ_SAMPLE_PERIOD_US)
23 extern int hdq_fiq_handler(void);
24 #endif
25
26 /* Global data related to our fiq source */
27 static uint32_t gta02_fiq_ack_mask;
28 static const int gta02_gta02_fiq_timer_id = 2;
29
30 struct pwm_device* gta02_fiq_timer;
31
32 void gta02_fiq_handler(void)
33 {
34         unsigned long intmask;
35         int keep_running = 0;
36         /* disable further timer interrupts if nobody has any work
37          * or adjust rate according to who still has work
38          *
39          * CAUTION: it means forground code must disable FIQ around
40          * its own non-atomic S3C2410_INTMSK changes... not common
41          * thankfully and taken care of by the fiq-basis patch
42          */
43
44 #ifdef CONFIG_HDQ_GPIO_BITBANG
45         keep_running = hdq_fiq_handler();
46 #endif
47         if (!keep_running) {
48                 /* Disable irq */
49                 intmask = __raw_readl(S3C2410_INTMSK);
50                 intmask |= (gta02_fiq_ack_mask);
51                 __raw_writel(intmask, S3C2410_INTMSK);
52         }
53
54         __raw_writel(gta02_fiq_ack_mask, S3C2410_SRCPND);
55 }
56
57 void gta02_fiq_kick(void)
58 {
59         unsigned long flags;
60         unsigned long intmask;
61         /* we have to take care about FIQ because this modification is
62          * non-atomic, FIQ could come in after the read and before the
63          * writeback and its changes to the register would be lost
64          * (platform INTMSK mod code is taken care of already)
65          */
66         local_save_flags(flags);
67         local_fiq_disable();
68
69         /* allow FIQs to resume */
70         intmask = __raw_readl(S3C2410_INTMSK);
71         intmask &= ~(gta02_fiq_ack_mask);
72         __raw_writel(intmask, S3C2410_INTMSK);
73
74         local_irq_restore(flags);
75
76 }
77
78 int gta02_fiq_enable(void)
79 {
80         int ret = 0;
81
82         local_fiq_disable();
83
84         gta02_fiq_timer = pwm_request(gta02_gta02_fiq_timer_id, "fiq timer");
85
86         if (IS_ERR(gta02_fiq_timer)) {
87                 ret = PTR_ERR(gta02_fiq_timer);
88                 printk("GTA02 FIQ: Could not request fiq timer: %d\n", ret);
89                 return ret;
90         }
91
92         gta02_fiq_ack_mask = 1 << (IRQ_TIMER0 + gta02_gta02_fiq_timer_id
93                                         - S3C2410_CPUIRQ_OFFSET);
94
95
96         ret = pwm_config(gta02_fiq_timer, HDQ_SAMPLE_PERIOD_US * 1000,
97                                         HDQ_SAMPLE_PERIOD_US * 1000);
98         if (ret) {
99                 printk("GTA02 FIQ: Could not configure fiq timer: %d\n", ret);
100                 goto err;
101         }
102
103         set_fiq_c_handler(gta02_fiq_handler);
104
105         __raw_writel(gta02_fiq_ack_mask, S3C2410_INTMOD);
106
107         pwm_enable(gta02_fiq_timer);
108
109         local_fiq_enable();
110
111         return 0;
112
113 err:
114         pwm_free(gta02_fiq_timer);
115
116         return ret;
117 }
118
119 void gta02_fiq_disable(void)
120 {
121         local_fiq_disable();
122
123         if (!gta02_fiq_timer)
124                 return;
125
126         __raw_writel(0, S3C2410_INTMOD);
127         set_fiq_c_handler(NULL);
128
129         pwm_disable(gta02_fiq_timer);
130
131         pwm_free(gta02_fiq_timer);
132
133         gta02_fiq_timer = NULL;
134 }
135 /* -------------------- /GTA02 FIQ Handler ------------------------------------- */