1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Intel IXP4xx Network Processor Engine driver for Linux 4 * 5 * Copyright (C) 2007 Krzysztof Halasa <khc@pm.waw.pl> 6 * 7 * The code is based on publicly available information: 8 * - Intel IXP4xx Developer's Manual and other e-papers 9 * - Intel IXP400 Access Library Software (BSD license) 10 * - previous works by Christian Hohnstaedt <chohnstaedt@innominate.com> 11 * Thanks, Christian. 12 */ 13 14 #include <linux/delay.h> 15 #include <linux/dma-mapping.h> 16 #include <linux/firmware.h> 17 #include <linux/io.h> 18 #include <linux/kernel.h> 19 #include <linux/mfd/syscon.h> 20 #include <linux/module.h> 21 #include <linux/of.h> 22 #include <linux/of_platform.h> 23 #include <linux/platform_device.h> 24 #include <linux/soc/ixp4xx/npe.h> 25 #include <linux/soc/ixp4xx/cpu.h> 26 27 #define DEBUG_MSG 0 28 #define DEBUG_FW 0 29 30 #define NPE_COUNT 3 31 #define MAX_RETRIES 1000 /* microseconds */ 32 #define NPE_42X_DATA_SIZE 0x800 /* in dwords */ 33 #define NPE_46X_DATA_SIZE 0x1000 34 #define NPE_A_42X_INSTR_SIZE 0x1000 35 #define NPE_B_AND_C_42X_INSTR_SIZE 0x800 36 #define NPE_46X_INSTR_SIZE 0x1000 37 #define REGS_SIZE 0x1000 38 39 #define NPE_PHYS_REG 32 40 41 #define FW_MAGIC 0xFEEDF00D 42 #define FW_BLOCK_TYPE_INSTR 0x0 43 #define FW_BLOCK_TYPE_DATA 0x1 44 #define FW_BLOCK_TYPE_EOF 0xF 45 46 /* NPE exec status (read) and command (write) */ 47 #define CMD_NPE_STEP 0x01 48 #define CMD_NPE_START 0x02 49 #define CMD_NPE_STOP 0x03 50 #define CMD_NPE_CLR_PIPE 0x04 51 #define CMD_CLR_PROFILE_CNT 0x0C 52 #define CMD_RD_INS_MEM 0x10 /* instruction memory */ 53 #define CMD_WR_INS_MEM 0x11 54 #define CMD_RD_DATA_MEM 0x12 /* data memory */ 55 #define CMD_WR_DATA_MEM 0x13 56 #define CMD_RD_ECS_REG 0x14 /* exec access register */ 57 #define CMD_WR_ECS_REG 0x15 58 59 #define STAT_RUN 0x80000000 60 #define STAT_STOP 0x40000000 61 #define STAT_CLEAR 0x20000000 62 #define STAT_ECS_K 0x00800000 /* pipeline clean */ 63 64 #define NPE_STEVT 0x1B 65 #define NPE_STARTPC 0x1C 66 #define NPE_REGMAP 0x1E 67 #define NPE_CINDEX 0x1F 68 69 #define INSTR_WR_REG_SHORT 0x0000C000 70 #define INSTR_WR_REG_BYTE 0x00004000 71 #define INSTR_RD_FIFO 0x0F888220 72 #define INSTR_RESET_MBOX 0x0FAC8210 73 74 #define ECS_BG_CTXT_REG_0 0x00 /* Background Executing Context */ 75 #define ECS_BG_CTXT_REG_1 0x01 /* Stack level */ 76 #define ECS_BG_CTXT_REG_2 0x02 77 #define ECS_PRI_1_CTXT_REG_0 0x04 /* Priority 1 Executing Context */ 78 #define ECS_PRI_1_CTXT_REG_1 0x05 /* Stack level */ 79 #define ECS_PRI_1_CTXT_REG_2 0x06 80 #define ECS_PRI_2_CTXT_REG_0 0x08 /* Priority 2 Executing Context */ 81 #define ECS_PRI_2_CTXT_REG_1 0x09 /* Stack level */ 82 #define ECS_PRI_2_CTXT_REG_2 0x0A 83 #define ECS_DBG_CTXT_REG_0 0x0C /* Debug Executing Context */ 84 #define ECS_DBG_CTXT_REG_1 0x0D /* Stack level */ 85 #define ECS_DBG_CTXT_REG_2 0x0E 86 #define ECS_INSTRUCT_REG 0x11 /* NPE Instruction Register */ 87 88 #define ECS_REG_0_ACTIVE 0x80000000 /* all levels */ 89 #define ECS_REG_0_NEXTPC_MASK 0x1FFF0000 /* BG/PRI1/PRI2 levels */ 90 #define ECS_REG_0_LDUR_BITS 8 91 #define ECS_REG_0_LDUR_MASK 0x00000700 /* all levels */ 92 #define ECS_REG_1_CCTXT_BITS 16 93 #define ECS_REG_1_CCTXT_MASK 0x000F0000 /* all levels */ 94 #define ECS_REG_1_SELCTXT_BITS 0 95 #define ECS_REG_1_SELCTXT_MASK 0x0000000F /* all levels */ 96 #define ECS_DBG_REG_2_IF 0x00100000 /* debug level */ 97 #define ECS_DBG_REG_2_IE 0x00080000 /* debug level */ 98 99 /* NPE watchpoint_fifo register bit */ 100 #define WFIFO_VALID 0x80000000 101 102 /* NPE messaging_status register bit definitions */ 103 #define MSGSTAT_OFNE 0x00010000 /* OutFifoNotEmpty */ 104 #define MSGSTAT_IFNF 0x00020000 /* InFifoNotFull */ 105 #define MSGSTAT_OFNF 0x00040000 /* OutFifoNotFull */ 106 #define MSGSTAT_IFNE 0x00080000 /* InFifoNotEmpty */ 107 #define MSGSTAT_MBINT 0x00100000 /* Mailbox interrupt */ 108 #define MSGSTAT_IFINT 0x00200000 /* InFifo interrupt */ 109 #define MSGSTAT_OFINT 0x00400000 /* OutFifo interrupt */ 110 #define MSGSTAT_WFINT 0x00800000 /* WatchFifo interrupt */ 111 112 /* NPE messaging_control register bit definitions */ 113 #define MSGCTL_OUT_FIFO 0x00010000 /* enable output FIFO */ 114 #define MSGCTL_IN_FIFO 0x00020000 /* enable input FIFO */ 115 #define MSGCTL_OUT_FIFO_WRITE 0x01000000 /* enable FIFO + WRITE */ 116 #define MSGCTL_IN_FIFO_WRITE 0x02000000 117 118 /* NPE mailbox_status value for reset */ 119 #define RESET_MBOX_STAT 0x0000F0F0 120 121 #define NPE_A_FIRMWARE "NPE-A" 122 #define NPE_B_FIRMWARE "NPE-B" 123 #define NPE_C_FIRMWARE "NPE-C" 124 125 const char *npe_names[] = { NPE_A_FIRMWARE, NPE_B_FIRMWARE, NPE_C_FIRMWARE }; 126 127 #define print_npe(pri, npe, fmt, ...) \ 128 printk(pri "%s: " fmt, npe_name(npe), ## __VA_ARGS__) 129 130 #if DEBUG_MSG 131 #define debug_msg(npe, fmt, ...) \ 132 print_npe(KERN_DEBUG, npe, fmt, ## __VA_ARGS__) 133 #else 134 #define debug_msg(npe, fmt, ...) 135 #endif 136 137 static struct { 138 u32 reg, val; 139 } ecs_reset[] = { 140 { ECS_BG_CTXT_REG_0, 0xA0000000 }, 141 { ECS_BG_CTXT_REG_1, 0x01000000 }, 142 { ECS_BG_CTXT_REG_2, 0x00008000 }, 143 { ECS_PRI_1_CTXT_REG_0, 0x20000080 }, 144 { ECS_PRI_1_CTXT_REG_1, 0x01000000 }, 145 { ECS_PRI_1_CTXT_REG_2, 0x00008000 }, 146 { ECS_PRI_2_CTXT_REG_0, 0x20000080 }, 147 { ECS_PRI_2_CTXT_REG_1, 0x01000000 }, 148 { ECS_PRI_2_CTXT_REG_2, 0x00008000 }, 149 { ECS_DBG_CTXT_REG_0, 0x20000000 }, 150 { ECS_DBG_CTXT_REG_1, 0x00000000 }, 151 { ECS_DBG_CTXT_REG_2, 0x001E0000 }, 152 { ECS_INSTRUCT_REG, 0x1003C00F }, 153 }; 154 155 static struct npe npe_tab[NPE_COUNT] = { 156 { 157 .id = 0, 158 }, { 159 .id = 1, 160 }, { 161 .id = 2, 162 } 163 }; 164 165 int npe_running(struct npe *npe) 166 { 167 return (__raw_readl(&npe->regs->exec_status_cmd) & STAT_RUN) != 0; 168 } 169 170 static void npe_cmd_write(struct npe *npe, u32 addr, int cmd, u32 data) 171 { 172 __raw_writel(data, &npe->regs->exec_data); 173 __raw_writel(addr, &npe->regs->exec_addr); 174 __raw_writel(cmd, &npe->regs->exec_status_cmd); 175 } 176 177 static u32 npe_cmd_read(struct npe *npe, u32 addr, int cmd) 178 { 179 __raw_writel(addr, &npe->regs->exec_addr); 180 __raw_writel(cmd, &npe->regs->exec_status_cmd); 181 /* Iintroduce extra read cycles after issuing read command to NPE 182 so that we read the register after the NPE has updated it. 183 This is to overcome race condition between XScale and NPE */ 184 __raw_readl(&npe->regs->exec_data); 185 __raw_readl(&npe->regs->exec_data); 186 return __raw_readl(&npe->regs->exec_data); 187 } 188 189 static void npe_clear_active(struct npe *npe, u32 reg) 190 { 191 u32 val = npe_cmd_read(npe, reg, CMD_RD_ECS_REG); 192 npe_cmd_write(npe, reg, CMD_WR_ECS_REG, val & ~ECS_REG_0_ACTIVE); 193 } 194 195 static void npe_start(struct npe *npe) 196 { 197 /* ensure only Background Context Stack Level is active */ 198 npe_clear_active(npe, ECS_PRI_1_CTXT_REG_0); 199 npe_clear_active(npe, ECS_PRI_2_CTXT_REG_0); 200 npe_clear_active(npe, ECS_DBG_CTXT_REG_0); 201 202 __raw_writel(CMD_NPE_CLR_PIPE, &npe->regs->exec_status_cmd); 203 __raw_writel(CMD_NPE_START, &npe->regs->exec_status_cmd); 204 } 205 206 static void npe_stop(struct npe *npe) 207 { 208 __raw_writel(CMD_NPE_STOP, &npe->regs->exec_status_cmd); 209 __raw_writel(CMD_NPE_CLR_PIPE, &npe->regs->exec_status_cmd); /*FIXME?*/ 210 } 211 212 static int __must_check npe_debug_instr(struct npe *npe, u32 instr, u32 ctx, 213 u32 ldur) 214 { 215 u32 wc; 216 int i; 217 218 /* set the Active bit, and the LDUR, in the debug level */ 219 npe_cmd_write(npe, ECS_DBG_CTXT_REG_0, CMD_WR_ECS_REG, 220 ECS_REG_0_ACTIVE | (ldur << ECS_REG_0_LDUR_BITS)); 221 222 /* set CCTXT at ECS DEBUG L3 to specify in which context to execute 223 the instruction, and set SELCTXT at ECS DEBUG Level to specify 224 which context store to access. 225 Debug ECS Level Reg 1 has form 0x000n000n, where n = context number 226 */ 227 npe_cmd_write(npe, ECS_DBG_CTXT_REG_1, CMD_WR_ECS_REG, 228 (ctx << ECS_REG_1_CCTXT_BITS) | 229 (ctx << ECS_REG_1_SELCTXT_BITS)); 230 231 /* clear the pipeline */ 232 __raw_writel(CMD_NPE_CLR_PIPE, &npe->regs->exec_status_cmd); 233 234 /* load NPE instruction into the instruction register */ 235 npe_cmd_write(npe, ECS_INSTRUCT_REG, CMD_WR_ECS_REG, instr); 236 237 /* we need this value later to wait for completion of NPE execution 238 step */ 239 wc = __raw_readl(&npe->regs->watch_count); 240 241 /* issue a Step One command via the Execution Control register */ 242 __raw_writel(CMD_NPE_STEP, &npe->regs->exec_status_cmd); 243 244 /* Watch Count register increments when NPE completes an instruction */ 245 for (i = 0; i < MAX_RETRIES; i++) { 246 if (wc != __raw_readl(&npe->regs->watch_count)) 247 return 0; 248 udelay(1); 249 } 250 251 print_npe(KERN_ERR, npe, "reset: npe_debug_instr(): timeout\n"); 252 return -ETIMEDOUT; 253 } 254 255 static int __must_check npe_logical_reg_write8(struct npe *npe, u32 addr, 256 u8 val, u32 ctx) 257 { 258 /* here we build the NPE assembler instruction: mov8 d0, #0 */ 259 u32 instr = INSTR_WR_REG_BYTE | /* OpCode */ 260 addr << 9 | /* base Operand */ 261 (val & 0x1F) << 4 | /* lower 5 bits to immediate data */ 262 (val & ~0x1F) << (18 - 5);/* higher 3 bits to CoProc instr. */ 263 return npe_debug_instr(npe, instr, ctx, 1); /* execute it */ 264 } 265 266 static int __must_check npe_logical_reg_write16(struct npe *npe, u32 addr, 267 u16 val, u32 ctx) 268 { 269 /* here we build the NPE assembler instruction: mov16 d0, #0 */ 270 u32 instr = INSTR_WR_REG_SHORT | /* OpCode */ 271 addr << 9 | /* base Operand */ 272 (val & 0x1F) << 4 | /* lower 5 bits to immediate data */ 273 (val & ~0x1F) << (18 - 5);/* higher 11 bits to CoProc instr. */ 274 return npe_debug_instr(npe, instr, ctx, 1); /* execute it */ 275 } 276 277 static int __must_check npe_logical_reg_write32(struct npe *npe, u32 addr, 278 u32 val, u32 ctx) 279 { 280 /* write in 16 bit steps first the high and then the low value */ 281 if (npe_logical_reg_write16(npe, addr, val >> 16, ctx)) 282 return -ETIMEDOUT; 283 return npe_logical_reg_write16(npe, addr + 2, val & 0xFFFF, ctx); 284 } 285 286 static int npe_reset(struct npe *npe) 287 { 288 u32 reset_bit = (IXP4XX_FEATURE_RESET_NPEA << npe->id); 289 u32 val, ctl, exec_count, ctx_reg2; 290 int i; 291 292 ctl = (__raw_readl(&npe->regs->messaging_control) | 0x3F000000) & 293 0x3F3FFFFF; 294 295 /* disable parity interrupt */ 296 __raw_writel(ctl & 0x3F00FFFF, &npe->regs->messaging_control); 297 298 /* pre exec - debug instruction */ 299 /* turn off the halt bit by clearing Execution Count register. */ 300 exec_count = __raw_readl(&npe->regs->exec_count); 301 __raw_writel(0, &npe->regs->exec_count); 302 /* ensure that IF and IE are on (temporarily), so that we don't end up 303 stepping forever */ 304 ctx_reg2 = npe_cmd_read(npe, ECS_DBG_CTXT_REG_2, CMD_RD_ECS_REG); 305 npe_cmd_write(npe, ECS_DBG_CTXT_REG_2, CMD_WR_ECS_REG, ctx_reg2 | 306 ECS_DBG_REG_2_IF | ECS_DBG_REG_2_IE); 307 308 /* clear the FIFOs */ 309 while (__raw_readl(&npe->regs->watchpoint_fifo) & WFIFO_VALID) 310 ; 311 while (__raw_readl(&npe->regs->messaging_status) & MSGSTAT_OFNE) 312 /* read from the outFIFO until empty */ 313 print_npe(KERN_DEBUG, npe, "npe_reset: read FIFO = 0x%X\n", 314 __raw_readl(&npe->regs->in_out_fifo)); 315 316 while (__raw_readl(&npe->regs->messaging_status) & MSGSTAT_IFNE) 317 /* step execution of the NPE intruction to read inFIFO using 318 the Debug Executing Context stack */ 319 if (npe_debug_instr(npe, INSTR_RD_FIFO, 0, 0)) 320 return -ETIMEDOUT; 321 322 /* reset the mailbox reg from the XScale side */ 323 __raw_writel(RESET_MBOX_STAT, &npe->regs->mailbox_status); 324 /* from NPE side */ 325 if (npe_debug_instr(npe, INSTR_RESET_MBOX, 0, 0)) 326 return -ETIMEDOUT; 327 328 /* Reset the physical registers in the NPE register file */ 329 for (val = 0; val < NPE_PHYS_REG; val++) { 330 if (npe_logical_reg_write16(npe, NPE_REGMAP, val >> 1, 0)) 331 return -ETIMEDOUT; 332 /* address is either 0 or 4 */ 333 if (npe_logical_reg_write32(npe, (val & 1) * 4, 0, 0)) 334 return -ETIMEDOUT; 335 } 336 337 /* Reset the context store = each context's Context Store registers */ 338 339 /* Context 0 has no STARTPC. Instead, this value is used to set NextPC 340 for Background ECS, to set where NPE starts executing code */ 341 val = npe_cmd_read(npe, ECS_BG_CTXT_REG_0, CMD_RD_ECS_REG); 342 val &= ~ECS_REG_0_NEXTPC_MASK; 343 val |= (0 /* NextPC */ << 16) & ECS_REG_0_NEXTPC_MASK; 344 npe_cmd_write(npe, ECS_BG_CTXT_REG_0, CMD_WR_ECS_REG, val); 345 346 for (i = 0; i < 16; i++) { 347 if (i) { /* Context 0 has no STEVT nor STARTPC */ 348 /* STEVT = off, 0x80 */ 349 if (npe_logical_reg_write8(npe, NPE_STEVT, 0x80, i)) 350 return -ETIMEDOUT; 351 if (npe_logical_reg_write16(npe, NPE_STARTPC, 0, i)) 352 return -ETIMEDOUT; 353 } 354 /* REGMAP = d0->p0, d8->p2, d16->p4 */ 355 if (npe_logical_reg_write16(npe, NPE_REGMAP, 0x820, i)) 356 return -ETIMEDOUT; 357 if (npe_logical_reg_write8(npe, NPE_CINDEX, 0, i)) 358 return -ETIMEDOUT; 359 } 360 361 /* post exec */ 362 /* clear active bit in debug level */ 363 npe_cmd_write(npe, ECS_DBG_CTXT_REG_0, CMD_WR_ECS_REG, 0); 364 /* clear the pipeline */ 365 __raw_writel(CMD_NPE_CLR_PIPE, &npe->regs->exec_status_cmd); 366 /* restore previous values */ 367 __raw_writel(exec_count, &npe->regs->exec_count); 368 npe_cmd_write(npe, ECS_DBG_CTXT_REG_2, CMD_WR_ECS_REG, ctx_reg2); 369 370 /* write reset values to Execution Context Stack registers */ 371 for (val = 0; val < ARRAY_SIZE(ecs_reset); val++) 372 npe_cmd_write(npe, ecs_reset[val].reg, CMD_WR_ECS_REG, 373 ecs_reset[val].val); 374 375 /* clear the profile counter */ 376 __raw_writel(CMD_CLR_PROFILE_CNT, &npe->regs->exec_status_cmd); 377 378 __raw_writel(0, &npe->regs->exec_count); 379 __raw_writel(0, &npe->regs->action_points[0]); 380 __raw_writel(0, &npe->regs->action_points[1]); 381 __raw_writel(0, &npe->regs->action_points[2]); 382 __raw_writel(0, &npe->regs->action_points[3]); 383 __raw_writel(0, &npe->regs->watch_count); 384 385 /* 386 * We need to work on cached values here because the register 387 * will read inverted but needs to be written non-inverted. 388 */ 389 val = cpu_ixp4xx_features(npe->rmap); 390 /* reset the NPE */ 391 regmap_write(npe->rmap, IXP4XX_EXP_CNFG2, val & ~reset_bit); 392 /* deassert reset */ 393 regmap_write(npe->rmap, IXP4XX_EXP_CNFG2, val | reset_bit); 394 395 for (i = 0; i < MAX_RETRIES; i++) { 396 val = cpu_ixp4xx_features(npe->rmap); 397 if (val & reset_bit) 398 break; /* NPE is back alive */ 399 udelay(1); 400 } 401 if (i == MAX_RETRIES) 402 return -ETIMEDOUT; 403 404 npe_stop(npe); 405 406 /* restore NPE configuration bus Control Register - parity settings */ 407 __raw_writel(ctl, &npe->regs->messaging_control); 408 return 0; 409 } 410 411 412 int npe_send_message(struct npe *npe, const void *msg, const char *what) 413 { 414 const u32 *send = msg; 415 int cycles = 0; 416 417 debug_msg(npe, "Trying to send message %s [%08X:%08X]\n", 418 what, send[0], send[1]); 419 420 if (__raw_readl(&npe->regs->messaging_status) & MSGSTAT_IFNE) { 421 debug_msg(npe, "NPE input FIFO not empty\n"); 422 return -EIO; 423 } 424 425 __raw_writel(send[0], &npe->regs->in_out_fifo); 426 427 if (!(__raw_readl(&npe->regs->messaging_status) & MSGSTAT_IFNF)) { 428 debug_msg(npe, "NPE input FIFO full\n"); 429 return -EIO; 430 } 431 432 __raw_writel(send[1], &npe->regs->in_out_fifo); 433 434 while ((cycles < MAX_RETRIES) && 435 (__raw_readl(&npe->regs->messaging_status) & MSGSTAT_IFNE)) { 436 udelay(1); 437 cycles++; 438 } 439 440 if (cycles == MAX_RETRIES) { 441 debug_msg(npe, "Timeout sending message\n"); 442 return -ETIMEDOUT; 443 } 444 445 #if DEBUG_MSG > 1 446 debug_msg(npe, "Sending a message took %i cycles\n", cycles); 447 #endif 448 return 0; 449 } 450 451 int npe_recv_message(struct npe *npe, void *msg, const char *what) 452 { 453 u32 *recv = msg; 454 int cycles = 0, cnt = 0; 455 456 debug_msg(npe, "Trying to receive message %s\n", what); 457 458 while (cycles < MAX_RETRIES) { 459 if (__raw_readl(&npe->regs->messaging_status) & MSGSTAT_OFNE) { 460 recv[cnt++] = __raw_readl(&npe->regs->in_out_fifo); 461 if (cnt == 2) 462 break; 463 } else { 464 udelay(1); 465 cycles++; 466 } 467 } 468 469 switch(cnt) { 470 case 1: 471 debug_msg(npe, "Received [%08X]\n", recv[0]); 472 break; 473 case 2: 474 debug_msg(npe, "Received [%08X:%08X]\n", recv[0], recv[1]); 475 break; 476 } 477 478 if (cycles == MAX_RETRIES) { 479 debug_msg(npe, "Timeout waiting for message\n"); 480 return -ETIMEDOUT; 481 } 482 483 #if DEBUG_MSG > 1 484 debug_msg(npe, "Receiving a message took %i cycles\n", cycles); 485 #endif 486 return 0; 487 } 488 489 int npe_send_recv_message(struct npe *npe, void *msg, const char *what) 490 { 491 int result; 492 u32 *send = msg, recv[2]; 493 494 if ((result = npe_send_message(npe, msg, what)) != 0) 495 return result; 496 if ((result = npe_recv_message(npe, recv, what)) != 0) 497 return result; 498 499 if ((recv[0] != send[0]) || (recv[1] != send[1])) { 500 debug_msg(npe, "Message %s: unexpected message received\n", 501 what); 502 return -EIO; 503 } 504 return 0; 505 } 506 507 508 int npe_load_firmware(struct npe *npe, const char *name, struct device *dev) 509 { 510 const struct firmware *fw_entry; 511 512 struct dl_block { 513 u32 type; 514 u32 offset; 515 } *blk; 516 517 struct dl_image { 518 u32 magic; 519 u32 id; 520 u32 size; 521 union { 522 u32 data[0]; 523 struct dl_block blocks[0]; 524 }; 525 } *image; 526 527 struct dl_codeblock { 528 u32 npe_addr; 529 u32 size; 530 u32 data[0]; 531 } *cb; 532 533 int i, j, err, data_size, instr_size, blocks, table_end; 534 u32 cmd; 535 536 if ((err = request_firmware(&fw_entry, name, dev)) != 0) 537 return err; 538 539 err = -EINVAL; 540 if (fw_entry->size < sizeof(struct dl_image)) { 541 print_npe(KERN_ERR, npe, "incomplete firmware file\n"); 542 goto err; 543 } 544 image = (struct dl_image*)fw_entry->data; 545 546 #if DEBUG_FW 547 print_npe(KERN_DEBUG, npe, "firmware: %08X %08X %08X (0x%X bytes)\n", 548 image->magic, image->id, image->size, image->size * 4); 549 #endif 550 551 if (image->magic == swab32(FW_MAGIC)) { /* swapped file */ 552 image->id = swab32(image->id); 553 image->size = swab32(image->size); 554 } else if (image->magic != FW_MAGIC) { 555 print_npe(KERN_ERR, npe, "bad firmware file magic: 0x%X\n", 556 image->magic); 557 goto err; 558 } 559 if ((image->size * 4 + sizeof(struct dl_image)) != fw_entry->size) { 560 print_npe(KERN_ERR, npe, 561 "inconsistent size of firmware file\n"); 562 goto err; 563 } 564 if (((image->id >> 24) & 0xF /* NPE ID */) != npe->id) { 565 print_npe(KERN_ERR, npe, "firmware file NPE ID mismatch\n"); 566 goto err; 567 } 568 if (image->magic == swab32(FW_MAGIC)) 569 for (i = 0; i < image->size; i++) 570 image->data[i] = swab32(image->data[i]); 571 572 if (cpu_is_ixp42x() && ((image->id >> 28) & 0xF /* device ID */)) { 573 print_npe(KERN_INFO, npe, "IXP43x/IXP46x firmware ignored on " 574 "IXP42x\n"); 575 goto err; 576 } 577 578 if (npe_running(npe)) { 579 print_npe(KERN_INFO, npe, "unable to load firmware, NPE is " 580 "already running\n"); 581 err = -EBUSY; 582 goto err; 583 } 584 #if 0 585 npe_stop(npe); 586 npe_reset(npe); 587 #endif 588 589 print_npe(KERN_INFO, npe, "firmware functionality 0x%X, " 590 "revision 0x%X:%X\n", (image->id >> 16) & 0xFF, 591 (image->id >> 8) & 0xFF, image->id & 0xFF); 592 593 if (cpu_is_ixp42x()) { 594 if (!npe->id) 595 instr_size = NPE_A_42X_INSTR_SIZE; 596 else 597 instr_size = NPE_B_AND_C_42X_INSTR_SIZE; 598 data_size = NPE_42X_DATA_SIZE; 599 } else { 600 instr_size = NPE_46X_INSTR_SIZE; 601 data_size = NPE_46X_DATA_SIZE; 602 } 603 604 for (blocks = 0; blocks * sizeof(struct dl_block) / 4 < image->size; 605 blocks++) 606 if (image->blocks[blocks].type == FW_BLOCK_TYPE_EOF) 607 break; 608 if (blocks * sizeof(struct dl_block) / 4 >= image->size) { 609 print_npe(KERN_INFO, npe, "firmware EOF block marker not " 610 "found\n"); 611 goto err; 612 } 613 614 #if DEBUG_FW 615 print_npe(KERN_DEBUG, npe, "%i firmware blocks found\n", blocks); 616 #endif 617 618 table_end = blocks * sizeof(struct dl_block) / 4 + 1 /* EOF marker */; 619 for (i = 0, blk = image->blocks; i < blocks; i++, blk++) { 620 if (blk->offset > image->size - sizeof(struct dl_codeblock) / 4 621 || blk->offset < table_end) { 622 print_npe(KERN_INFO, npe, "invalid offset 0x%X of " 623 "firmware block #%i\n", blk->offset, i); 624 goto err; 625 } 626 627 cb = (struct dl_codeblock*)&image->data[blk->offset]; 628 if (blk->type == FW_BLOCK_TYPE_INSTR) { 629 if (cb->npe_addr + cb->size > instr_size) 630 goto too_big; 631 cmd = CMD_WR_INS_MEM; 632 } else if (blk->type == FW_BLOCK_TYPE_DATA) { 633 if (cb->npe_addr + cb->size > data_size) 634 goto too_big; 635 cmd = CMD_WR_DATA_MEM; 636 } else { 637 print_npe(KERN_INFO, npe, "invalid firmware block #%i " 638 "type 0x%X\n", i, blk->type); 639 goto err; 640 } 641 if (blk->offset + sizeof(*cb) / 4 + cb->size > image->size) { 642 print_npe(KERN_INFO, npe, "firmware block #%i doesn't " 643 "fit in firmware image: type %c, start 0x%X," 644 " length 0x%X\n", i, 645 blk->type == FW_BLOCK_TYPE_INSTR ? 'I' : 'D', 646 cb->npe_addr, cb->size); 647 goto err; 648 } 649 650 for (j = 0; j < cb->size; j++) 651 npe_cmd_write(npe, cb->npe_addr + j, cmd, cb->data[j]); 652 } 653 654 npe_start(npe); 655 if (!npe_running(npe)) 656 print_npe(KERN_ERR, npe, "unable to start\n"); 657 release_firmware(fw_entry); 658 return 0; 659 660 too_big: 661 print_npe(KERN_INFO, npe, "firmware block #%i doesn't fit in NPE " 662 "memory: type %c, start 0x%X, length 0x%X\n", i, 663 blk->type == FW_BLOCK_TYPE_INSTR ? 'I' : 'D', 664 cb->npe_addr, cb->size); 665 err: 666 release_firmware(fw_entry); 667 return err; 668 } 669 670 671 struct npe *npe_request(unsigned id) 672 { 673 if (id < NPE_COUNT) 674 if (npe_tab[id].valid) 675 if (try_module_get(THIS_MODULE)) 676 return &npe_tab[id]; 677 return NULL; 678 } 679 680 void npe_release(struct npe *npe) 681 { 682 module_put(THIS_MODULE); 683 } 684 685 static int ixp4xx_npe_probe(struct platform_device *pdev) 686 { 687 int i, found = 0; 688 struct device *dev = &pdev->dev; 689 struct device_node *np = dev->of_node; 690 struct resource *res; 691 struct regmap *rmap; 692 u32 val; 693 694 /* This system has only one syscon, so fetch it */ 695 rmap = syscon_regmap_lookup_by_compatible("syscon"); 696 if (IS_ERR(rmap)) 697 return dev_err_probe(dev, PTR_ERR(rmap), 698 "failed to look up syscon\n"); 699 700 for (i = 0; i < NPE_COUNT; i++) { 701 struct npe *npe = &npe_tab[i]; 702 703 res = platform_get_resource(pdev, IORESOURCE_MEM, i); 704 if (!res) 705 return -ENODEV; 706 707 val = cpu_ixp4xx_features(rmap); 708 709 if (!(val & (IXP4XX_FEATURE_RESET_NPEA << i))) { 710 dev_info(dev, "NPE%d at %pR not available\n", 711 i, res); 712 continue; /* NPE already disabled or not present */ 713 } 714 npe->regs = devm_ioremap_resource(dev, res); 715 if (IS_ERR(npe->regs)) 716 return PTR_ERR(npe->regs); 717 npe->rmap = rmap; 718 719 if (npe_reset(npe)) { 720 dev_info(dev, "NPE%d at %pR does not reset\n", 721 i, res); 722 continue; 723 } 724 npe->valid = 1; 725 dev_info(dev, "NPE%d at %pR registered\n", i, res); 726 found++; 727 } 728 729 if (!found) 730 return -ENODEV; 731 732 /* Spawn crypto subdevice if using device tree */ 733 if (IS_ENABLED(CONFIG_OF) && np) 734 devm_of_platform_populate(dev); 735 736 return 0; 737 } 738 739 static int ixp4xx_npe_remove(struct platform_device *pdev) 740 { 741 int i; 742 743 for (i = 0; i < NPE_COUNT; i++) 744 if (npe_tab[i].regs) { 745 npe_reset(&npe_tab[i]); 746 } 747 748 return 0; 749 } 750 751 static const struct of_device_id ixp4xx_npe_of_match[] = { 752 { 753 .compatible = "intel,ixp4xx-network-processing-engine", 754 }, 755 {}, 756 }; 757 758 static struct platform_driver ixp4xx_npe_driver = { 759 .driver = { 760 .name = "ixp4xx-npe", 761 .of_match_table = of_match_ptr(ixp4xx_npe_of_match), 762 }, 763 .probe = ixp4xx_npe_probe, 764 .remove = ixp4xx_npe_remove, 765 }; 766 module_platform_driver(ixp4xx_npe_driver); 767 768 MODULE_AUTHOR("Krzysztof Halasa"); 769 MODULE_LICENSE("GPL v2"); 770 MODULE_FIRMWARE(NPE_A_FIRMWARE); 771 MODULE_FIRMWARE(NPE_B_FIRMWARE); 772 MODULE_FIRMWARE(NPE_C_FIRMWARE); 773 774 EXPORT_SYMBOL(npe_names); 775 EXPORT_SYMBOL(npe_running); 776 EXPORT_SYMBOL(npe_request); 777 EXPORT_SYMBOL(npe_release); 778 EXPORT_SYMBOL(npe_load_firmware); 779 EXPORT_SYMBOL(npe_send_message); 780 EXPORT_SYMBOL(npe_recv_message); 781 EXPORT_SYMBOL(npe_send_recv_message); 782