|
1 | 1 | #include "dma_transfer.hpp" |
2 | 2 |
|
3 | | -#include <dma_desc.h> |
4 | 3 | #include <qurt.h> |
5 | 4 |
|
6 | 5 | #include <array> |
7 | 6 | #include <cstdlib> |
8 | 7 |
|
| 8 | +namespace { |
| 9 | + |
| 10 | +// From addons/compute/libs/userdma/utils_lib/ |
| 11 | + |
| 12 | +#define DM0_STATUS_MASK 0x00000003 |
| 13 | +#define DM0_STATUS_SHIFT 0 |
| 14 | +#define DM0_STATUS_IDLE 0 |
| 15 | +#define DM0_STATUS_RUN 1 |
| 16 | +#define DM0_STATUS_ERROR 2 |
| 17 | + |
| 18 | +#define DM0_DESC_ADDR_MASK 0xFFFFFFF0 |
| 19 | +#define DM0_DESC_ADDR_SHIFT 4 |
| 20 | + |
| 21 | +#define DMA_COMPLETE 1 |
| 22 | +#define DMA_INCOMPLETE 0 |
| 23 | + |
| 24 | +#define DMA_SUCCESS 0 |
| 25 | +#define DMA_FAIL -1 |
| 26 | + |
| 27 | +#define DMA_DESC_TYPE_1D 0 |
| 28 | +#define DMA_DESC_TYPE_2D 1 |
| 29 | + |
| 30 | +#define DESC_NEXT_MASK 0xFFFFFFFF |
| 31 | +#define DESC_NEXT_SHIFT 0 |
| 32 | + |
| 33 | +#define DESC_DSTATE_MASK 0x80000000 |
| 34 | +#define DESC_DSTATE_SHIFT 31 |
| 35 | +#define DESC_DSTATE_INCOMPLETE 0 |
| 36 | +#define DESC_DSTATE_COMPLETE 1 |
| 37 | + |
| 38 | +#define DESC_ORDER_MASK 0x40000000 |
| 39 | +#define DESC_ORDER_SHIFT 30 |
| 40 | +#define DESC_ORDER_NOORDER 0 |
| 41 | +#define DESC_ORDER_ORDER 1 |
| 42 | + |
| 43 | +#define DESC_BYPASSSRC_MASK 0x20000000 |
| 44 | +#define DESC_BYPASSSRC_SHIFT 29 |
| 45 | +#define DESC_BYPASSDST_MASK 0x10000000 |
| 46 | +#define DESC_BYPASSDST_SHIFT 28 |
| 47 | +#define DESC_BYPASS_OFF 0 |
| 48 | +#define DESC_BYPASS_ON 1 |
| 49 | + |
| 50 | +#define DESC_DESCTYPE_MASK 0x03000000 |
| 51 | +#define DESC_DESCTYPE_SHIFT 24 |
| 52 | +#define DESC_DESCTYPE_1D 0 |
| 53 | +#define DESC_DESCTYPE_2D 1 |
| 54 | + |
| 55 | +#define DESC_LENGTH_MASK 0x00FFFFFF |
| 56 | +#define DESC_LENGTH_SHIFT 0 |
| 57 | +#define DESC_SRC_MASK 0xFFFFFFFF |
| 58 | +#define DESC_SRC_SHIFT 0 |
| 59 | +#define DESC_DST_MASK 0xFFFFFFFF |
| 60 | +#define DESC_DST_SHIFT 0 |
| 61 | + |
| 62 | +#define DESC_CACHEALLOC_MASK 0x03000000 |
| 63 | +#define DESC_CACHEALLOC_SHIFT 24 |
| 64 | +#define DESC_CACHEALLOC_NONE 0 |
| 65 | +#define DESC_CACHEALLOC_WRITEONLY 1 |
| 66 | +#define DESC_CACHEALLOC_READONLY 2 |
| 67 | +#define DESC_CACHEALLOC_READWRITE 3 |
| 68 | + |
| 69 | +#define DESC_ROIWIDTH_MASK 0x0000FFFF |
| 70 | +#define DESC_ROIWIDTH_SHIFT 0 |
| 71 | +#define DESC_ROIHEIGHT_MASK 0xFFFF0000 |
| 72 | +#define DESC_ROIHEIGHT_SHIFT 16 |
| 73 | + |
| 74 | +#define DESC_SRCSTRIDE_MASK 0x0000FFFF |
| 75 | +#define DESC_SRCSTRIDE_SHIFT 0 |
| 76 | +#define DESC_DSTSTRIDE_MASK 0xFFFF0000 |
| 77 | +#define DESC_DSTSTRIDE_SHIFT 16 |
| 78 | + |
| 79 | +#define DESC_SRCWIDTHOFFSET_MASK 0x0000FFFF |
| 80 | +#define DESC_SRCWIDTHOFFSET_SHIFT 0 |
| 81 | +#define DESC_DSTWIDTHOFFSET_MASK 0xFFFF0000 |
| 82 | +#define DESC_DSTWIDTHOFFSET_SHIFT 16 |
| 83 | + |
| 84 | +/**************************/ |
| 85 | +/* 1D (linear) descriptor */ |
| 86 | +/**************************/ |
| 87 | +typedef struct _dma_desc_1d_t { |
| 88 | + uint32_t next; |
| 89 | + uint32_t dstate_order_bypass_desctype_length; |
| 90 | + uint32_t src; |
| 91 | + uint32_t dst; |
| 92 | +} dma_desc_1d_t; |
| 93 | + |
| 94 | +static_assert(sizeof(dma_desc_1d_t) == hexagon::dma::kDmaDescSize1D, "kDmaDescSize1D size incorrect"); |
| 95 | + |
| 96 | +/***********************/ |
| 97 | +/* 2D (box) descriptor */ |
| 98 | +/***********************/ |
| 99 | +typedef struct _dma_desc_2d_t { |
| 100 | + uint32_t next; |
| 101 | + uint32_t dstate_order_bypass_desctype_length; |
| 102 | + uint32_t src; |
| 103 | + uint32_t dst; |
| 104 | + uint32_t allocation; |
| 105 | + uint32_t roiheight_roiwidth; |
| 106 | + uint32_t dststride_srcstride; |
| 107 | + uint32_t dstwidthoffset_srcwidthoffset; |
| 108 | +} dma_desc_2d_t; |
| 109 | + |
| 110 | +static_assert(sizeof(dma_desc_2d_t) == hexagon::dma::kDmaDescSize2D, "kDmaDescSize2D size incorrect"); |
| 111 | + |
| 112 | +inline void dmstart(void * next) { |
| 113 | + asm volatile(" release(%0):at" : : "r"(next)); |
| 114 | + asm volatile(" dmstart(%0)" : : "r"(next)); |
| 115 | +} |
| 116 | + |
| 117 | +inline void dmlink(void * cur, void * next) { |
| 118 | + asm volatile(" release(%0):at" : : "r"(next)); |
| 119 | + asm volatile(" dmlink(%0, %1)" : : "r"(cur), "r"(next)); |
| 120 | +} |
| 121 | + |
| 122 | +inline unsigned int dmpoll(void) { |
| 123 | + unsigned int ret = 0; |
| 124 | + asm volatile(" %0 = dmpoll" : "=r"(ret) : : "memory"); |
| 125 | + return ret; |
| 126 | +} |
| 127 | + |
| 128 | +inline unsigned int dmwait(void) { |
| 129 | + unsigned int ret = 0; |
| 130 | + asm volatile(" %0 = dmwait" : "=r"(ret) : : "memory"); |
| 131 | + return ret; |
| 132 | +} |
| 133 | + |
| 134 | +inline void dma_desc_set_next(void * d, uint32_t v) { |
| 135 | + (((dma_desc_1d_t *) d)->next) &= ~DESC_NEXT_MASK; |
| 136 | + (((dma_desc_1d_t *) d)->next) |= ((v << DESC_NEXT_SHIFT) & DESC_NEXT_MASK); |
| 137 | +} |
| 138 | + |
| 139 | +inline uint32_t dma_desc_get_dstate(void * d) { |
| 140 | + return (((((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) & DESC_DSTATE_MASK) >> DESC_DSTATE_SHIFT); |
| 141 | +} |
| 142 | + |
| 143 | +inline void dma_desc_set_dstate(void * d, uint32_t v) { |
| 144 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) &= ~DESC_DSTATE_MASK; |
| 145 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) |= ((v << DESC_DSTATE_SHIFT) & DESC_DSTATE_MASK); |
| 146 | +} |
| 147 | + |
| 148 | +inline void dma_desc_set_desctype(void * d, uint32_t v) { |
| 149 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) &= ~DESC_DESCTYPE_MASK; |
| 150 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) |= ((v << DESC_DESCTYPE_SHIFT) & DESC_DESCTYPE_MASK); |
| 151 | +} |
| 152 | + |
| 153 | +inline void dma_desc_set_order(void * d, uint32_t v) { |
| 154 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) &= ~DESC_ORDER_MASK; |
| 155 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) |= ((v << DESC_ORDER_SHIFT) & DESC_ORDER_MASK); |
| 156 | +} |
| 157 | + |
| 158 | +inline void dma_desc_set_bypasssrc(void * d, uint32_t v) { |
| 159 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) &= ~DESC_BYPASSSRC_MASK; |
| 160 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) |= ((v << DESC_BYPASSSRC_SHIFT) & DESC_BYPASSSRC_MASK); |
| 161 | +} |
| 162 | + |
| 163 | +inline void dma_desc_set_bypassdst(void * d, uint32_t v) { |
| 164 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) &= ~DESC_BYPASSDST_MASK; |
| 165 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) |= ((v << DESC_BYPASSDST_SHIFT) & DESC_BYPASSDST_MASK); |
| 166 | +} |
| 167 | + |
| 168 | +inline void dma_desc_set_length(void * d, uint32_t v) { |
| 169 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) &= ~DESC_LENGTH_MASK; |
| 170 | + (((dma_desc_1d_t *) d)->dstate_order_bypass_desctype_length) |= ((v << DESC_LENGTH_SHIFT) & DESC_LENGTH_MASK); |
| 171 | +} |
| 172 | + |
| 173 | +inline uint32_t dma_desc_get_src(void * d) { |
| 174 | + return (((((dma_desc_1d_t *) d)->src) & DESC_SRC_MASK) >> DESC_SRC_SHIFT); |
| 175 | +} |
| 176 | + |
| 177 | +inline void dma_desc_set_src(void * d, uint32_t v) { |
| 178 | + (((dma_desc_1d_t *) d)->src) &= ~DESC_SRC_MASK; |
| 179 | + (((dma_desc_1d_t *) d)->src) |= ((v << DESC_SRC_SHIFT) & DESC_SRC_MASK); |
| 180 | +} |
| 181 | + |
| 182 | +inline void dma_desc_set_dst(void * d, uint32_t v) { |
| 183 | + (((dma_desc_1d_t *) d)->dst) &= ~DESC_DST_MASK; |
| 184 | + (((dma_desc_1d_t *) d)->dst) |= ((v << DESC_DST_SHIFT) & DESC_DST_MASK); |
| 185 | +} |
| 186 | + |
| 187 | +inline void dma_desc_set_roiwidth(void * d, uint32_t v) { |
| 188 | + (((dma_desc_2d_t *) d)->roiheight_roiwidth) &= ~DESC_ROIWIDTH_MASK; |
| 189 | + (((dma_desc_2d_t *) d)->roiheight_roiwidth) |= ((v << DESC_ROIWIDTH_SHIFT) & DESC_ROIWIDTH_MASK); |
| 190 | +} |
| 191 | + |
| 192 | +inline void dma_desc_set_roiheight(void * d, uint32_t v) { |
| 193 | + (((dma_desc_2d_t *) d)->roiheight_roiwidth) &= ~DESC_ROIHEIGHT_MASK; |
| 194 | + (((dma_desc_2d_t *) d)->roiheight_roiwidth) |= ((v << DESC_ROIHEIGHT_SHIFT) & DESC_ROIHEIGHT_MASK); |
| 195 | +} |
| 196 | + |
| 197 | +inline void dma_desc_set_srcstride(void * d, uint32_t v) { |
| 198 | + (((dma_desc_2d_t *) d)->dststride_srcstride) &= ~DESC_SRCSTRIDE_MASK; |
| 199 | + (((dma_desc_2d_t *) d)->dststride_srcstride) |= ((v << DESC_SRCSTRIDE_SHIFT) & DESC_SRCSTRIDE_MASK); |
| 200 | +} |
| 201 | + |
| 202 | +inline void dma_desc_set_dststride(void * d, uint32_t v) { |
| 203 | + (((dma_desc_2d_t *) d)->dststride_srcstride) &= ~DESC_DSTSTRIDE_MASK; |
| 204 | + (((dma_desc_2d_t *) d)->dststride_srcstride) |= ((v << DESC_DSTSTRIDE_SHIFT) & DESC_DSTSTRIDE_MASK); |
| 205 | +} |
| 206 | + |
| 207 | +inline void dma_desc_set_srcwidthoffset(void * d, uint32_t v) { |
| 208 | + (((dma_desc_2d_t *) d)->dstwidthoffset_srcwidthoffset) &= ~DESC_SRCWIDTHOFFSET_MASK; |
| 209 | + (((dma_desc_2d_t *) d)->dstwidthoffset_srcwidthoffset) |= |
| 210 | + ((v << DESC_SRCWIDTHOFFSET_SHIFT) & DESC_SRCWIDTHOFFSET_MASK); |
| 211 | +} |
| 212 | + |
| 213 | +inline void dma_desc_set_dstwidthoffset(void * d, uint32_t v) { |
| 214 | + (((dma_desc_2d_t *) d)->dstwidthoffset_srcwidthoffset) &= ~DESC_DSTWIDTHOFFSET_MASK; |
| 215 | + (((dma_desc_2d_t *) d)->dstwidthoffset_srcwidthoffset) |= |
| 216 | + ((v << DESC_DSTWIDTHOFFSET_SHIFT) & DESC_DSTWIDTHOFFSET_MASK); |
| 217 | +} |
| 218 | + |
| 219 | +inline void dma_desc_set_cachealloc(void * d, uint32_t v) { |
| 220 | + (((dma_desc_2d_t *) d)->allocation) &= ~DESC_CACHEALLOC_MASK; |
| 221 | + (((dma_desc_2d_t *) d)->allocation) |= ((v << DESC_CACHEALLOC_SHIFT) & DESC_CACHEALLOC_MASK); |
| 222 | +} |
| 223 | + |
| 224 | +} // namespace |
| 225 | + |
9 | 226 | namespace hexagon::dma { |
10 | 227 |
|
11 | 228 | dma_transfer::dma_transfer() { |
@@ -162,23 +379,58 @@ bool dma_transfer::submit2d(const uint8_t * src, |
162 | 379 | } |
163 | 380 |
|
164 | 381 | void dma_transfer::wait() { |
165 | | - auto ret = dma_wait_for_idle(); |
166 | | - if (ret != DMA_SUCCESS) { |
167 | | - DEVICE_LOG_ERROR("dma_transfer: failed to wait for DMA idle: %d\n", ret); |
| 382 | + uint32_t dm0_status = dmwait() & DM0_STATUS_MASK; |
| 383 | + if (dm0_status != DM0_STATUS_IDLE) { |
| 384 | + DEVICE_LOG_ERROR("dma_transfer: failed to wait for DMA idle, dm0_status: %d\n", (int) dm0_status); |
168 | 385 | } |
169 | 386 | } |
170 | 387 |
|
171 | 388 | bool dma_transfer::is_desc_done(uint8_t * desc) { |
172 | | - return !dma_desc_get_src(desc) || dma_desc_is_done(desc) == DMA_COMPLETE; |
| 389 | + if (!dma_desc_get_src(desc)) { |
| 390 | + return true; |
| 391 | + } |
| 392 | + |
| 393 | + if (dma_desc_get_dstate(desc) == DESC_DSTATE_COMPLETE) { |
| 394 | + return true; |
| 395 | + } |
| 396 | + |
| 397 | + dmpoll(); |
| 398 | + return false; |
173 | 399 | } |
174 | 400 |
|
175 | | -bool dma_transfer::submit_impl(void ** desc_batch, int batch_len) { |
| 401 | +bool dma_transfer::submit_impl(void ** desc_batch, size_t batch_len) { |
176 | 402 | _dma_desc_mutex.lock(); |
177 | | - const bool succ = dma_desc_submit(desc_batch, batch_len) == DMA_SUCCESS; |
| 403 | + for (size_t i = 0; i < batch_len - 1; i++) { |
| 404 | + dma_desc_set_next(desc_batch[i], (uint32_t) desc_batch[i + 1]); |
| 405 | + } |
| 406 | + |
| 407 | + dma_desc_set_next(desc_batch[batch_len - 1], (uint32_t) nullptr); |
| 408 | + uint32_t dm0_status = dmpoll() & DM0_STATUS_MASK; |
| 409 | + if (dm0_status == DM0_STATUS_IDLE) { |
| 410 | + dmstart(desc_batch[0]); |
| 411 | + } else if (dm0_status == DM0_STATUS_RUN) { |
| 412 | + if (_dma_last_desc == nullptr) { |
| 413 | + _dma_desc_mutex.unlock(); |
| 414 | + DEVICE_LOG_ERROR("dma_transfer: last descriptor not found for linking. Submission failed\n"); |
| 415 | + return false; |
| 416 | + } else { |
| 417 | + dmlink(_dma_last_desc, desc_batch[0]); |
| 418 | + } |
| 419 | + } else { |
| 420 | + _dma_desc_mutex.unlock(); |
| 421 | + DEVICE_LOG_ERROR("dma_transfer: DMA not idle or running. Submission failed\n"); |
| 422 | + return false; |
| 423 | + } |
| 424 | + |
| 425 | + dmpoll(); |
| 426 | + |
| 427 | + _dma_last_desc = (void *) desc_batch[batch_len - 1]; |
| 428 | + |
178 | 429 | _dma_desc_mutex.unlock(); |
179 | | - return succ; |
| 430 | + return true; |
180 | 431 | } |
181 | 432 |
|
182 | 433 | qurt_mutex dma_transfer::_dma_desc_mutex; |
| 434 | +void * dma_transfer::_dma_last_desc = nullptr; |
183 | 435 |
|
184 | 436 | } // namespace hexagon::dma |
0 commit comments