1 /* 2 * Multicore Navigator driver for TI Keystone 2 devices. 3 * 4 * (C) Copyright 2012-2014 5 * Texas Instruments Incorporated, <www.ti.com> 6 * 7 * SPDX-License-Identifier: GPL-2.0+ 8 */ 9 #include <common.h> 10 #include <asm/io.h> 11 #include <asm/ti-common/keystone_nav.h> 12 13 struct qm_config qm_memmap = { 14 .stat_cfg = CONFIG_KSNAV_QM_QUEUE_STATUS_BASE, 15 .queue = (void *)CONFIG_KSNAV_QM_MANAGER_QUEUES_BASE, 16 .mngr_vbusm = CONFIG_KSNAV_QM_BASE_ADDRESS, 17 .i_lram = CONFIG_KSNAV_QM_LINK_RAM_BASE, 18 .proxy = (void *)CONFIG_KSNAV_QM_MANAGER_Q_PROXY_BASE, 19 .status_ram = CONFIG_KSNAV_QM_STATUS_RAM_BASE, 20 .mngr_cfg = (void *)CONFIG_KSNAV_QM_CONF_BASE, 21 .intd_cfg = CONFIG_KSNAV_QM_INTD_CONF_BASE, 22 .desc_mem = (void *)CONFIG_KSNAV_QM_DESC_SETUP_BASE, 23 .region_num = CONFIG_KSNAV_QM_REGION_NUM, 24 .pdsp_cmd = CONFIG_KSNAV_QM_PDSP1_CMD_BASE, 25 .pdsp_ctl = CONFIG_KSNAV_QM_PDSP1_CTRL_BASE, 26 .pdsp_iram = CONFIG_KSNAV_QM_PDSP1_IRAM_BASE, 27 .qpool_num = CONFIG_KSNAV_QM_QPOOL_NUM, 28 }; 29 30 /* 31 * We are going to use only one type of descriptors - host packet 32 * descriptors. We staticaly allocate memory for them here 33 */ 34 struct qm_host_desc desc_pool[HDESC_NUM] __aligned(sizeof(struct qm_host_desc)); 35 36 static struct qm_config *qm_cfg; 37 38 inline int num_of_desc_to_reg(int num_descr) 39 { 40 int j, num; 41 42 for (j = 0, num = 32; j < 15; j++, num *= 2) { 43 if (num_descr <= num) 44 return j; 45 } 46 47 return 15; 48 } 49 50 int _qm_init(struct qm_config *cfg) 51 { 52 u32 j; 53 54 qm_cfg = cfg; 55 56 qm_cfg->mngr_cfg->link_ram_base0 = qm_cfg->i_lram; 57 qm_cfg->mngr_cfg->link_ram_size0 = HDESC_NUM * 8; 58 qm_cfg->mngr_cfg->link_ram_base1 = 0; 59 qm_cfg->mngr_cfg->link_ram_size1 = 0; 60 qm_cfg->mngr_cfg->link_ram_base2 = 0; 61 62 qm_cfg->desc_mem[0].base_addr = (u32)desc_pool; 63 qm_cfg->desc_mem[0].start_idx = 0; 64 qm_cfg->desc_mem[0].desc_reg_size = 65 (((sizeof(struct qm_host_desc) >> 4) - 1) << 16) | 66 num_of_desc_to_reg(HDESC_NUM); 67 68 memset(desc_pool, 0, sizeof(desc_pool)); 69 for (j = 0; j < HDESC_NUM; j++) 70 qm_push(&desc_pool[j], qm_cfg->qpool_num); 71 72 return QM_OK; 73 } 74 75 int qm_init(void) 76 { 77 return _qm_init(&qm_memmap); 78 } 79 80 void qm_close(void) 81 { 82 u32 j; 83 84 queue_close(qm_cfg->qpool_num); 85 86 qm_cfg->mngr_cfg->link_ram_base0 = 0; 87 qm_cfg->mngr_cfg->link_ram_size0 = 0; 88 qm_cfg->mngr_cfg->link_ram_base1 = 0; 89 qm_cfg->mngr_cfg->link_ram_size1 = 0; 90 qm_cfg->mngr_cfg->link_ram_base2 = 0; 91 92 for (j = 0; j < qm_cfg->region_num; j++) { 93 qm_cfg->desc_mem[j].base_addr = 0; 94 qm_cfg->desc_mem[j].start_idx = 0; 95 qm_cfg->desc_mem[j].desc_reg_size = 0; 96 } 97 98 qm_cfg = NULL; 99 } 100 101 void qm_push(struct qm_host_desc *hd, u32 qnum) 102 { 103 u32 regd; 104 105 cpu_to_bus((u32 *)hd, sizeof(struct qm_host_desc)/4); 106 regd = (u32)hd | ((sizeof(struct qm_host_desc) >> 4) - 1); 107 writel(regd, &qm_cfg->queue[qnum].ptr_size_thresh); 108 } 109 110 void qm_buff_push(struct qm_host_desc *hd, u32 qnum, 111 void *buff_ptr, u32 buff_len) 112 { 113 hd->orig_buff_len = buff_len; 114 hd->buff_len = buff_len; 115 hd->orig_buff_ptr = (u32)buff_ptr; 116 hd->buff_ptr = (u32)buff_ptr; 117 qm_push(hd, qnum); 118 } 119 120 struct qm_host_desc *qm_pop(u32 qnum) 121 { 122 u32 uhd; 123 124 uhd = readl(&qm_cfg->queue[qnum].ptr_size_thresh) & ~0xf; 125 if (uhd) 126 cpu_to_bus((u32 *)uhd, sizeof(struct qm_host_desc)/4); 127 128 return (struct qm_host_desc *)uhd; 129 } 130 131 struct qm_host_desc *qm_pop_from_free_pool(void) 132 { 133 return qm_pop(qm_cfg->qpool_num); 134 } 135 136 void queue_close(u32 qnum) 137 { 138 struct qm_host_desc *hd; 139 140 while ((hd = qm_pop(qnum))) 141 ; 142 } 143 144 /** 145 * DMA API 146 */ 147 148 static int ksnav_rx_disable(struct pktdma_cfg *pktdma) 149 { 150 u32 j, v, k; 151 152 for (j = 0; j < pktdma->rx_ch_num; j++) { 153 v = readl(&pktdma->rx_ch[j].cfg_a); 154 if (!(v & CPDMA_CHAN_A_ENABLE)) 155 continue; 156 157 writel(v | CPDMA_CHAN_A_TDOWN, &pktdma->rx_ch[j].cfg_a); 158 for (k = 0; k < TDOWN_TIMEOUT_COUNT; k++) { 159 udelay(100); 160 v = readl(&pktdma->rx_ch[j].cfg_a); 161 if (!(v & CPDMA_CHAN_A_ENABLE)) 162 continue; 163 } 164 /* TODO: teardown error on if TDOWN_TIMEOUT_COUNT is reached */ 165 } 166 167 /* Clear all of the flow registers */ 168 for (j = 0; j < pktdma->rx_flow_num; j++) { 169 writel(0, &pktdma->rx_flows[j].control); 170 writel(0, &pktdma->rx_flows[j].tags); 171 writel(0, &pktdma->rx_flows[j].tag_sel); 172 writel(0, &pktdma->rx_flows[j].fdq_sel[0]); 173 writel(0, &pktdma->rx_flows[j].fdq_sel[1]); 174 writel(0, &pktdma->rx_flows[j].thresh[0]); 175 writel(0, &pktdma->rx_flows[j].thresh[1]); 176 writel(0, &pktdma->rx_flows[j].thresh[2]); 177 } 178 179 return QM_OK; 180 } 181 182 static int ksnav_tx_disable(struct pktdma_cfg *pktdma) 183 { 184 u32 j, v, k; 185 186 for (j = 0; j < pktdma->tx_ch_num; j++) { 187 v = readl(&pktdma->tx_ch[j].cfg_a); 188 if (!(v & CPDMA_CHAN_A_ENABLE)) 189 continue; 190 191 writel(v | CPDMA_CHAN_A_TDOWN, &pktdma->tx_ch[j].cfg_a); 192 for (k = 0; k < TDOWN_TIMEOUT_COUNT; k++) { 193 udelay(100); 194 v = readl(&pktdma->tx_ch[j].cfg_a); 195 if (!(v & CPDMA_CHAN_A_ENABLE)) 196 continue; 197 } 198 /* TODO: teardown error on if TDOWN_TIMEOUT_COUNT is reached */ 199 } 200 201 return QM_OK; 202 } 203 204 int ksnav_init(struct pktdma_cfg *pktdma, struct rx_buff_desc *rx_buffers) 205 { 206 u32 j, v; 207 struct qm_host_desc *hd; 208 u8 *rx_ptr; 209 210 if (pktdma == NULL || rx_buffers == NULL || 211 rx_buffers->buff_ptr == NULL || qm_cfg == NULL) 212 return QM_ERR; 213 214 pktdma->rx_flow = rx_buffers->rx_flow; 215 216 /* init rx queue */ 217 rx_ptr = rx_buffers->buff_ptr; 218 219 for (j = 0; j < rx_buffers->num_buffs; j++) { 220 hd = qm_pop(qm_cfg->qpool_num); 221 if (hd == NULL) 222 return QM_ERR; 223 224 qm_buff_push(hd, pktdma->rx_free_q, 225 rx_ptr, rx_buffers->buff_len); 226 227 rx_ptr += rx_buffers->buff_len; 228 } 229 230 ksnav_rx_disable(pktdma); 231 232 /* configure rx channels */ 233 v = CPDMA_REG_VAL_MAKE_RX_FLOW_A(1, 1, 0, 0, 0, 0, 0, pktdma->rx_rcv_q); 234 writel(v, &pktdma->rx_flows[pktdma->rx_flow].control); 235 writel(0, &pktdma->rx_flows[pktdma->rx_flow].tags); 236 writel(0, &pktdma->rx_flows[pktdma->rx_flow].tag_sel); 237 238 v = CPDMA_REG_VAL_MAKE_RX_FLOW_D(0, pktdma->rx_free_q, 0, 239 pktdma->rx_free_q); 240 241 writel(v, &pktdma->rx_flows[pktdma->rx_flow].fdq_sel[0]); 242 writel(v, &pktdma->rx_flows[pktdma->rx_flow].fdq_sel[1]); 243 writel(0, &pktdma->rx_flows[pktdma->rx_flow].thresh[0]); 244 writel(0, &pktdma->rx_flows[pktdma->rx_flow].thresh[1]); 245 writel(0, &pktdma->rx_flows[pktdma->rx_flow].thresh[2]); 246 247 for (j = 0; j < pktdma->rx_ch_num; j++) 248 writel(CPDMA_CHAN_A_ENABLE, &pktdma->rx_ch[j].cfg_a); 249 250 /* configure tx channels */ 251 /* Disable loopback in the tx direction */ 252 writel(0, &pktdma->global->emulation_control); 253 254 /* Set QM base address, only for K2x devices */ 255 writel(CONFIG_KSNAV_QM_BASE_ADDRESS, &pktdma->global->qm_base_addr[0]); 256 257 /* Enable all channels. The current state isn't important */ 258 for (j = 0; j < pktdma->tx_ch_num; j++) { 259 writel(0, &pktdma->tx_ch[j].cfg_b); 260 writel(CPDMA_CHAN_A_ENABLE, &pktdma->tx_ch[j].cfg_a); 261 } 262 263 return QM_OK; 264 } 265 266 int ksnav_close(struct pktdma_cfg *pktdma) 267 { 268 if (!pktdma) 269 return QM_ERR; 270 271 ksnav_tx_disable(pktdma); 272 ksnav_rx_disable(pktdma); 273 274 queue_close(pktdma->rx_free_q); 275 queue_close(pktdma->rx_rcv_q); 276 queue_close(pktdma->tx_snd_q); 277 278 return QM_OK; 279 } 280 281 int ksnav_send(struct pktdma_cfg *pktdma, u32 *pkt, int num_bytes, u32 swinfo2) 282 { 283 struct qm_host_desc *hd; 284 285 hd = qm_pop(qm_cfg->qpool_num); 286 if (hd == NULL) 287 return QM_ERR; 288 289 hd->desc_info = num_bytes; 290 hd->swinfo[2] = swinfo2; 291 hd->packet_info = qm_cfg->qpool_num; 292 293 qm_buff_push(hd, pktdma->tx_snd_q, pkt, num_bytes); 294 295 return QM_OK; 296 } 297 298 void *ksnav_recv(struct pktdma_cfg *pktdma, u32 **pkt, int *num_bytes) 299 { 300 struct qm_host_desc *hd; 301 302 hd = qm_pop(pktdma->rx_rcv_q); 303 if (!hd) 304 return NULL; 305 306 *pkt = (u32 *)hd->buff_ptr; 307 *num_bytes = hd->desc_info & 0x3fffff; 308 309 return hd; 310 } 311 312 void ksnav_release_rxhd(struct pktdma_cfg *pktdma, void *hd) 313 { 314 struct qm_host_desc *_hd = (struct qm_host_desc *)hd; 315 316 _hd->buff_len = _hd->orig_buff_len; 317 _hd->buff_ptr = _hd->orig_buff_ptr; 318 319 qm_push(_hd, pktdma->rx_free_q); 320 } 321