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>
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>
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) \
79 if (iter >= ring_size) \
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))
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,
109 HIDMA_EVRE_STATUS_COMPLETE
= 1,
110 HIDMA_EVRE_STATUS_ERROR
= 4,
113 static int hidma_is_chan_enabled(int state
)
116 case HIDMA_CH_ENABLED
:
117 case HIDMA_CH_RUNNING
:
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
);
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
);
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
)
146 struct hidma_tre
*tre
;
149 if (!tre_ch
|| !lldev
)
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))
158 if (i
== (lldev
->nr_tres
- 1))
161 tre
= &lldev
->trepool
[i
];
163 tre
->dev_name
= dev_name
;
164 tre
->callback
= callback
;
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 */
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 */
192 tre
->callback(tre
->data
);
196 static int hidma_post_completed(struct hidma_lldev
*lldev
, u8 err_info
,
199 struct hidma_tre
*tre
;
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
];
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
);
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
;
233 kfifo_put(&lldev
->handoff_fifo
, tre
);
234 tasklet_schedule(&lldev
->task
);
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
;
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");
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
;
269 cfg
= current_evre
[HIDMA_EVRE_CFG_IDX
];
270 err_info
= cfg
>> HIDMA_EVRE_ERRINFO_BIT_POS
;
271 err_info
&= HIDMA_EVRE_ERRINFO_MASK
;
273 (cfg
>> HIDMA_EVRE_CODE_BIT_POS
) & HIDMA_EVRE_CODE_MASK
;
275 if (hidma_post_completed(lldev
, err_info
, err_code
))
278 HIDMA_INCREMENT_ITERATOR(evre_iterator
, HIDMA_EVRE_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.
287 readl_relaxed(lldev
->evca
+ HIDMA_EVCA_WRITE_PTR_REG
);
291 * An error interrupt might have arrived while we are processing
292 * the completed interrupt.
294 if (!hidma_ll_isenabled(lldev
))
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
,
314 while (atomic_read(&lldev
->pending_tre_count
)) {
315 if (hidma_post_completed(lldev
, err_info
, err_code
))
320 static int hidma_ll_reset(struct hidma_lldev
*lldev
)
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
,
338 dev_err(lldev
->dev
, "transfer channel did not reset\n");
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
,
357 lldev
->trch_state
= HIDMA_CH_DISABLED
;
358 lldev
->evch_state
= HIDMA_CH_DISABLED
;
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
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",
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
);
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
;
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
;
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
;
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
);
463 int hidma_ll_enable(struct hidma_lldev
*lldev
)
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
)),
477 dev_err(lldev
->dev
, "event channel did not get enabled\n");
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
)),
490 dev_err(lldev
->dev
, "transfer channel did not get enabled\n");
494 lldev
->trch_state
= HIDMA_CH_ENABLED
;
495 lldev
->evch_state
= HIDMA_CH_ENABLED
;
498 writel(ENABLE_IRQS
, lldev
->evca
+ HIDMA_EVCA_IRQ_EN_REG
);
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
)
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
))
529 void hidma_ll_queue_request(struct hidma_lldev
*lldev
, u32 tre_ch
)
531 struct hidma_tre
*tre
;
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
);
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
)
561 /* The channel needs to be in working state */
562 if (!hidma_ll_isenabled(lldev
))
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
,
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
,
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
);
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
;
610 if (tre_ch
>= lldev
->nr_tres
) {
611 dev_err(lldev
->dev
, "invalid TRE number in transfer params:%d",
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",
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
)
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
);
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
);
692 void hidma_ll_setup_irq(struct hidma_lldev
*lldev
, bool msi
)
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
);
705 if (!lldev
->msi_support
)
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
,
719 struct hidma_lldev
*lldev
;
723 if (!trca
|| !evca
|| !dev
|| !nr_tres
)
726 /* need at least four TREs */
730 /* need an extra space */
733 lldev
= devm_kzalloc(dev
, sizeof(struct hidma_lldev
), GFP_KERNEL
);
740 sz
= sizeof(struct hidma_tre
);
741 lldev
->trepool
= devm_kcalloc(lldev
->dev
, nr_tres
, sz
, GFP_KERNEL
);
745 required_bytes
= sizeof(lldev
->pending_tre_list
[0]);
746 lldev
->pending_tre_list
= devm_kcalloc(dev
, nr_tres
, required_bytes
,
748 if (!lldev
->pending_tre_list
)
751 sz
= (HIDMA_TRE_SIZE
+ 1) * nr_tres
;
752 lldev
->tre_ring
= dmam_alloc_coherent(dev
, sz
, &lldev
->tre_dma
,
754 if (!lldev
->tre_ring
)
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
)) {
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
,
774 if (!lldev
->evre_ring
)
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
)) {
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
);
797 rc
= hidma_ll_setup(lldev
);
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
);
808 int hidma_ll_uninit(struct hidma_lldev
*lldev
)
817 if (!lldev
->initialized
)
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
);
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
;
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
)
855 else if (err_code
& HIDMA_EVRE_STATUS_ERROR
)
858 ret
= DMA_IN_PROGRESS
;
859 spin_unlock_irqrestore(&lldev
->lock
, flags
);