Lines Matching defs:npe
22 #include <linux/soc/ixp4xx/npe.h>
124 #define print_npe(pri, npe, fmt, ...) \
125 printk(pri "%s: " fmt, npe_name(npe), ## __VA_ARGS__)
128 #define debug_msg(npe, fmt, ...) \
129 print_npe(KERN_DEBUG, npe, fmt, ## __VA_ARGS__)
131 #define debug_msg(npe, fmt, ...)
152 static struct npe npe_tab[NPE_COUNT] = {
162 int npe_running(struct npe *npe)
164 return (__raw_readl(&npe->regs->exec_status_cmd) & STAT_RUN) != 0;
167 static void npe_cmd_write(struct npe *npe, u32 addr, int cmd, u32 data)
169 __raw_writel(data, &npe->regs->exec_data);
170 __raw_writel(addr, &npe->regs->exec_addr);
171 __raw_writel(cmd, &npe->regs->exec_status_cmd);
174 static u32 npe_cmd_read(struct npe *npe, u32 addr, int cmd)
176 __raw_writel(addr, &npe->regs->exec_addr);
177 __raw_writel(cmd, &npe->regs->exec_status_cmd);
181 __raw_readl(&npe->regs->exec_data);
182 __raw_readl(&npe->regs->exec_data);
183 return __raw_readl(&npe->regs->exec_data);
186 static void npe_clear_active(struct npe *npe, u32 reg)
188 u32 val = npe_cmd_read(npe, reg, CMD_RD_ECS_REG);
189 npe_cmd_write(npe, reg, CMD_WR_ECS_REG, val & ~ECS_REG_0_ACTIVE);
192 static void npe_start(struct npe *npe)
195 npe_clear_active(npe, ECS_PRI_1_CTXT_REG_0);
196 npe_clear_active(npe, ECS_PRI_2_CTXT_REG_0);
197 npe_clear_active(npe, ECS_DBG_CTXT_REG_0);
199 __raw_writel(CMD_NPE_CLR_PIPE, &npe->regs->exec_status_cmd);
200 __raw_writel(CMD_NPE_START, &npe->regs->exec_status_cmd);
203 static void npe_stop(struct npe *npe)
205 __raw_writel(CMD_NPE_STOP, &npe->regs->exec_status_cmd);
206 __raw_writel(CMD_NPE_CLR_PIPE, &npe->regs->exec_status_cmd); /*FIXME?*/
209 static int __must_check npe_debug_instr(struct npe *npe, u32 instr, u32 ctx,
216 npe_cmd_write(npe, ECS_DBG_CTXT_REG_0, CMD_WR_ECS_REG,
224 npe_cmd_write(npe, ECS_DBG_CTXT_REG_1, CMD_WR_ECS_REG,
229 __raw_writel(CMD_NPE_CLR_PIPE, &npe->regs->exec_status_cmd);
232 npe_cmd_write(npe, ECS_INSTRUCT_REG, CMD_WR_ECS_REG, instr);
236 wc = __raw_readl(&npe->regs->watch_count);
239 __raw_writel(CMD_NPE_STEP, &npe->regs->exec_status_cmd);
243 if (wc != __raw_readl(&npe->regs->watch_count))
248 print_npe(KERN_ERR, npe, "reset: npe_debug_instr(): timeout\n");
252 static int __must_check npe_logical_reg_write8(struct npe *npe, u32 addr,
260 return npe_debug_instr(npe, instr, ctx, 1); /* execute it */
263 static int __must_check npe_logical_reg_write16(struct npe *npe, u32 addr,
271 return npe_debug_instr(npe, instr, ctx, 1); /* execute it */
274 static int __must_check npe_logical_reg_write32(struct npe *npe, u32 addr,
278 if (npe_logical_reg_write16(npe, addr, val >> 16, ctx))
280 return npe_logical_reg_write16(npe, addr + 2, val & 0xFFFF, ctx);
283 static int npe_reset(struct npe *npe)
288 ctl = (__raw_readl(&npe->regs->messaging_control) | 0x3F000000) &
292 __raw_writel(ctl & 0x3F00FFFF, &npe->regs->messaging_control);
296 exec_count = __raw_readl(&npe->regs->exec_count);
297 __raw_writel(0, &npe->regs->exec_count);
300 ctx_reg2 = npe_cmd_read(npe, ECS_DBG_CTXT_REG_2, CMD_RD_ECS_REG);
301 npe_cmd_write(npe, ECS_DBG_CTXT_REG_2, CMD_WR_ECS_REG, ctx_reg2 |
305 while (__raw_readl(&npe->regs->watchpoint_fifo) & WFIFO_VALID)
307 while (__raw_readl(&npe->regs->messaging_status) & MSGSTAT_OFNE)
309 print_npe(KERN_DEBUG, npe, "npe_reset: read FIFO = 0x%X\n",
310 __raw_readl(&npe->regs->in_out_fifo));
312 while (__raw_readl(&npe->regs->messaging_status) & MSGSTAT_IFNE)
315 if (npe_debug_instr(npe, INSTR_RD_FIFO, 0, 0))
319 __raw_writel(RESET_MBOX_STAT, &npe->regs->mailbox_status);
321 if (npe_debug_instr(npe, INSTR_RESET_MBOX, 0, 0))
326 if (npe_logical_reg_write16(npe, NPE_REGMAP, val >> 1, 0))
329 if (npe_logical_reg_write32(npe, (val & 1) * 4, 0, 0))
337 val = npe_cmd_read(npe, ECS_BG_CTXT_REG_0, CMD_RD_ECS_REG);
340 npe_cmd_write(npe, ECS_BG_CTXT_REG_0, CMD_WR_ECS_REG, val);
345 if (npe_logical_reg_write8(npe, NPE_STEVT, 0x80, i))
347 if (npe_logical_reg_write16(npe, NPE_STARTPC, 0, i))
351 if (npe_logical_reg_write16(npe, NPE_REGMAP, 0x820, i))
353 if (npe_logical_reg_write8(npe, NPE_CINDEX, 0, i))
359 npe_cmd_write(npe, ECS_DBG_CTXT_REG_0, CMD_WR_ECS_REG, 0);
361 __raw_writel(CMD_NPE_CLR_PIPE, &npe->regs->exec_status_cmd);
363 __raw_writel(exec_count, &npe->regs->exec_count);
364 npe_cmd_write(npe, ECS_DBG_CTXT_REG_2, CMD_WR_ECS_REG, ctx_reg2);
368 npe_cmd_write(npe, ecs_reset[val].reg, CMD_WR_ECS_REG,
372 __raw_writel(CMD_CLR_PROFILE_CNT, &npe->regs->exec_status_cmd);
374 __raw_writel(0, &npe->regs->exec_count);
375 __raw_writel(0, &npe->regs->action_points[0]);
376 __raw_writel(0, &npe->regs->action_points[1]);
377 __raw_writel(0, &npe->regs->action_points[2]);
378 __raw_writel(0, &npe->regs->action_points[3]);
379 __raw_writel(0, &npe->regs->watch_count);
384 ~(IXP4XX_FEATURE_RESET_NPEA << npe->id));
387 (IXP4XX_FEATURE_RESET_NPEA << npe->id));
390 (IXP4XX_FEATURE_RESET_NPEA << npe->id))
397 npe_stop(npe);
400 __raw_writel(ctl, &npe->regs->messaging_control);
405 int npe_send_message(struct npe *npe, const void *msg, const char *what)
410 debug_msg(npe, "Trying to send message %s [%08X:%08X]\n",
413 if (__raw_readl(&npe->regs->messaging_status) & MSGSTAT_IFNE) {
414 debug_msg(npe, "NPE input FIFO not empty\n");
418 __raw_writel(send[0], &npe->regs->in_out_fifo);
420 if (!(__raw_readl(&npe->regs->messaging_status) & MSGSTAT_IFNF)) {
421 debug_msg(npe, "NPE input FIFO full\n");
425 __raw_writel(send[1], &npe->regs->in_out_fifo);
428 (__raw_readl(&npe->regs->messaging_status) & MSGSTAT_IFNE)) {
434 debug_msg(npe, "Timeout sending message\n");
439 debug_msg(npe, "Sending a message took %i cycles\n", cycles);
444 int npe_recv_message(struct npe *npe, void *msg, const char *what)
449 debug_msg(npe, "Trying to receive message %s\n", what);
452 if (__raw_readl(&npe->regs->messaging_status) & MSGSTAT_OFNE) {
453 recv[cnt++] = __raw_readl(&npe->regs->in_out_fifo);
464 debug_msg(npe, "Received [%08X]\n", recv[0]);
467 debug_msg(npe, "Received [%08X:%08X]\n", recv[0], recv[1]);
472 debug_msg(npe, "Timeout waiting for message\n");
477 debug_msg(npe, "Receiving a message took %i cycles\n", cycles);
482 int npe_send_recv_message(struct npe *npe, void *msg, const char *what)
487 if ((result = npe_send_message(npe, msg, what)) != 0)
489 if ((result = npe_recv_message(npe, recv, what)) != 0)
493 debug_msg(npe, "Message %s: unexpected message received\n",
501 int npe_load_firmware(struct npe *npe, const char *name, struct device *dev)
534 print_npe(KERN_ERR, npe, "incomplete firmware file\n");
540 print_npe(KERN_DEBUG, npe, "firmware: %08X %08X %08X (0x%X bytes)\n",
548 print_npe(KERN_ERR, npe, "bad firmware file magic: 0x%X\n",
553 print_npe(KERN_ERR, npe,
557 if (((image->id >> 24) & 0xF /* NPE ID */) != npe->id) {
558 print_npe(KERN_ERR, npe, "firmware file NPE ID mismatch\n");
566 print_npe(KERN_INFO, npe, "IXP43x/IXP46x firmware ignored on "
571 if (npe_running(npe)) {
572 print_npe(KERN_INFO, npe, "unable to load firmware, NPE is "
578 npe_stop(npe);
579 npe_reset(npe);
582 print_npe(KERN_INFO, npe, "firmware functionality 0x%X, "
587 if (!npe->id)
602 print_npe(KERN_INFO, npe, "firmware EOF block marker not "
608 print_npe(KERN_DEBUG, npe, "%i firmware blocks found\n", blocks);
615 print_npe(KERN_INFO, npe, "invalid offset 0x%X of "
630 print_npe(KERN_INFO, npe, "invalid firmware block #%i "
635 print_npe(KERN_INFO, npe, "firmware block #%i doesn't "
644 npe_cmd_write(npe, cb->npe_addr + j, cmd, cb->data[j]);
647 npe_start(npe);
648 if (!npe_running(npe))
649 print_npe(KERN_ERR, npe, "unable to start\n");
654 print_npe(KERN_INFO, npe, "firmware block #%i doesn't fit in NPE "
664 struct npe *npe_request(unsigned id)
673 void npe_release(struct npe *npe)
685 struct npe *npe = &npe_tab[i];
697 npe->regs = devm_ioremap_resource(dev, res);
698 if (IS_ERR(npe->regs))
699 return PTR_ERR(npe->regs);
701 if (npe_reset(npe)) {
706 npe->valid = 1;
737 .name = "ixp4xx-npe",