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