mei: me: add cannon point device ids
[linux/fpc-iii.git] / drivers / dma / qcom / hidma_ll.c
blob4999e266b2dec83ea3f98fccb28aa08e08595a9b
1 /*
2 * Qualcomm Technologies HIDMA DMA engine low level code
4 * Copyright (c) 2015-2016, The Linux Foundation. All rights reserved.
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 and
8 * only version 2 as published by the Free Software Foundation.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
16 #include <linux/dmaengine.h>
17 #include <linux/slab.h>
18 #include <linux/interrupt.h>
19 #include <linux/mm.h>
20 #include <linux/highmem.h>
21 #include <linux/dma-mapping.h>
22 #include <linux/delay.h>
23 #include <linux/atomic.h>
24 #include <linux/iopoll.h>
25 #include <linux/kfifo.h>
26 #include <linux/bitops.h>
28 #include "hidma.h"
30 #define HIDMA_EVRE_SIZE 16 /* each EVRE is 16 bytes */
32 #define HIDMA_TRCA_CTRLSTS_REG 0x000
33 #define HIDMA_TRCA_RING_LOW_REG 0x008
34 #define HIDMA_TRCA_RING_HIGH_REG 0x00C
35 #define HIDMA_TRCA_RING_LEN_REG 0x010
36 #define HIDMA_TRCA_DOORBELL_REG 0x400
38 #define HIDMA_EVCA_CTRLSTS_REG 0x000
39 #define HIDMA_EVCA_INTCTRL_REG 0x004
40 #define HIDMA_EVCA_RING_LOW_REG 0x008
41 #define HIDMA_EVCA_RING_HIGH_REG 0x00C
42 #define HIDMA_EVCA_RING_LEN_REG 0x010
43 #define HIDMA_EVCA_WRITE_PTR_REG 0x020
44 #define HIDMA_EVCA_DOORBELL_REG 0x400
46 #define HIDMA_EVCA_IRQ_STAT_REG 0x100
47 #define HIDMA_EVCA_IRQ_CLR_REG 0x108
48 #define HIDMA_EVCA_IRQ_EN_REG 0x110
50 #define HIDMA_EVRE_CFG_IDX 0
52 #define HIDMA_EVRE_ERRINFO_BIT_POS 24
53 #define HIDMA_EVRE_CODE_BIT_POS 28
55 #define HIDMA_EVRE_ERRINFO_MASK GENMASK(3, 0)
56 #define HIDMA_EVRE_CODE_MASK GENMASK(3, 0)
58 #define HIDMA_CH_CONTROL_MASK GENMASK(7, 0)
59 #define HIDMA_CH_STATE_MASK GENMASK(7, 0)
60 #define HIDMA_CH_STATE_BIT_POS 0x8
62 #define HIDMA_IRQ_EV_CH_EOB_IRQ_BIT_POS 0
63 #define HIDMA_IRQ_EV_CH_WR_RESP_BIT_POS 1
64 #define HIDMA_IRQ_TR_CH_TRE_RD_RSP_ER_BIT_POS 9
65 #define HIDMA_IRQ_TR_CH_DATA_RD_ER_BIT_POS 10
66 #define HIDMA_IRQ_TR_CH_DATA_WR_ER_BIT_POS 11
67 #define HIDMA_IRQ_TR_CH_INVALID_TRE_BIT_POS 14
69 #define ENABLE_IRQS (BIT(HIDMA_IRQ_EV_CH_EOB_IRQ_BIT_POS) | \
70 BIT(HIDMA_IRQ_EV_CH_WR_RESP_BIT_POS) | \
71 BIT(HIDMA_IRQ_TR_CH_TRE_RD_RSP_ER_BIT_POS) | \
72 BIT(HIDMA_IRQ_TR_CH_DATA_RD_ER_BIT_POS) | \
73 BIT(HIDMA_IRQ_TR_CH_DATA_WR_ER_BIT_POS) | \
74 BIT(HIDMA_IRQ_TR_CH_INVALID_TRE_BIT_POS))
76 #define HIDMA_INCREMENT_ITERATOR(iter, size, ring_size) \
77 do { \
78 iter += size; \
79 if (iter >= ring_size) \
80 iter -= ring_size; \
81 } while (0)
83 #define HIDMA_CH_STATE(val) \
84 ((val >> HIDMA_CH_STATE_BIT_POS) & HIDMA_CH_STATE_MASK)
86 #define HIDMA_ERR_INT_MASK \
87 (BIT(HIDMA_IRQ_TR_CH_INVALID_TRE_BIT_POS) | \
88 BIT(HIDMA_IRQ_TR_CH_TRE_RD_RSP_ER_BIT_POS) | \
89 BIT(HIDMA_IRQ_EV_CH_WR_RESP_BIT_POS) | \
90 BIT(HIDMA_IRQ_TR_CH_DATA_RD_ER_BIT_POS) | \
91 BIT(HIDMA_IRQ_TR_CH_DATA_WR_ER_BIT_POS))
93 enum ch_command {
94 HIDMA_CH_DISABLE = 0,
95 HIDMA_CH_ENABLE = 1,
96 HIDMA_CH_SUSPEND = 2,
97 HIDMA_CH_RESET = 9,
100 enum ch_state {
101 HIDMA_CH_DISABLED = 0,
102 HIDMA_CH_ENABLED = 1,
103 HIDMA_CH_RUNNING = 2,
104 HIDMA_CH_SUSPENDED = 3,
105 HIDMA_CH_STOPPED = 4,
108 enum err_code {
109 HIDMA_EVRE_STATUS_COMPLETE = 1,
110 HIDMA_EVRE_STATUS_ERROR = 4,
113 static int hidma_is_chan_enabled(int state)
115 switch (state) {
116 case HIDMA_CH_ENABLED:
117 case HIDMA_CH_RUNNING:
118 return true;
119 default:
120 return false;
124 void hidma_ll_free(struct hidma_lldev *lldev, u32 tre_ch)
126 struct hidma_tre *tre;
128 if (tre_ch >= lldev->nr_tres) {
129 dev_err(lldev->dev, "invalid TRE number in free:%d", tre_ch);
130 return;
133 tre = &lldev->trepool[tre_ch];
134 if (atomic_read(&tre->allocated) != true) {
135 dev_err(lldev->dev, "trying to free an unused TRE:%d", tre_ch);
136 return;
139 atomic_set(&tre->allocated, 0);
142 int hidma_ll_request(struct hidma_lldev *lldev, u32 sig, const char *dev_name,
143 void (*callback)(void *data), void *data, u32 *tre_ch)
145 unsigned int i;
146 struct hidma_tre *tre;
147 u32 *tre_local;
149 if (!tre_ch || !lldev)
150 return -EINVAL;
152 /* need to have at least one empty spot in the queue */
153 for (i = 0; i < lldev->nr_tres - 1; i++) {
154 if (atomic_add_unless(&lldev->trepool[i].allocated, 1, 1))
155 break;
158 if (i == (lldev->nr_tres - 1))
159 return -ENOMEM;
161 tre = &lldev->trepool[i];
162 tre->dma_sig = sig;
163 tre->dev_name = dev_name;
164 tre->callback = callback;
165 tre->data = data;
166 tre->idx = i;
167 tre->status = 0;
168 tre->queued = 0;
169 tre->err_code = 0;
170 tre->err_info = 0;
171 tre->lldev = lldev;
172 tre_local = &tre->tre_local[0];
173 tre_local[HIDMA_TRE_CFG_IDX] = (lldev->chidx & 0xFF) << 8;
174 tre_local[HIDMA_TRE_CFG_IDX] |= BIT(16); /* set IEOB */
175 *tre_ch = i;
176 if (callback)
177 callback(data);
178 return 0;
182 * Multiple TREs may be queued and waiting in the pending queue.
184 static void hidma_ll_tre_complete(unsigned long arg)
186 struct hidma_lldev *lldev = (struct hidma_lldev *)arg;
187 struct hidma_tre *tre;
189 while (kfifo_out(&lldev->handoff_fifo, &tre, 1)) {
190 /* call the user if it has been read by the hardware */
191 if (tre->callback)
192 tre->callback(tre->data);
196 static int hidma_post_completed(struct hidma_lldev *lldev, u8 err_info,
197 u8 err_code)
199 struct hidma_tre *tre;
200 unsigned long flags;
201 u32 tre_iterator;
203 spin_lock_irqsave(&lldev->lock, flags);
205 tre_iterator = lldev->tre_processed_off;
206 tre = lldev->pending_tre_list[tre_iterator / HIDMA_TRE_SIZE];
207 if (!tre) {
208 spin_unlock_irqrestore(&lldev->lock, flags);
209 dev_warn(lldev->dev, "tre_index [%d] and tre out of sync\n",
210 tre_iterator / HIDMA_TRE_SIZE);
211 return -EINVAL;
213 lldev->pending_tre_list[tre->tre_index] = NULL;
216 * Keep track of pending TREs that SW is expecting to receive
217 * from HW. We got one now. Decrement our counter.
219 if (atomic_dec_return(&lldev->pending_tre_count) < 0) {
220 dev_warn(lldev->dev, "tre count mismatch on completion");
221 atomic_set(&lldev->pending_tre_count, 0);
224 HIDMA_INCREMENT_ITERATOR(tre_iterator, HIDMA_TRE_SIZE,
225 lldev->tre_ring_size);
226 lldev->tre_processed_off = tre_iterator;
227 spin_unlock_irqrestore(&lldev->lock, flags);
229 tre->err_info = err_info;
230 tre->err_code = err_code;
231 tre->queued = 0;
233 kfifo_put(&lldev->handoff_fifo, tre);
234 tasklet_schedule(&lldev->task);
236 return 0;
240 * Called to handle the interrupt for the channel.
241 * Return a positive number if TRE or EVRE were consumed on this run.
242 * Return a positive number if there are pending TREs or EVREs.
243 * Return 0 if there is nothing to consume or no pending TREs/EVREs found.
245 static int hidma_handle_tre_completion(struct hidma_lldev *lldev)
247 u32 evre_ring_size = lldev->evre_ring_size;
248 u32 err_info, err_code, evre_write_off;
249 u32 evre_iterator;
250 u32 num_completed = 0;
252 evre_write_off = readl_relaxed(lldev->evca + HIDMA_EVCA_WRITE_PTR_REG);
253 evre_iterator = lldev->evre_processed_off;
255 if ((evre_write_off > evre_ring_size) ||
256 (evre_write_off % HIDMA_EVRE_SIZE)) {
257 dev_err(lldev->dev, "HW reports invalid EVRE write offset\n");
258 return 0;
262 * By the time control reaches here the number of EVREs and TREs
263 * may not match. Only consume the ones that hardware told us.
265 while ((evre_iterator != evre_write_off)) {
266 u32 *current_evre = lldev->evre_ring + evre_iterator;
267 u32 cfg;
269 cfg = current_evre[HIDMA_EVRE_CFG_IDX];
270 err_info = cfg >> HIDMA_EVRE_ERRINFO_BIT_POS;
271 err_info &= HIDMA_EVRE_ERRINFO_MASK;
272 err_code =
273 (cfg >> HIDMA_EVRE_CODE_BIT_POS) & HIDMA_EVRE_CODE_MASK;
275 if (hidma_post_completed(lldev, err_info, err_code))
276 break;
278 HIDMA_INCREMENT_ITERATOR(evre_iterator, HIDMA_EVRE_SIZE,
279 evre_ring_size);
282 * Read the new event descriptor written by the HW.
283 * As we are processing the delivered events, other events
284 * get queued to the SW for processing.
286 evre_write_off =
287 readl_relaxed(lldev->evca + HIDMA_EVCA_WRITE_PTR_REG);
288 num_completed++;
291 * An error interrupt might have arrived while we are processing
292 * the completed interrupt.
294 if (!hidma_ll_isenabled(lldev))
295 break;
298 if (num_completed) {
299 u32 evre_read_off = (lldev->evre_processed_off +
300 HIDMA_EVRE_SIZE * num_completed);
301 evre_read_off = evre_read_off % evre_ring_size;
302 writel(evre_read_off, lldev->evca + HIDMA_EVCA_DOORBELL_REG);
304 /* record the last processed tre offset */
305 lldev->evre_processed_off = evre_read_off;
308 return num_completed;
311 void hidma_cleanup_pending_tre(struct hidma_lldev *lldev, u8 err_info,
312 u8 err_code)
314 while (atomic_read(&lldev->pending_tre_count)) {
315 if (hidma_post_completed(lldev, err_info, err_code))
316 break;
320 static int hidma_ll_reset(struct hidma_lldev *lldev)
322 u32 val;
323 int ret;
325 val = readl(lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
326 val &= ~(HIDMA_CH_CONTROL_MASK << 16);
327 val |= HIDMA_CH_RESET << 16;
328 writel(val, lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
331 * Delay 10ms after reset to allow DMA logic to quiesce.
332 * Do a polled read up to 1ms and 10ms maximum.
334 ret = readl_poll_timeout(lldev->trca + HIDMA_TRCA_CTRLSTS_REG, val,
335 HIDMA_CH_STATE(val) == HIDMA_CH_DISABLED,
336 1000, 10000);
337 if (ret) {
338 dev_err(lldev->dev, "transfer channel did not reset\n");
339 return ret;
342 val = readl(lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
343 val &= ~(HIDMA_CH_CONTROL_MASK << 16);
344 val |= HIDMA_CH_RESET << 16;
345 writel(val, lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
348 * Delay 10ms after reset to allow DMA logic to quiesce.
349 * Do a polled read up to 1ms and 10ms maximum.
351 ret = readl_poll_timeout(lldev->evca + HIDMA_EVCA_CTRLSTS_REG, val,
352 HIDMA_CH_STATE(val) == HIDMA_CH_DISABLED,
353 1000, 10000);
354 if (ret)
355 return ret;
357 lldev->trch_state = HIDMA_CH_DISABLED;
358 lldev->evch_state = HIDMA_CH_DISABLED;
359 return 0;
363 * The interrupt handler for HIDMA will try to consume as many pending
364 * EVRE from the event queue as possible. Each EVRE has an associated
365 * TRE that holds the user interface parameters. EVRE reports the
366 * result of the transaction. Hardware guarantees ordering between EVREs
367 * and TREs. We use last processed offset to figure out which TRE is
368 * associated with which EVRE. If two TREs are consumed by HW, the EVREs
369 * are in order in the event ring.
371 * This handler will do a one pass for consuming EVREs. Other EVREs may
372 * be delivered while we are working. It will try to consume incoming
373 * EVREs one more time and return.
375 * For unprocessed EVREs, hardware will trigger another interrupt until
376 * all the interrupt bits are cleared.
378 * Hardware guarantees that by the time interrupt is observed, all data
379 * transactions in flight are delivered to their respective places and
380 * are visible to the CPU.
382 * On demand paging for IOMMU is only supported for PCIe via PRI
383 * (Page Request Interface) not for HIDMA. All other hardware instances
384 * including HIDMA work on pinned DMA addresses.
386 * HIDMA is not aware of IOMMU presence since it follows the DMA API. All
387 * IOMMU latency will be built into the data movement time. By the time
388 * interrupt happens, IOMMU lookups + data movement has already taken place.
390 * While the first read in a typical PCI endpoint ISR flushes all outstanding
391 * requests traditionally to the destination, this concept does not apply
392 * here for this HW.
394 static void hidma_ll_int_handler_internal(struct hidma_lldev *lldev, int cause)
396 if (cause & HIDMA_ERR_INT_MASK) {
397 dev_err(lldev->dev, "error 0x%x, disabling...\n",
398 cause);
400 /* Clear out pending interrupts */
401 writel(cause, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
403 /* No further submissions. */
404 hidma_ll_disable(lldev);
406 /* Driver completes the txn and intimates the client.*/
407 hidma_cleanup_pending_tre(lldev, 0xFF,
408 HIDMA_EVRE_STATUS_ERROR);
410 return;
414 * Fine tuned for this HW...
416 * This ISR has been designed for this particular hardware. Relaxed
417 * read and write accessors are used for performance reasons due to
418 * interrupt delivery guarantees. Do not copy this code blindly and
419 * expect that to work.
421 * Try to consume as many EVREs as possible.
423 hidma_handle_tre_completion(lldev);
425 /* We consumed TREs or there are pending TREs or EVREs. */
426 writel_relaxed(cause, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
429 irqreturn_t hidma_ll_inthandler(int chirq, void *arg)
431 struct hidma_lldev *lldev = arg;
432 u32 status;
433 u32 enable;
434 u32 cause;
436 status = readl_relaxed(lldev->evca + HIDMA_EVCA_IRQ_STAT_REG);
437 enable = readl_relaxed(lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
438 cause = status & enable;
440 while (cause) {
441 hidma_ll_int_handler_internal(lldev, cause);
444 * Another interrupt might have arrived while we are
445 * processing this one. Read the new cause.
447 status = readl_relaxed(lldev->evca + HIDMA_EVCA_IRQ_STAT_REG);
448 enable = readl_relaxed(lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
449 cause = status & enable;
452 return IRQ_HANDLED;
455 irqreturn_t hidma_ll_inthandler_msi(int chirq, void *arg, int cause)
457 struct hidma_lldev *lldev = arg;
459 hidma_ll_int_handler_internal(lldev, cause);
460 return IRQ_HANDLED;
463 int hidma_ll_enable(struct hidma_lldev *lldev)
465 u32 val;
466 int ret;
468 val = readl(lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
469 val &= ~(HIDMA_CH_CONTROL_MASK << 16);
470 val |= HIDMA_CH_ENABLE << 16;
471 writel(val, lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
473 ret = readl_poll_timeout(lldev->evca + HIDMA_EVCA_CTRLSTS_REG, val,
474 hidma_is_chan_enabled(HIDMA_CH_STATE(val)),
475 1000, 10000);
476 if (ret) {
477 dev_err(lldev->dev, "event channel did not get enabled\n");
478 return ret;
481 val = readl(lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
482 val &= ~(HIDMA_CH_CONTROL_MASK << 16);
483 val |= HIDMA_CH_ENABLE << 16;
484 writel(val, lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
486 ret = readl_poll_timeout(lldev->trca + HIDMA_TRCA_CTRLSTS_REG, val,
487 hidma_is_chan_enabled(HIDMA_CH_STATE(val)),
488 1000, 10000);
489 if (ret) {
490 dev_err(lldev->dev, "transfer channel did not get enabled\n");
491 return ret;
494 lldev->trch_state = HIDMA_CH_ENABLED;
495 lldev->evch_state = HIDMA_CH_ENABLED;
497 /* enable irqs */
498 writel(ENABLE_IRQS, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
500 return 0;
503 void hidma_ll_start(struct hidma_lldev *lldev)
505 unsigned long irqflags;
507 spin_lock_irqsave(&lldev->lock, irqflags);
508 writel(lldev->tre_write_offset, lldev->trca + HIDMA_TRCA_DOORBELL_REG);
509 spin_unlock_irqrestore(&lldev->lock, irqflags);
512 bool hidma_ll_isenabled(struct hidma_lldev *lldev)
514 u32 val;
516 val = readl(lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
517 lldev->trch_state = HIDMA_CH_STATE(val);
518 val = readl(lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
519 lldev->evch_state = HIDMA_CH_STATE(val);
521 /* both channels have to be enabled before calling this function */
522 if (hidma_is_chan_enabled(lldev->trch_state) &&
523 hidma_is_chan_enabled(lldev->evch_state))
524 return true;
526 return false;
529 void hidma_ll_queue_request(struct hidma_lldev *lldev, u32 tre_ch)
531 struct hidma_tre *tre;
532 unsigned long flags;
534 tre = &lldev->trepool[tre_ch];
536 /* copy the TRE into its location in the TRE ring */
537 spin_lock_irqsave(&lldev->lock, flags);
538 tre->tre_index = lldev->tre_write_offset / HIDMA_TRE_SIZE;
539 lldev->pending_tre_list[tre->tre_index] = tre;
540 memcpy(lldev->tre_ring + lldev->tre_write_offset,
541 &tre->tre_local[0], HIDMA_TRE_SIZE);
542 tre->err_code = 0;
543 tre->err_info = 0;
544 tre->queued = 1;
545 atomic_inc(&lldev->pending_tre_count);
546 lldev->tre_write_offset = (lldev->tre_write_offset + HIDMA_TRE_SIZE)
547 % lldev->tre_ring_size;
548 spin_unlock_irqrestore(&lldev->lock, flags);
552 * Note that even though we stop this channel if there is a pending transaction
553 * in flight it will complete and follow the callback. This request will
554 * prevent further requests to be made.
556 int hidma_ll_disable(struct hidma_lldev *lldev)
558 u32 val;
559 int ret;
561 /* The channel needs to be in working state */
562 if (!hidma_ll_isenabled(lldev))
563 return 0;
565 val = readl(lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
566 val &= ~(HIDMA_CH_CONTROL_MASK << 16);
567 val |= HIDMA_CH_SUSPEND << 16;
568 writel(val, lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
571 * Start the wait right after the suspend is confirmed.
572 * Do a polled read up to 1ms and 10ms maximum.
574 ret = readl_poll_timeout(lldev->trca + HIDMA_TRCA_CTRLSTS_REG, val,
575 HIDMA_CH_STATE(val) == HIDMA_CH_SUSPENDED,
576 1000, 10000);
577 if (ret)
578 return ret;
580 val = readl(lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
581 val &= ~(HIDMA_CH_CONTROL_MASK << 16);
582 val |= HIDMA_CH_SUSPEND << 16;
583 writel(val, lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
586 * Start the wait right after the suspend is confirmed
587 * Delay up to 10ms after reset to allow DMA logic to quiesce.
589 ret = readl_poll_timeout(lldev->evca + HIDMA_EVCA_CTRLSTS_REG, val,
590 HIDMA_CH_STATE(val) == HIDMA_CH_SUSPENDED,
591 1000, 10000);
592 if (ret)
593 return ret;
595 lldev->trch_state = HIDMA_CH_SUSPENDED;
596 lldev->evch_state = HIDMA_CH_SUSPENDED;
598 /* disable interrupts */
599 writel(0, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
600 return 0;
603 void hidma_ll_set_transfer_params(struct hidma_lldev *lldev, u32 tre_ch,
604 dma_addr_t src, dma_addr_t dest, u32 len,
605 u32 flags, u32 txntype)
607 struct hidma_tre *tre;
608 u32 *tre_local;
610 if (tre_ch >= lldev->nr_tres) {
611 dev_err(lldev->dev, "invalid TRE number in transfer params:%d",
612 tre_ch);
613 return;
616 tre = &lldev->trepool[tre_ch];
617 if (atomic_read(&tre->allocated) != true) {
618 dev_err(lldev->dev, "trying to set params on an unused TRE:%d",
619 tre_ch);
620 return;
623 tre_local = &tre->tre_local[0];
624 tre_local[HIDMA_TRE_CFG_IDX] &= ~GENMASK(7, 0);
625 tre_local[HIDMA_TRE_CFG_IDX] |= txntype;
626 tre_local[HIDMA_TRE_LEN_IDX] = len;
627 tre_local[HIDMA_TRE_SRC_LOW_IDX] = lower_32_bits(src);
628 tre_local[HIDMA_TRE_SRC_HI_IDX] = upper_32_bits(src);
629 tre_local[HIDMA_TRE_DEST_LOW_IDX] = lower_32_bits(dest);
630 tre_local[HIDMA_TRE_DEST_HI_IDX] = upper_32_bits(dest);
631 tre->int_flags = flags;
635 * Called during initialization and after an error condition
636 * to restore hardware state.
638 int hidma_ll_setup(struct hidma_lldev *lldev)
640 int rc;
641 u64 addr;
642 u32 val;
643 u32 nr_tres = lldev->nr_tres;
645 atomic_set(&lldev->pending_tre_count, 0);
646 lldev->tre_processed_off = 0;
647 lldev->evre_processed_off = 0;
648 lldev->tre_write_offset = 0;
650 /* disable interrupts */
651 writel(0, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
653 /* clear all pending interrupts */
654 val = readl(lldev->evca + HIDMA_EVCA_IRQ_STAT_REG);
655 writel(val, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
657 rc = hidma_ll_reset(lldev);
658 if (rc)
659 return rc;
662 * Clear all pending interrupts again.
663 * Otherwise, we observe reset complete interrupts.
665 val = readl(lldev->evca + HIDMA_EVCA_IRQ_STAT_REG);
666 writel(val, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
668 /* disable interrupts again after reset */
669 writel(0, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
671 addr = lldev->tre_dma;
672 writel(lower_32_bits(addr), lldev->trca + HIDMA_TRCA_RING_LOW_REG);
673 writel(upper_32_bits(addr), lldev->trca + HIDMA_TRCA_RING_HIGH_REG);
674 writel(lldev->tre_ring_size, lldev->trca + HIDMA_TRCA_RING_LEN_REG);
676 addr = lldev->evre_dma;
677 writel(lower_32_bits(addr), lldev->evca + HIDMA_EVCA_RING_LOW_REG);
678 writel(upper_32_bits(addr), lldev->evca + HIDMA_EVCA_RING_HIGH_REG);
679 writel(HIDMA_EVRE_SIZE * nr_tres,
680 lldev->evca + HIDMA_EVCA_RING_LEN_REG);
682 /* configure interrupts */
683 hidma_ll_setup_irq(lldev, lldev->msi_support);
685 rc = hidma_ll_enable(lldev);
686 if (rc)
687 return rc;
689 return rc;
692 void hidma_ll_setup_irq(struct hidma_lldev *lldev, bool msi)
694 u32 val;
696 lldev->msi_support = msi;
698 /* disable interrupts again after reset */
699 writel(0, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
700 writel(0, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
702 /* support IRQ by default */
703 val = readl(lldev->evca + HIDMA_EVCA_INTCTRL_REG);
704 val &= ~0xF;
705 if (!lldev->msi_support)
706 val = val | 0x1;
707 writel(val, lldev->evca + HIDMA_EVCA_INTCTRL_REG);
709 /* clear all pending interrupts and enable them */
710 writel(ENABLE_IRQS, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
711 writel(ENABLE_IRQS, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
714 struct hidma_lldev *hidma_ll_init(struct device *dev, u32 nr_tres,
715 void __iomem *trca, void __iomem *evca,
716 u8 chidx)
718 u32 required_bytes;
719 struct hidma_lldev *lldev;
720 int rc;
721 size_t sz;
723 if (!trca || !evca || !dev || !nr_tres)
724 return NULL;
726 /* need at least four TREs */
727 if (nr_tres < 4)
728 return NULL;
730 /* need an extra space */
731 nr_tres += 1;
733 lldev = devm_kzalloc(dev, sizeof(struct hidma_lldev), GFP_KERNEL);
734 if (!lldev)
735 return NULL;
737 lldev->evca = evca;
738 lldev->trca = trca;
739 lldev->dev = dev;
740 sz = sizeof(struct hidma_tre);
741 lldev->trepool = devm_kcalloc(lldev->dev, nr_tres, sz, GFP_KERNEL);
742 if (!lldev->trepool)
743 return NULL;
745 required_bytes = sizeof(lldev->pending_tre_list[0]);
746 lldev->pending_tre_list = devm_kcalloc(dev, nr_tres, required_bytes,
747 GFP_KERNEL);
748 if (!lldev->pending_tre_list)
749 return NULL;
751 sz = (HIDMA_TRE_SIZE + 1) * nr_tres;
752 lldev->tre_ring = dmam_alloc_coherent(dev, sz, &lldev->tre_dma,
753 GFP_KERNEL);
754 if (!lldev->tre_ring)
755 return NULL;
757 memset(lldev->tre_ring, 0, (HIDMA_TRE_SIZE + 1) * nr_tres);
758 lldev->tre_ring_size = HIDMA_TRE_SIZE * nr_tres;
759 lldev->nr_tres = nr_tres;
761 /* the TRE ring has to be TRE_SIZE aligned */
762 if (!IS_ALIGNED(lldev->tre_dma, HIDMA_TRE_SIZE)) {
763 u8 tre_ring_shift;
765 tre_ring_shift = lldev->tre_dma % HIDMA_TRE_SIZE;
766 tre_ring_shift = HIDMA_TRE_SIZE - tre_ring_shift;
767 lldev->tre_dma += tre_ring_shift;
768 lldev->tre_ring += tre_ring_shift;
771 sz = (HIDMA_EVRE_SIZE + 1) * nr_tres;
772 lldev->evre_ring = dmam_alloc_coherent(dev, sz, &lldev->evre_dma,
773 GFP_KERNEL);
774 if (!lldev->evre_ring)
775 return NULL;
777 memset(lldev->evre_ring, 0, (HIDMA_EVRE_SIZE + 1) * nr_tres);
778 lldev->evre_ring_size = HIDMA_EVRE_SIZE * nr_tres;
780 /* the EVRE ring has to be EVRE_SIZE aligned */
781 if (!IS_ALIGNED(lldev->evre_dma, HIDMA_EVRE_SIZE)) {
782 u8 evre_ring_shift;
784 evre_ring_shift = lldev->evre_dma % HIDMA_EVRE_SIZE;
785 evre_ring_shift = HIDMA_EVRE_SIZE - evre_ring_shift;
786 lldev->evre_dma += evre_ring_shift;
787 lldev->evre_ring += evre_ring_shift;
789 lldev->nr_tres = nr_tres;
790 lldev->chidx = chidx;
792 sz = nr_tres * sizeof(struct hidma_tre *);
793 rc = kfifo_alloc(&lldev->handoff_fifo, sz, GFP_KERNEL);
794 if (rc)
795 return NULL;
797 rc = hidma_ll_setup(lldev);
798 if (rc)
799 return NULL;
801 spin_lock_init(&lldev->lock);
802 tasklet_init(&lldev->task, hidma_ll_tre_complete, (unsigned long)lldev);
803 lldev->initialized = 1;
804 writel(ENABLE_IRQS, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
805 return lldev;
808 int hidma_ll_uninit(struct hidma_lldev *lldev)
810 u32 required_bytes;
811 int rc = 0;
812 u32 val;
814 if (!lldev)
815 return -ENODEV;
817 if (!lldev->initialized)
818 return 0;
820 lldev->initialized = 0;
822 required_bytes = sizeof(struct hidma_tre) * lldev->nr_tres;
823 tasklet_kill(&lldev->task);
824 memset(lldev->trepool, 0, required_bytes);
825 lldev->trepool = NULL;
826 atomic_set(&lldev->pending_tre_count, 0);
827 lldev->tre_write_offset = 0;
829 rc = hidma_ll_reset(lldev);
832 * Clear all pending interrupts again.
833 * Otherwise, we observe reset complete interrupts.
835 val = readl(lldev->evca + HIDMA_EVCA_IRQ_STAT_REG);
836 writel(val, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
837 writel(0, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
838 return rc;
841 enum dma_status hidma_ll_status(struct hidma_lldev *lldev, u32 tre_ch)
843 enum dma_status ret = DMA_ERROR;
844 struct hidma_tre *tre;
845 unsigned long flags;
846 u8 err_code;
848 spin_lock_irqsave(&lldev->lock, flags);
850 tre = &lldev->trepool[tre_ch];
851 err_code = tre->err_code;
853 if (err_code & HIDMA_EVRE_STATUS_COMPLETE)
854 ret = DMA_COMPLETE;
855 else if (err_code & HIDMA_EVRE_STATUS_ERROR)
856 ret = DMA_ERROR;
857 else
858 ret = DMA_IN_PROGRESS;
859 spin_unlock_irqrestore(&lldev->lock, flags);
861 return ret;