Merge branch 'msm-core' of git://codeaurora.org/quic/kernel/dwalker/linux-msm
[linux-2.6-block.git] / arch / arm / mach-msm / dma.c
CommitLineData
bfe645ad
AH
1/* linux/arch/arm/mach-msm/dma.c
2 *
3 * Copyright (C) 2007 Google, Inc.
4 *
5 * This software is licensed under the terms of the GNU General Public
6 * License version 2, as published by the Free Software Foundation, and
7 * may be copied, distributed, and modified under those terms.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 */
15
c5541079
AH
16#include <linux/clk.h>
17#include <linux/err.h>
fced80c7 18#include <linux/io.h>
bfe645ad 19#include <linux/interrupt.h>
a09e64fb 20#include <mach/dma.h>
bfe645ad
AH
21
22#define MSM_DMOV_CHANNEL_COUNT 16
23
24enum {
25 MSM_DMOV_PRINT_ERRORS = 1,
26 MSM_DMOV_PRINT_IO = 2,
27 MSM_DMOV_PRINT_FLOW = 4
28};
29
30static DEFINE_SPINLOCK(msm_dmov_lock);
c5541079 31static struct clk *msm_dmov_clk;
8a0f6f17 32static unsigned int channel_active;
bfe645ad
AH
33static struct list_head ready_commands[MSM_DMOV_CHANNEL_COUNT];
34static struct list_head active_commands[MSM_DMOV_CHANNEL_COUNT];
35unsigned int msm_dmov_print_mask = MSM_DMOV_PRINT_ERRORS;
36
37#define MSM_DMOV_DPRINTF(mask, format, args...) \
38 do { \
39 if ((mask) & msm_dmov_print_mask) \
40 printk(KERN_ERR format, args); \
41 } while (0)
42#define PRINT_ERROR(format, args...) \
43 MSM_DMOV_DPRINTF(MSM_DMOV_PRINT_ERRORS, format, args);
44#define PRINT_IO(format, args...) \
45 MSM_DMOV_DPRINTF(MSM_DMOV_PRINT_IO, format, args);
46#define PRINT_FLOW(format, args...) \
47 MSM_DMOV_DPRINTF(MSM_DMOV_PRINT_FLOW, format, args);
48
8a0f6f17
BS
49void msm_dmov_stop_cmd(unsigned id, struct msm_dmov_cmd *cmd, int graceful)
50{
51 writel((graceful << 31), DMOV_FLUSH0(id));
52}
53
bfe645ad
AH
54void msm_dmov_enqueue_cmd(unsigned id, struct msm_dmov_cmd *cmd)
55{
56 unsigned long irq_flags;
57 unsigned int status;
58
59 spin_lock_irqsave(&msm_dmov_lock, irq_flags);
c5541079
AH
60 if (!channel_active)
61 clk_enable(msm_dmov_clk);
9f68fcdb 62 dsb();
bfe645ad
AH
63 status = readl(DMOV_STATUS(id));
64 if (list_empty(&ready_commands[id]) &&
65 (status & DMOV_STATUS_CMD_PTR_RDY)) {
66#if 0
67 if (list_empty(&active_commands[id])) {
68 PRINT_FLOW("msm_dmov_enqueue_cmd(%d), enable interrupt\n", id);
69 writel(DMOV_CONFIG_IRQ_EN, DMOV_CONFIG(id));
70 }
71#endif
72 PRINT_IO("msm_dmov_enqueue_cmd(%d), start command, status %x\n", id, status);
73 list_add_tail(&cmd->list, &active_commands[id]);
8a0f6f17
BS
74 if (!channel_active)
75 enable_irq(INT_ADM_AARM);
76 channel_active |= 1U << id;
bfe645ad
AH
77 writel(cmd->cmdptr, DMOV_CMD_PTR(id));
78 } else {
c5541079
AH
79 if (!channel_active)
80 clk_disable(msm_dmov_clk);
bfe645ad
AH
81 if (list_empty(&active_commands[id]))
82 PRINT_ERROR("msm_dmov_enqueue_cmd(%d), error datamover stalled, status %x\n", id, status);
83
84 PRINT_IO("msm_dmov_enqueue_cmd(%d), enqueue command, status %x\n", id, status);
85 list_add_tail(&cmd->list, &ready_commands[id]);
86 }
87 spin_unlock_irqrestore(&msm_dmov_lock, irq_flags);
88}
89
90struct msm_dmov_exec_cmdptr_cmd {
91 struct msm_dmov_cmd dmov_cmd;
92 struct completion complete;
93 unsigned id;
94 unsigned int result;
8a0f6f17 95 struct msm_dmov_errdata err;
bfe645ad
AH
96};
97
8a0f6f17
BS
98static void
99dmov_exec_cmdptr_complete_func(struct msm_dmov_cmd *_cmd,
100 unsigned int result,
101 struct msm_dmov_errdata *err)
bfe645ad
AH
102{
103 struct msm_dmov_exec_cmdptr_cmd *cmd = container_of(_cmd, struct msm_dmov_exec_cmdptr_cmd, dmov_cmd);
104 cmd->result = result;
8a0f6f17
BS
105 if (result != 0x80000002 && err)
106 memcpy(&cmd->err, err, sizeof(struct msm_dmov_errdata));
107
bfe645ad
AH
108 complete(&cmd->complete);
109}
110
111int msm_dmov_exec_cmd(unsigned id, unsigned int cmdptr)
112{
113 struct msm_dmov_exec_cmdptr_cmd cmd;
114
115 PRINT_FLOW("dmov_exec_cmdptr(%d, %x)\n", id, cmdptr);
116
117 cmd.dmov_cmd.cmdptr = cmdptr;
118 cmd.dmov_cmd.complete_func = dmov_exec_cmdptr_complete_func;
119 cmd.id = id;
120 init_completion(&cmd.complete);
121
122 msm_dmov_enqueue_cmd(id, &cmd.dmov_cmd);
123 wait_for_completion(&cmd.complete);
124
125 if (cmd.result != 0x80000002) {
126 PRINT_ERROR("dmov_exec_cmdptr(%d): ERROR, result: %x\n", id, cmd.result);
127 PRINT_ERROR("dmov_exec_cmdptr(%d): flush: %x %x %x %x\n",
8a0f6f17 128 id, cmd.err.flush[0], cmd.err.flush[1], cmd.err.flush[2], cmd.err.flush[3]);
bfe645ad
AH
129 return -EIO;
130 }
131 PRINT_FLOW("dmov_exec_cmdptr(%d, %x) done\n", id, cmdptr);
132 return 0;
133}
134
135
136static irqreturn_t msm_datamover_irq_handler(int irq, void *dev_id)
137{
138 unsigned int int_status, mask, id;
139 unsigned long irq_flags;
140 unsigned int ch_status;
141 unsigned int ch_result;
142 struct msm_dmov_cmd *cmd;
143
144 spin_lock_irqsave(&msm_dmov_lock, irq_flags);
145
146 int_status = readl(DMOV_ISR); /* read and clear interrupt */
147 PRINT_FLOW("msm_datamover_irq_handler: DMOV_ISR %x\n", int_status);
148
149 while (int_status) {
150 mask = int_status & -int_status;
151 id = fls(mask) - 1;
152 PRINT_FLOW("msm_datamover_irq_handler %08x %08x id %d\n", int_status, mask, id);
153 int_status &= ~mask;
154 ch_status = readl(DMOV_STATUS(id));
155 if (!(ch_status & DMOV_STATUS_RSLT_VALID)) {
156 PRINT_FLOW("msm_datamover_irq_handler id %d, result not valid %x\n", id, ch_status);
157 continue;
158 }
159 do {
160 ch_result = readl(DMOV_RSLT(id));
161 if (list_empty(&active_commands[id])) {
162 PRINT_ERROR("msm_datamover_irq_handler id %d, got result "
163 "with no active command, status %x, result %x\n",
164 id, ch_status, ch_result);
165 cmd = NULL;
166 } else
167 cmd = list_entry(active_commands[id].next, typeof(*cmd), list);
168 PRINT_FLOW("msm_datamover_irq_handler id %d, status %x, result %x\n", id, ch_status, ch_result);
169 if (ch_result & DMOV_RSLT_DONE) {
170 PRINT_FLOW("msm_datamover_irq_handler id %d, status %x\n",
171 id, ch_status);
172 PRINT_IO("msm_datamover_irq_handler id %d, got result "
173 "for %p, result %x\n", id, cmd, ch_result);
174 if (cmd) {
175 list_del(&cmd->list);
9f68fcdb 176 dsb();
8a0f6f17 177 cmd->complete_func(cmd, ch_result, NULL);
bfe645ad
AH
178 }
179 }
180 if (ch_result & DMOV_RSLT_FLUSH) {
8a0f6f17
BS
181 struct msm_dmov_errdata errdata;
182
183 errdata.flush[0] = readl(DMOV_FLUSH0(id));
184 errdata.flush[1] = readl(DMOV_FLUSH1(id));
185 errdata.flush[2] = readl(DMOV_FLUSH2(id));
186 errdata.flush[3] = readl(DMOV_FLUSH3(id));
187 errdata.flush[4] = readl(DMOV_FLUSH4(id));
188 errdata.flush[5] = readl(DMOV_FLUSH5(id));
bfe645ad 189 PRINT_FLOW("msm_datamover_irq_handler id %d, status %x\n", id, ch_status);
8a0f6f17 190 PRINT_FLOW("msm_datamover_irq_handler id %d, flush, result %x, flush0 %x\n", id, ch_result, errdata.flush[0]);
bfe645ad
AH
191 if (cmd) {
192 list_del(&cmd->list);
9f68fcdb 193 dsb();
8a0f6f17 194 cmd->complete_func(cmd, ch_result, &errdata);
bfe645ad
AH
195 }
196 }
197 if (ch_result & DMOV_RSLT_ERROR) {
8a0f6f17
BS
198 struct msm_dmov_errdata errdata;
199
200 errdata.flush[0] = readl(DMOV_FLUSH0(id));
201 errdata.flush[1] = readl(DMOV_FLUSH1(id));
202 errdata.flush[2] = readl(DMOV_FLUSH2(id));
203 errdata.flush[3] = readl(DMOV_FLUSH3(id));
204 errdata.flush[4] = readl(DMOV_FLUSH4(id));
205 errdata.flush[5] = readl(DMOV_FLUSH5(id));
206
bfe645ad 207 PRINT_ERROR("msm_datamover_irq_handler id %d, status %x\n", id, ch_status);
8a0f6f17 208 PRINT_ERROR("msm_datamover_irq_handler id %d, error, result %x, flush0 %x\n", id, ch_result, errdata.flush[0]);
bfe645ad
AH
209 if (cmd) {
210 list_del(&cmd->list);
9f68fcdb 211 dsb();
8a0f6f17 212 cmd->complete_func(cmd, ch_result, &errdata);
bfe645ad
AH
213 }
214 /* this does not seem to work, once we get an error */
215 /* the datamover will no longer accept commands */
216 writel(0, DMOV_FLUSH0(id));
217 }
218 ch_status = readl(DMOV_STATUS(id));
219 PRINT_FLOW("msm_datamover_irq_handler id %d, status %x\n", id, ch_status);
220 if ((ch_status & DMOV_STATUS_CMD_PTR_RDY) && !list_empty(&ready_commands[id])) {
221 cmd = list_entry(ready_commands[id].next, typeof(*cmd), list);
222 list_del(&cmd->list);
223 list_add_tail(&cmd->list, &active_commands[id]);
224 PRINT_FLOW("msm_datamover_irq_handler id %d, start command\n", id);
225 writel(cmd->cmdptr, DMOV_CMD_PTR(id));
226 }
227 } while (ch_status & DMOV_STATUS_RSLT_VALID);
8a0f6f17
BS
228 if (list_empty(&active_commands[id]) && list_empty(&ready_commands[id]))
229 channel_active &= ~(1U << id);
bfe645ad
AH
230 PRINT_FLOW("msm_datamover_irq_handler id %d, status %x\n", id, ch_status);
231 }
8a0f6f17 232
c5541079 233 if (!channel_active) {
a6407dd7 234 disable_irq_nosync(INT_ADM_AARM);
c5541079
AH
235 clk_disable(msm_dmov_clk);
236 }
8a0f6f17 237
bfe645ad
AH
238 spin_unlock_irqrestore(&msm_dmov_lock, irq_flags);
239 return IRQ_HANDLED;
240}
241
242static int __init msm_init_datamover(void)
243{
244 int i;
8a0f6f17 245 int ret;
c5541079
AH
246 struct clk *clk;
247
bfe645ad
AH
248 for (i = 0; i < MSM_DMOV_CHANNEL_COUNT; i++) {
249 INIT_LIST_HEAD(&ready_commands[i]);
250 INIT_LIST_HEAD(&active_commands[i]);
251 writel(DMOV_CONFIG_IRQ_EN | DMOV_CONFIG_FORCE_TOP_PTR_RSLT | DMOV_CONFIG_FORCE_FLUSH_RSLT, DMOV_CONFIG(i));
252 }
c5541079
AH
253 clk = clk_get(NULL, "adm_clk");
254 if (IS_ERR(clk))
255 return PTR_ERR(clk);
256 msm_dmov_clk = clk;
8a0f6f17
BS
257 ret = request_irq(INT_ADM_AARM, msm_datamover_irq_handler, 0, "msmdatamover", NULL);
258 if (ret)
259 return ret;
260 disable_irq(INT_ADM_AARM);
261 return 0;
bfe645ad
AH
262}
263
264arch_initcall(msm_init_datamover);
265