Linux Audio

Check our new training course

Linux BSP upgrade and security maintenance

Need help to get security updates for your Linux BSP?
Loading...
   1#include "qlge.h"
   2
   3int ql_unpause_mpi_risc(struct ql_adapter *qdev)
   4{
   5	u32 tmp;
   6
   7	/* Un-pause the RISC */
   8	tmp = ql_read32(qdev, CSR);
   9	if (!(tmp & CSR_RP))
  10		return -EIO;
  11
  12	ql_write32(qdev, CSR, CSR_CMD_CLR_PAUSE);
  13	return 0;
  14}
  15
  16int ql_pause_mpi_risc(struct ql_adapter *qdev)
  17{
  18	u32 tmp;
  19	int count = UDELAY_COUNT;
  20
  21	/* Pause the RISC */
  22	ql_write32(qdev, CSR, CSR_CMD_SET_PAUSE);
  23	do {
  24		tmp = ql_read32(qdev, CSR);
  25		if (tmp & CSR_RP)
  26			break;
  27		mdelay(UDELAY_DELAY);
  28		count--;
  29	} while (count);
  30	return (count == 0) ? -ETIMEDOUT : 0;
  31}
  32
  33int ql_hard_reset_mpi_risc(struct ql_adapter *qdev)
  34{
  35	u32 tmp;
  36	int count = UDELAY_COUNT;
  37
  38	/* Reset the RISC */
  39	ql_write32(qdev, CSR, CSR_CMD_SET_RST);
  40	do {
  41		tmp = ql_read32(qdev, CSR);
  42		if (tmp & CSR_RR) {
  43			ql_write32(qdev, CSR, CSR_CMD_CLR_RST);
  44			break;
  45		}
  46		mdelay(UDELAY_DELAY);
  47		count--;
  48	} while (count);
  49	return (count == 0) ? -ETIMEDOUT : 0;
  50}
  51
  52int ql_read_mpi_reg(struct ql_adapter *qdev, u32 reg, u32 *data)
  53{
  54	int status;
  55	/* wait for reg to come ready */
  56	status = ql_wait_reg_rdy(qdev, PROC_ADDR, PROC_ADDR_RDY, PROC_ADDR_ERR);
  57	if (status)
  58		goto exit;
  59	/* set up for reg read */
  60	ql_write32(qdev, PROC_ADDR, reg | PROC_ADDR_R);
  61	/* wait for reg to come ready */
  62	status = ql_wait_reg_rdy(qdev, PROC_ADDR, PROC_ADDR_RDY, PROC_ADDR_ERR);
  63	if (status)
  64		goto exit;
  65	/* get the data */
  66	*data = ql_read32(qdev, PROC_DATA);
  67exit:
  68	return status;
  69}
  70
  71int ql_write_mpi_reg(struct ql_adapter *qdev, u32 reg, u32 data)
  72{
  73	int status = 0;
  74	/* wait for reg to come ready */
  75	status = ql_wait_reg_rdy(qdev, PROC_ADDR, PROC_ADDR_RDY, PROC_ADDR_ERR);
  76	if (status)
  77		goto exit;
  78	/* write the data to the data reg */
  79	ql_write32(qdev, PROC_DATA, data);
  80	/* trigger the write */
  81	ql_write32(qdev, PROC_ADDR, reg);
  82	/* wait for reg to come ready */
  83	status = ql_wait_reg_rdy(qdev, PROC_ADDR, PROC_ADDR_RDY, PROC_ADDR_ERR);
  84	if (status)
  85		goto exit;
  86exit:
  87	return status;
  88}
  89
  90int ql_soft_reset_mpi_risc(struct ql_adapter *qdev)
  91{
  92	int status;
  93	status = ql_write_mpi_reg(qdev, 0x00001010, 1);
  94	return status;
  95}
  96
  97/* Determine if we are in charge of the firwmare. If
  98 * we are the lower of the 2 NIC pcie functions, or if
  99 * we are the higher function and the lower function
 100 * is not enabled.
 101 */
 102int ql_own_firmware(struct ql_adapter *qdev)
 103{
 104	u32 temp;
 105
 106	/* If we are the lower of the 2 NIC functions
 107	 * on the chip the we are responsible for
 108	 * core dump and firmware reset after an error.
 109	 */
 110	if (qdev->func < qdev->alt_func)
 111		return 1;
 112
 113	/* If we are the higher of the 2 NIC functions
 114	 * on the chip and the lower function is not
 115	 * enabled, then we are responsible for
 116	 * core dump and firmware reset after an error.
 117	 */
 118	temp =  ql_read32(qdev, STS);
 119	if (!(temp & (1 << (8 + qdev->alt_func))))
 120		return 1;
 121
 122	return 0;
 123
 124}
 125
 126static int ql_get_mb_sts(struct ql_adapter *qdev, struct mbox_params *mbcp)
 127{
 128	int i, status;
 129
 130	status = ql_sem_spinlock(qdev, SEM_PROC_REG_MASK);
 131	if (status)
 132		return -EBUSY;
 133	for (i = 0; i < mbcp->out_count; i++) {
 134		status =
 135		    ql_read_mpi_reg(qdev, qdev->mailbox_out + i,
 136				     &mbcp->mbox_out[i]);
 137		if (status) {
 138			netif_err(qdev, drv, qdev->ndev, "Failed mailbox read.\n");
 139			break;
 140		}
 141	}
 142	ql_sem_unlock(qdev, SEM_PROC_REG_MASK);	/* does flush too */
 143	return status;
 144}
 145
 146/* Wait for a single mailbox command to complete.
 147 * Returns zero on success.
 148 */
 149static int ql_wait_mbx_cmd_cmplt(struct ql_adapter *qdev)
 150{
 151	int count = 100;
 152	u32 value;
 153
 154	do {
 155		value = ql_read32(qdev, STS);
 156		if (value & STS_PI)
 157			return 0;
 158		mdelay(UDELAY_DELAY); /* 100ms */
 159	} while (--count);
 160	return -ETIMEDOUT;
 161}
 162
 163/* Execute a single mailbox command.
 164 * Caller must hold PROC_ADDR semaphore.
 165 */
 166static int ql_exec_mb_cmd(struct ql_adapter *qdev, struct mbox_params *mbcp)
 167{
 168	int i, status;
 169
 170	/*
 171	 * Make sure there's nothing pending.
 172	 * This shouldn't happen.
 173	 */
 174	if (ql_read32(qdev, CSR) & CSR_HRI)
 175		return -EIO;
 176
 177	status = ql_sem_spinlock(qdev, SEM_PROC_REG_MASK);
 178	if (status)
 179		return status;
 180
 181	/*
 182	 * Fill the outbound mailboxes.
 183	 */
 184	for (i = 0; i < mbcp->in_count; i++) {
 185		status = ql_write_mpi_reg(qdev, qdev->mailbox_in + i,
 186						mbcp->mbox_in[i]);
 187		if (status)
 188			goto end;
 189	}
 190	/*
 191	 * Wake up the MPI firmware.
 192	 */
 193	ql_write32(qdev, CSR, CSR_CMD_SET_H2R_INT);
 194end:
 195	ql_sem_unlock(qdev, SEM_PROC_REG_MASK);
 196	return status;
 197}
 198
 199/* We are being asked by firmware to accept
 200 * a change to the port.  This is only
 201 * a change to max frame sizes (Tx/Rx), pause
 202 * parameters, or loopback mode. We wake up a worker
 203 * to handler processing this since a mailbox command
 204 * will need to be sent to ACK the request.
 205 */
 206static int ql_idc_req_aen(struct ql_adapter *qdev)
 207{
 208	int status;
 209	struct mbox_params *mbcp = &qdev->idc_mbc;
 210
 211	netif_err(qdev, drv, qdev->ndev, "Enter!\n");
 212	/* Get the status data and start up a thread to
 213	 * handle the request.
 214	 */
 215	mbcp = &qdev->idc_mbc;
 216	mbcp->out_count = 4;
 217	status = ql_get_mb_sts(qdev, mbcp);
 218	if (status) {
 219		netif_err(qdev, drv, qdev->ndev,
 220			  "Could not read MPI, resetting ASIC!\n");
 221		ql_queue_asic_error(qdev);
 222	} else	{
 223		/* Begin polled mode early so
 224		 * we don't get another interrupt
 225		 * when we leave mpi_worker.
 226		 */
 227		ql_write32(qdev, INTR_MASK, (INTR_MASK_PI << 16));
 228		queue_delayed_work(qdev->workqueue, &qdev->mpi_idc_work, 0);
 229	}
 230	return status;
 231}
 232
 233/* Process an inter-device event completion.
 234 * If good, signal the caller's completion.
 235 */
 236static int ql_idc_cmplt_aen(struct ql_adapter *qdev)
 237{
 238	int status;
 239	struct mbox_params *mbcp = &qdev->idc_mbc;
 240	mbcp->out_count = 4;
 241	status = ql_get_mb_sts(qdev, mbcp);
 242	if (status) {
 243		netif_err(qdev, drv, qdev->ndev,
 244			  "Could not read MPI, resetting RISC!\n");
 245		ql_queue_fw_error(qdev);
 246	} else
 247		/* Wake up the sleeping mpi_idc_work thread that is
 248		 * waiting for this event.
 249		 */
 250		complete(&qdev->ide_completion);
 251
 252	return status;
 253}
 254
 255static void ql_link_up(struct ql_adapter *qdev, struct mbox_params *mbcp)
 256{
 257	int status;
 258	mbcp->out_count = 2;
 259
 260	status = ql_get_mb_sts(qdev, mbcp);
 261	if (status) {
 262		netif_err(qdev, drv, qdev->ndev,
 263			  "%s: Could not get mailbox status.\n", __func__);
 264		return;
 265	}
 266
 267	qdev->link_status = mbcp->mbox_out[1];
 268	netif_err(qdev, drv, qdev->ndev, "Link Up.\n");
 269
 270	/* If we're coming back from an IDC event
 271	 * then set up the CAM and frame routing.
 272	 */
 273	if (test_bit(QL_CAM_RT_SET, &qdev->flags)) {
 274		status = ql_cam_route_initialize(qdev);
 275		if (status) {
 276			netif_err(qdev, ifup, qdev->ndev,
 277				  "Failed to init CAM/Routing tables.\n");
 278			return;
 279		} else
 280			clear_bit(QL_CAM_RT_SET, &qdev->flags);
 281	}
 282
 283	/* Queue up a worker to check the frame
 284	 * size information, and fix it if it's not
 285	 * to our liking.
 286	 */
 287	if (!test_bit(QL_PORT_CFG, &qdev->flags)) {
 288		netif_err(qdev, drv, qdev->ndev, "Queue Port Config Worker!\n");
 289		set_bit(QL_PORT_CFG, &qdev->flags);
 290		/* Begin polled mode early so
 291		 * we don't get another interrupt
 292		 * when we leave mpi_worker dpc.
 293		 */
 294		ql_write32(qdev, INTR_MASK, (INTR_MASK_PI << 16));
 295		queue_delayed_work(qdev->workqueue,
 296				&qdev->mpi_port_cfg_work, 0);
 297	}
 298
 299	ql_link_on(qdev);
 300}
 301
 302static void ql_link_down(struct ql_adapter *qdev, struct mbox_params *mbcp)
 303{
 304	int status;
 305
 306	mbcp->out_count = 3;
 307
 308	status = ql_get_mb_sts(qdev, mbcp);
 309	if (status)
 310		netif_err(qdev, drv, qdev->ndev, "Link down AEN broken!\n");
 311
 312	ql_link_off(qdev);
 313}
 314
 315static int ql_sfp_in(struct ql_adapter *qdev, struct mbox_params *mbcp)
 316{
 317	int status;
 318
 319	mbcp->out_count = 5;
 320
 321	status = ql_get_mb_sts(qdev, mbcp);
 322	if (status)
 323		netif_err(qdev, drv, qdev->ndev, "SFP in AEN broken!\n");
 324	else
 325		netif_err(qdev, drv, qdev->ndev, "SFP insertion detected.\n");
 326
 327	return status;
 328}
 329
 330static int ql_sfp_out(struct ql_adapter *qdev, struct mbox_params *mbcp)
 331{
 332	int status;
 333
 334	mbcp->out_count = 1;
 335
 336	status = ql_get_mb_sts(qdev, mbcp);
 337	if (status)
 338		netif_err(qdev, drv, qdev->ndev, "SFP out AEN broken!\n");
 339	else
 340		netif_err(qdev, drv, qdev->ndev, "SFP removal detected.\n");
 341
 342	return status;
 343}
 344
 345static int ql_aen_lost(struct ql_adapter *qdev, struct mbox_params *mbcp)
 346{
 347	int status;
 348
 349	mbcp->out_count = 6;
 350
 351	status = ql_get_mb_sts(qdev, mbcp);
 352	if (status)
 353		netif_err(qdev, drv, qdev->ndev, "Lost AEN broken!\n");
 354	else {
 355		int i;
 356		netif_err(qdev, drv, qdev->ndev, "Lost AEN detected.\n");
 357		for (i = 0; i < mbcp->out_count; i++)
 358			netif_err(qdev, drv, qdev->ndev, "mbox_out[%d] = 0x%.08x.\n",
 359				  i, mbcp->mbox_out[i]);
 360
 361	}
 362
 363	return status;
 364}
 365
 366static void ql_init_fw_done(struct ql_adapter *qdev, struct mbox_params *mbcp)
 367{
 368	int status;
 369
 370	mbcp->out_count = 2;
 371
 372	status = ql_get_mb_sts(qdev, mbcp);
 373	if (status) {
 374		netif_err(qdev, drv, qdev->ndev, "Firmware did not initialize!\n");
 375	} else {
 376		netif_err(qdev, drv, qdev->ndev, "Firmware Revision  = 0x%.08x.\n",
 377			  mbcp->mbox_out[1]);
 378		qdev->fw_rev_id = mbcp->mbox_out[1];
 379		status = ql_cam_route_initialize(qdev);
 380		if (status)
 381			netif_err(qdev, ifup, qdev->ndev,
 382				  "Failed to init CAM/Routing tables.\n");
 383	}
 384}
 385
 386/* Process an async event and clear it unless it's an
 387 * error condition.
 388 *  This can get called iteratively from the mpi_work thread
 389 *  when events arrive via an interrupt.
 390 *  It also gets called when a mailbox command is polling for
 391 *  it's completion. */
 392static int ql_mpi_handler(struct ql_adapter *qdev, struct mbox_params *mbcp)
 393{
 394	int status;
 395	int orig_count = mbcp->out_count;
 396
 397	/* Just get mailbox zero for now. */
 398	mbcp->out_count = 1;
 399	status = ql_get_mb_sts(qdev, mbcp);
 400	if (status) {
 401		netif_err(qdev, drv, qdev->ndev,
 402			  "Could not read MPI, resetting ASIC!\n");
 403		ql_queue_asic_error(qdev);
 404		goto end;
 405	}
 406
 407	switch (mbcp->mbox_out[0]) {
 408
 409	/* This case is only active when we arrive here
 410	 * as a result of issuing a mailbox command to
 411	 * the firmware.
 412	 */
 413	case MB_CMD_STS_INTRMDT:
 414	case MB_CMD_STS_GOOD:
 415	case MB_CMD_STS_INVLD_CMD:
 416	case MB_CMD_STS_XFC_ERR:
 417	case MB_CMD_STS_CSUM_ERR:
 418	case MB_CMD_STS_ERR:
 419	case MB_CMD_STS_PARAM_ERR:
 420		/* We can only get mailbox status if we're polling from an
 421		 * unfinished command.  Get the rest of the status data and
 422		 * return back to the caller.
 423		 * We only end up here when we're polling for a mailbox
 424		 * command completion.
 425		 */
 426		mbcp->out_count = orig_count;
 427		status = ql_get_mb_sts(qdev, mbcp);
 428		return status;
 429
 430	/* We are being asked by firmware to accept
 431	 * a change to the port.  This is only
 432	 * a change to max frame sizes (Tx/Rx), pause
 433	 * parameters, or loopback mode.
 434	 */
 435	case AEN_IDC_REQ:
 436		status = ql_idc_req_aen(qdev);
 437		break;
 438
 439	/* Process and inbound IDC event.
 440	 * This will happen when we're trying to
 441	 * change tx/rx max frame size, change pause
 442	 * parameters or loopback mode.
 443	 */
 444	case AEN_IDC_CMPLT:
 445	case AEN_IDC_EXT:
 446		status = ql_idc_cmplt_aen(qdev);
 447		break;
 448
 449	case AEN_LINK_UP:
 450		ql_link_up(qdev, mbcp);
 451		break;
 452
 453	case AEN_LINK_DOWN:
 454		ql_link_down(qdev, mbcp);
 455		break;
 456
 457	case AEN_FW_INIT_DONE:
 458		/* If we're in process on executing the firmware,
 459		 * then convert the status to normal mailbox status.
 460		 */
 461		if (mbcp->mbox_in[0] == MB_CMD_EX_FW) {
 462			mbcp->out_count = orig_count;
 463			status = ql_get_mb_sts(qdev, mbcp);
 464			mbcp->mbox_out[0] = MB_CMD_STS_GOOD;
 465			return status;
 466		}
 467		ql_init_fw_done(qdev, mbcp);
 468		break;
 469
 470	case AEN_AEN_SFP_IN:
 471		ql_sfp_in(qdev, mbcp);
 472		break;
 473
 474	case AEN_AEN_SFP_OUT:
 475		ql_sfp_out(qdev, mbcp);
 476		break;
 477
 478	/* This event can arrive at boot time or after an
 479	 * MPI reset if the firmware failed to initialize.
 480	 */
 481	case AEN_FW_INIT_FAIL:
 482		/* If we're in process on executing the firmware,
 483		 * then convert the status to normal mailbox status.
 484		 */
 485		if (mbcp->mbox_in[0] == MB_CMD_EX_FW) {
 486			mbcp->out_count = orig_count;
 487			status = ql_get_mb_sts(qdev, mbcp);
 488			mbcp->mbox_out[0] = MB_CMD_STS_ERR;
 489			return status;
 490		}
 491		netif_err(qdev, drv, qdev->ndev,
 492			  "Firmware initialization failed.\n");
 493		status = -EIO;
 494		ql_queue_fw_error(qdev);
 495		break;
 496
 497	case AEN_SYS_ERR:
 498		netif_err(qdev, drv, qdev->ndev, "System Error.\n");
 499		ql_queue_fw_error(qdev);
 500		status = -EIO;
 501		break;
 502
 503	case AEN_AEN_LOST:
 504		ql_aen_lost(qdev, mbcp);
 505		break;
 506
 507	case AEN_DCBX_CHG:
 508		/* Need to support AEN 8110 */
 509		break;
 510	default:
 511		netif_err(qdev, drv, qdev->ndev,
 512			  "Unsupported AE %.08x.\n", mbcp->mbox_out[0]);
 513		/* Clear the MPI firmware status. */
 514	}
 515end:
 516	ql_write32(qdev, CSR, CSR_CMD_CLR_R2PCI_INT);
 517	/* Restore the original mailbox count to
 518	 * what the caller asked for.  This can get
 519	 * changed when a mailbox command is waiting
 520	 * for a response and an AEN arrives and
 521	 * is handled.
 522	 * */
 523	mbcp->out_count = orig_count;
 524	return status;
 525}
 526
 527/* Execute a single mailbox command.
 528 * mbcp is a pointer to an array of u32.  Each
 529 * element in the array contains the value for it's
 530 * respective mailbox register.
 531 */
 532static int ql_mailbox_command(struct ql_adapter *qdev, struct mbox_params *mbcp)
 533{
 534	int status;
 535	unsigned long count;
 536
 537	mutex_lock(&qdev->mpi_mutex);
 538
 539	/* Begin polled mode for MPI */
 540	ql_write32(qdev, INTR_MASK, (INTR_MASK_PI << 16));
 541
 542	/* Load the mailbox registers and wake up MPI RISC. */
 543	status = ql_exec_mb_cmd(qdev, mbcp);
 544	if (status)
 545		goto end;
 546
 547
 548	/* If we're generating a system error, then there's nothing
 549	 * to wait for.
 550	 */
 551	if (mbcp->mbox_in[0] == MB_CMD_MAKE_SYS_ERR)
 552		goto end;
 553
 554	/* Wait for the command to complete. We loop
 555	 * here because some AEN might arrive while
 556	 * we're waiting for the mailbox command to
 557	 * complete. If more than 5 seconds expire we can
 558	 * assume something is wrong. */
 559	count = jiffies + HZ * MAILBOX_TIMEOUT;
 560	do {
 561		/* Wait for the interrupt to come in. */
 562		status = ql_wait_mbx_cmd_cmplt(qdev);
 563		if (status)
 564			continue;
 565
 566		/* Process the event.  If it's an AEN, it
 567		 * will be handled in-line or a worker
 568		 * will be spawned. If it's our completion
 569		 * we will catch it below.
 570		 */
 571		status = ql_mpi_handler(qdev, mbcp);
 572		if (status)
 573			goto end;
 574
 575		/* It's either the completion for our mailbox
 576		 * command complete or an AEN.  If it's our
 577		 * completion then get out.
 578		 */
 579		if (((mbcp->mbox_out[0] & 0x0000f000) ==
 580					MB_CMD_STS_GOOD) ||
 581			((mbcp->mbox_out[0] & 0x0000f000) ==
 582					MB_CMD_STS_INTRMDT))
 583			goto done;
 584	} while (time_before(jiffies, count));
 585
 586	netif_err(qdev, drv, qdev->ndev,
 587		  "Timed out waiting for mailbox complete.\n");
 588	status = -ETIMEDOUT;
 589	goto end;
 590
 591done:
 592
 593	/* Now we can clear the interrupt condition
 594	 * and look at our status.
 595	 */
 596	ql_write32(qdev, CSR, CSR_CMD_CLR_R2PCI_INT);
 597
 598	if (((mbcp->mbox_out[0] & 0x0000f000) !=
 599					MB_CMD_STS_GOOD) &&
 600		((mbcp->mbox_out[0] & 0x0000f000) !=
 601					MB_CMD_STS_INTRMDT)) {
 602		status = -EIO;
 603	}
 604end:
 605	/* End polled mode for MPI */
 606	ql_write32(qdev, INTR_MASK, (INTR_MASK_PI << 16) | INTR_MASK_PI);
 607	mutex_unlock(&qdev->mpi_mutex);
 608	return status;
 609}
 610
 611/* Get MPI firmware version. This will be used for
 612 * driver banner and for ethtool info.
 613 * Returns zero on success.
 614 */
 615int ql_mb_about_fw(struct ql_adapter *qdev)
 616{
 617	struct mbox_params mbc;
 618	struct mbox_params *mbcp = &mbc;
 619	int status = 0;
 620
 621	memset(mbcp, 0, sizeof(struct mbox_params));
 622
 623	mbcp->in_count = 1;
 624	mbcp->out_count = 3;
 625
 626	mbcp->mbox_in[0] = MB_CMD_ABOUT_FW;
 627
 628	status = ql_mailbox_command(qdev, mbcp);
 629	if (status)
 630		return status;
 631
 632	if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
 633		netif_err(qdev, drv, qdev->ndev,
 634			  "Failed about firmware command\n");
 635		status = -EIO;
 636	}
 637
 638	/* Store the firmware version */
 639	qdev->fw_rev_id = mbcp->mbox_out[1];
 640
 641	return status;
 642}
 643
 644/* Get functional state for MPI firmware.
 645 * Returns zero on success.
 646 */
 647int ql_mb_get_fw_state(struct ql_adapter *qdev)
 648{
 649	struct mbox_params mbc;
 650	struct mbox_params *mbcp = &mbc;
 651	int status = 0;
 652
 653	memset(mbcp, 0, sizeof(struct mbox_params));
 654
 655	mbcp->in_count = 1;
 656	mbcp->out_count = 2;
 657
 658	mbcp->mbox_in[0] = MB_CMD_GET_FW_STATE;
 659
 660	status = ql_mailbox_command(qdev, mbcp);
 661	if (status)
 662		return status;
 663
 664	if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
 665		netif_err(qdev, drv, qdev->ndev,
 666			  "Failed Get Firmware State.\n");
 667		status = -EIO;
 668	}
 669
 670	/* If bit zero is set in mbx 1 then the firmware is
 671	 * running, but not initialized.  This should never
 672	 * happen.
 673	 */
 674	if (mbcp->mbox_out[1] & 1) {
 675		netif_err(qdev, drv, qdev->ndev,
 676			  "Firmware waiting for initialization.\n");
 677		status = -EIO;
 678	}
 679
 680	return status;
 681}
 682
 683/* Send and ACK mailbox command to the firmware to
 684 * let it continue with the change.
 685 */
 686static int ql_mb_idc_ack(struct ql_adapter *qdev)
 687{
 688	struct mbox_params mbc;
 689	struct mbox_params *mbcp = &mbc;
 690	int status = 0;
 691
 692	memset(mbcp, 0, sizeof(struct mbox_params));
 693
 694	mbcp->in_count = 5;
 695	mbcp->out_count = 1;
 696
 697	mbcp->mbox_in[0] = MB_CMD_IDC_ACK;
 698	mbcp->mbox_in[1] = qdev->idc_mbc.mbox_out[1];
 699	mbcp->mbox_in[2] = qdev->idc_mbc.mbox_out[2];
 700	mbcp->mbox_in[3] = qdev->idc_mbc.mbox_out[3];
 701	mbcp->mbox_in[4] = qdev->idc_mbc.mbox_out[4];
 702
 703	status = ql_mailbox_command(qdev, mbcp);
 704	if (status)
 705		return status;
 706
 707	if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
 708		netif_err(qdev, drv, qdev->ndev, "Failed IDC ACK send.\n");
 709		status = -EIO;
 710	}
 711	return status;
 712}
 713
 714/* Get link settings and maximum frame size settings
 715 * for the current port.
 716 * Most likely will block.
 717 */
 718int ql_mb_set_port_cfg(struct ql_adapter *qdev)
 719{
 720	struct mbox_params mbc;
 721	struct mbox_params *mbcp = &mbc;
 722	int status = 0;
 723
 724	memset(mbcp, 0, sizeof(struct mbox_params));
 725
 726	mbcp->in_count = 3;
 727	mbcp->out_count = 1;
 728
 729	mbcp->mbox_in[0] = MB_CMD_SET_PORT_CFG;
 730	mbcp->mbox_in[1] = qdev->link_config;
 731	mbcp->mbox_in[2] = qdev->max_frame_size;
 732
 733
 734	status = ql_mailbox_command(qdev, mbcp);
 735	if (status)
 736		return status;
 737
 738	if (mbcp->mbox_out[0] == MB_CMD_STS_INTRMDT) {
 739		netif_err(qdev, drv, qdev->ndev,
 740			  "Port Config sent, wait for IDC.\n");
 741	} else	if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
 742		netif_err(qdev, drv, qdev->ndev,
 743			  "Failed Set Port Configuration.\n");
 744		status = -EIO;
 745	}
 746	return status;
 747}
 748
 749static int ql_mb_dump_ram(struct ql_adapter *qdev, u64 req_dma, u32 addr,
 750	u32 size)
 751{
 752	int status = 0;
 753	struct mbox_params mbc;
 754	struct mbox_params *mbcp = &mbc;
 755
 756	memset(mbcp, 0, sizeof(struct mbox_params));
 757
 758	mbcp->in_count = 9;
 759	mbcp->out_count = 1;
 760
 761	mbcp->mbox_in[0] = MB_CMD_DUMP_RISC_RAM;
 762	mbcp->mbox_in[1] = LSW(addr);
 763	mbcp->mbox_in[2] = MSW(req_dma);
 764	mbcp->mbox_in[3] = LSW(req_dma);
 765	mbcp->mbox_in[4] = MSW(size);
 766	mbcp->mbox_in[5] = LSW(size);
 767	mbcp->mbox_in[6] = MSW(MSD(req_dma));
 768	mbcp->mbox_in[7] = LSW(MSD(req_dma));
 769	mbcp->mbox_in[8] = MSW(addr);
 770
 771
 772	status = ql_mailbox_command(qdev, mbcp);
 773	if (status)
 774		return status;
 775
 776	if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
 777		netif_err(qdev, drv, qdev->ndev, "Failed to dump risc RAM.\n");
 778		status = -EIO;
 779	}
 780	return status;
 781}
 782
 783/* Issue a mailbox command to dump RISC RAM. */
 784int ql_dump_risc_ram_area(struct ql_adapter *qdev, void *buf,
 785		u32 ram_addr, int word_count)
 786{
 787	int status;
 788	char *my_buf;
 789	dma_addr_t buf_dma;
 790
 791	my_buf = pci_alloc_consistent(qdev->pdev, word_count * sizeof(u32),
 792					&buf_dma);
 793	if (!my_buf)
 794		return -EIO;
 795
 796	status = ql_mb_dump_ram(qdev, buf_dma, ram_addr, word_count);
 797	if (!status)
 798		memcpy(buf, my_buf, word_count * sizeof(u32));
 799
 800	pci_free_consistent(qdev->pdev, word_count * sizeof(u32), my_buf,
 801				buf_dma);
 802	return status;
 803}
 804
 805/* Get link settings and maximum frame size settings
 806 * for the current port.
 807 * Most likely will block.
 808 */
 809int ql_mb_get_port_cfg(struct ql_adapter *qdev)
 810{
 811	struct mbox_params mbc;
 812	struct mbox_params *mbcp = &mbc;
 813	int status = 0;
 814
 815	memset(mbcp, 0, sizeof(struct mbox_params));
 816
 817	mbcp->in_count = 1;
 818	mbcp->out_count = 3;
 819
 820	mbcp->mbox_in[0] = MB_CMD_GET_PORT_CFG;
 821
 822	status = ql_mailbox_command(qdev, mbcp);
 823	if (status)
 824		return status;
 825
 826	if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
 827		netif_err(qdev, drv, qdev->ndev,
 828			  "Failed Get Port Configuration.\n");
 829		status = -EIO;
 830	} else	{
 831		netif_printk(qdev, drv, KERN_DEBUG, qdev->ndev,
 832			     "Passed Get Port Configuration.\n");
 833		qdev->link_config = mbcp->mbox_out[1];
 834		qdev->max_frame_size = mbcp->mbox_out[2];
 835	}
 836	return status;
 837}
 838
 839int ql_mb_wol_mode(struct ql_adapter *qdev, u32 wol)
 840{
 841	struct mbox_params mbc;
 842	struct mbox_params *mbcp = &mbc;
 843	int status;
 844
 845	memset(mbcp, 0, sizeof(struct mbox_params));
 846
 847	mbcp->in_count = 2;
 848	mbcp->out_count = 1;
 849
 850	mbcp->mbox_in[0] = MB_CMD_SET_WOL_MODE;
 851	mbcp->mbox_in[1] = wol;
 852
 853
 854	status = ql_mailbox_command(qdev, mbcp);
 855	if (status)
 856		return status;
 857
 858	if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
 859		netif_err(qdev, drv, qdev->ndev, "Failed to set WOL mode.\n");
 860		status = -EIO;
 861	}
 862	return status;
 863}
 864
 865int ql_mb_wol_set_magic(struct ql_adapter *qdev, u32 enable_wol)
 866{
 867	struct mbox_params mbc;
 868	struct mbox_params *mbcp = &mbc;
 869	int status;
 870	u8 *addr = qdev->ndev->dev_addr;
 871
 872	memset(mbcp, 0, sizeof(struct mbox_params));
 873
 874	mbcp->in_count = 8;
 875	mbcp->out_count = 1;
 876
 877	mbcp->mbox_in[0] = MB_CMD_SET_WOL_MAGIC;
 878	if (enable_wol) {
 879		mbcp->mbox_in[1] = (u32)addr[0];
 880		mbcp->mbox_in[2] = (u32)addr[1];
 881		mbcp->mbox_in[3] = (u32)addr[2];
 882		mbcp->mbox_in[4] = (u32)addr[3];
 883		mbcp->mbox_in[5] = (u32)addr[4];
 884		mbcp->mbox_in[6] = (u32)addr[5];
 885		mbcp->mbox_in[7] = 0;
 886	} else {
 887		mbcp->mbox_in[1] = 0;
 888		mbcp->mbox_in[2] = 1;
 889		mbcp->mbox_in[3] = 1;
 890		mbcp->mbox_in[4] = 1;
 891		mbcp->mbox_in[5] = 1;
 892		mbcp->mbox_in[6] = 1;
 893		mbcp->mbox_in[7] = 0;
 894	}
 895
 896	status = ql_mailbox_command(qdev, mbcp);
 897	if (status)
 898		return status;
 899
 900	if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
 901		netif_err(qdev, drv, qdev->ndev, "Failed to set WOL mode.\n");
 902		status = -EIO;
 903	}
 904	return status;
 905}
 906
 907/* IDC - Inter Device Communication...
 908 * Some firmware commands require consent of adjacent FCOE
 909 * function.  This function waits for the OK, or a
 910 * counter-request for a little more time.i
 911 * The firmware will complete the request if the other
 912 * function doesn't respond.
 913 */
 914static int ql_idc_wait(struct ql_adapter *qdev)
 915{
 916	int status = -ETIMEDOUT;
 917	long wait_time = 1 * HZ;
 918	struct mbox_params *mbcp = &qdev->idc_mbc;
 919	do {
 920		/* Wait here for the command to complete
 921		 * via the IDC process.
 922		 */
 923		wait_time =
 924			wait_for_completion_timeout(&qdev->ide_completion,
 925							wait_time);
 926		if (!wait_time) {
 927			netif_err(qdev, drv, qdev->ndev, "IDC Timeout.\n");
 928			break;
 929		}
 930		/* Now examine the response from the IDC process.
 931		 * We might have a good completion or a request for
 932		 * more wait time.
 933		 */
 934		if (mbcp->mbox_out[0] == AEN_IDC_EXT) {
 935			netif_err(qdev, drv, qdev->ndev,
 936				  "IDC Time Extension from function.\n");
 937			wait_time += (mbcp->mbox_out[1] >> 8) & 0x0000000f;
 938		} else if (mbcp->mbox_out[0] == AEN_IDC_CMPLT) {
 939			netif_err(qdev, drv, qdev->ndev, "IDC Success.\n");
 940			status = 0;
 941			break;
 942		} else {
 943			netif_err(qdev, drv, qdev->ndev,
 944				  "IDC: Invalid State 0x%.04x.\n",
 945				  mbcp->mbox_out[0]);
 946			status = -EIO;
 947			break;
 948		}
 949	} while (wait_time);
 950
 951	return status;
 952}
 953
 954int ql_mb_set_led_cfg(struct ql_adapter *qdev, u32 led_config)
 955{
 956	struct mbox_params mbc;
 957	struct mbox_params *mbcp = &mbc;
 958	int status;
 959
 960	memset(mbcp, 0, sizeof(struct mbox_params));
 961
 962	mbcp->in_count = 2;
 963	mbcp->out_count = 1;
 964
 965	mbcp->mbox_in[0] = MB_CMD_SET_LED_CFG;
 966	mbcp->mbox_in[1] = led_config;
 967
 968
 969	status = ql_mailbox_command(qdev, mbcp);
 970	if (status)
 971		return status;
 972
 973	if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
 974		netif_err(qdev, drv, qdev->ndev,
 975			  "Failed to set LED Configuration.\n");
 976		status = -EIO;
 977	}
 978
 979	return status;
 980}
 981
 982int ql_mb_get_led_cfg(struct ql_adapter *qdev)
 983{
 984	struct mbox_params mbc;
 985	struct mbox_params *mbcp = &mbc;
 986	int status;
 987
 988	memset(mbcp, 0, sizeof(struct mbox_params));
 989
 990	mbcp->in_count = 1;
 991	mbcp->out_count = 2;
 992
 993	mbcp->mbox_in[0] = MB_CMD_GET_LED_CFG;
 994
 995	status = ql_mailbox_command(qdev, mbcp);
 996	if (status)
 997		return status;
 998
 999	if (mbcp->mbox_out[0] != MB_CMD_STS_GOOD) {
1000		netif_err(qdev, drv, qdev->ndev,
1001			  "Failed to get LED Configuration.\n");
1002		status = -EIO;
1003	} else
1004		qdev->led_config = mbcp->mbox_out[1];
1005
1006	return status;
1007}
1008
1009int ql_mb_set_mgmnt_traffic_ctl(struct ql_adapter *qdev, u32 control)
1010{
1011	struct mbox_params mbc;
1012	struct mbox_params *mbcp = &mbc;
1013	int status;
1014
1015	memset(mbcp, 0, sizeof(struct mbox_params));
1016
1017	mbcp->in_count = 1;
1018	mbcp->out_count = 2;
1019
1020	mbcp->mbox_in[0] = MB_CMD_SET_MGMNT_TFK_CTL;
1021	mbcp->mbox_in[1] = control;
1022
1023	status = ql_mailbox_command(qdev, mbcp);
1024	if (status)
1025		return status;
1026
1027	if (mbcp->mbox_out[0] == MB_CMD_STS_GOOD)
1028		return status;
1029
1030	if (mbcp->mbox_out[0] == MB_CMD_STS_INVLD_CMD) {
1031		netif_err(qdev, drv, qdev->ndev,
1032			  "Command not supported by firmware.\n");
1033		status = -EINVAL;
1034	} else if (mbcp->mbox_out[0] == MB_CMD_STS_ERR) {
1035		/* This indicates that the firmware is
1036		 * already in the state we are trying to
1037		 * change it to.
1038		 */
1039		netif_err(qdev, drv, qdev->ndev,
1040			  "Command parameters make no change.\n");
1041	}
1042	return status;
1043}
1044
1045/* Returns a negative error code or the mailbox command status. */
1046static int ql_mb_get_mgmnt_traffic_ctl(struct ql_adapter *qdev, u32 *control)
1047{
1048	struct mbox_params mbc;
1049	struct mbox_params *mbcp = &mbc;
1050	int status;
1051
1052	memset(mbcp, 0, sizeof(struct mbox_params));
1053	*control = 0;
1054
1055	mbcp->in_count = 1;
1056	mbcp->out_count = 1;
1057
1058	mbcp->mbox_in[0] = MB_CMD_GET_MGMNT_TFK_CTL;
1059
1060	status = ql_mailbox_command(qdev, mbcp);
1061	if (status)
1062		return status;
1063
1064	if (mbcp->mbox_out[0] == MB_CMD_STS_GOOD) {
1065		*control = mbcp->mbox_in[1];
1066		return status;
1067	}
1068
1069	if (mbcp->mbox_out[0] == MB_CMD_STS_INVLD_CMD) {
1070		netif_err(qdev, drv, qdev->ndev,
1071			  "Command not supported by firmware.\n");
1072		status = -EINVAL;
1073	} else if (mbcp->mbox_out[0] == MB_CMD_STS_ERR) {
1074		netif_err(qdev, drv, qdev->ndev,
1075			  "Failed to get MPI traffic control.\n");
1076		status = -EIO;
1077	}
1078	return status;
1079}
1080
1081int ql_wait_fifo_empty(struct ql_adapter *qdev)
1082{
1083	int count = 5;
1084	u32 mgmnt_fifo_empty;
1085	u32 nic_fifo_empty;
1086
1087	do {
1088		nic_fifo_empty = ql_read32(qdev, STS) & STS_NFE;
1089		ql_mb_get_mgmnt_traffic_ctl(qdev, &mgmnt_fifo_empty);
1090		mgmnt_fifo_empty &= MB_GET_MPI_TFK_FIFO_EMPTY;
1091		if (nic_fifo_empty && mgmnt_fifo_empty)
1092			return 0;
1093		msleep(100);
1094	} while (count-- > 0);
1095	return -ETIMEDOUT;
1096}
1097
1098/* API called in work thread context to set new TX/RX
1099 * maximum frame size values to match MTU.
1100 */
1101static int ql_set_port_cfg(struct ql_adapter *qdev)
1102{
1103	int status;
1104	status = ql_mb_set_port_cfg(qdev);
1105	if (status)
1106		return status;
1107	status = ql_idc_wait(qdev);
1108	return status;
1109}
1110
1111/* The following routines are worker threads that process
1112 * events that may sleep waiting for completion.
1113 */
1114
1115/* This thread gets the maximum TX and RX frame size values
1116 * from the firmware and, if necessary, changes them to match
1117 * the MTU setting.
1118 */
1119void ql_mpi_port_cfg_work(struct work_struct *work)
1120{
1121	struct ql_adapter *qdev =
1122	    container_of(work, struct ql_adapter, mpi_port_cfg_work.work);
1123	int status;
1124
1125	status = ql_mb_get_port_cfg(qdev);
1126	if (status) {
1127		netif_err(qdev, drv, qdev->ndev,
1128			  "Bug: Failed to get port config data.\n");
1129		goto err;
1130	}
1131
1132	if (qdev->link_config & CFG_JUMBO_FRAME_SIZE &&
1133			qdev->max_frame_size ==
1134			CFG_DEFAULT_MAX_FRAME_SIZE)
1135		goto end;
1136
1137	qdev->link_config |=	CFG_JUMBO_FRAME_SIZE;
1138	qdev->max_frame_size = CFG_DEFAULT_MAX_FRAME_SIZE;
1139	status = ql_set_port_cfg(qdev);
1140	if (status) {
1141		netif_err(qdev, drv, qdev->ndev,
1142			  "Bug: Failed to set port config data.\n");
1143		goto err;
1144	}
1145end:
1146	clear_bit(QL_PORT_CFG, &qdev->flags);
1147	return;
1148err:
1149	ql_queue_fw_error(qdev);
1150	goto end;
1151}
1152
1153/* Process an inter-device request.  This is issues by
1154 * the firmware in response to another function requesting
1155 * a change to the port. We set a flag to indicate a change
1156 * has been made and then send a mailbox command ACKing
1157 * the change request.
1158 */
1159void ql_mpi_idc_work(struct work_struct *work)
1160{
1161	struct ql_adapter *qdev =
1162	    container_of(work, struct ql_adapter, mpi_idc_work.work);
1163	int status;
1164	struct mbox_params *mbcp = &qdev->idc_mbc;
1165	u32 aen;
1166	int timeout;
1167
1168	aen = mbcp->mbox_out[1] >> 16;
1169	timeout = (mbcp->mbox_out[1] >> 8) & 0xf;
1170
1171	switch (aen) {
1172	default:
1173		netif_err(qdev, drv, qdev->ndev,
1174			  "Bug: Unhandled IDC action.\n");
1175		break;
1176	case MB_CMD_PORT_RESET:
1177	case MB_CMD_STOP_FW:
1178		ql_link_off(qdev);
1179	case MB_CMD_SET_PORT_CFG:
1180		/* Signal the resulting link up AEN
1181		 * that the frame routing and mac addr
1182		 * needs to be set.
1183		 * */
1184		set_bit(QL_CAM_RT_SET, &qdev->flags);
1185		/* Do ACK if required */
1186		if (timeout) {
1187			status = ql_mb_idc_ack(qdev);
1188			if (status)
1189				netif_err(qdev, drv, qdev->ndev,
1190					  "Bug: No pending IDC!\n");
1191		} else {
1192			netif_printk(qdev, drv, KERN_DEBUG, qdev->ndev,
1193				     "IDC ACK not required\n");
1194			status = 0; /* success */
1195		}
1196		break;
1197
1198	/* These sub-commands issued by another (FCoE)
1199	 * function are requesting to do an operation
1200	 * on the shared resource (MPI environment).
1201	 * We currently don't issue these so we just
1202	 * ACK the request.
1203	 */
1204	case MB_CMD_IOP_RESTART_MPI:
1205	case MB_CMD_IOP_PREP_LINK_DOWN:
1206		/* Drop the link, reload the routing
1207		 * table when link comes up.
1208		 */
1209		ql_link_off(qdev);
1210		set_bit(QL_CAM_RT_SET, &qdev->flags);
1211		/* Fall through. */
1212	case MB_CMD_IOP_DVR_START:
1213	case MB_CMD_IOP_FLASH_ACC:
1214	case MB_CMD_IOP_CORE_DUMP_MPI:
1215	case MB_CMD_IOP_PREP_UPDATE_MPI:
1216	case MB_CMD_IOP_COMP_UPDATE_MPI:
1217	case MB_CMD_IOP_NONE:	/*  an IDC without params */
1218		/* Do ACK if required */
1219		if (timeout) {
1220			status = ql_mb_idc_ack(qdev);
1221			if (status)
1222				netif_err(qdev, drv, qdev->ndev,
1223					  "Bug: No pending IDC!\n");
1224		} else {
1225			netif_printk(qdev, drv, KERN_DEBUG, qdev->ndev,
1226				     "IDC ACK not required\n");
1227			status = 0; /* success */
1228		}
1229		break;
1230	}
1231}
1232
1233void ql_mpi_work(struct work_struct *work)
1234{
1235	struct ql_adapter *qdev =
1236	    container_of(work, struct ql_adapter, mpi_work.work);
1237	struct mbox_params mbc;
1238	struct mbox_params *mbcp = &mbc;
1239	int err = 0;
1240
1241	mutex_lock(&qdev->mpi_mutex);
1242	/* Begin polled mode for MPI */
1243	ql_write32(qdev, INTR_MASK, (INTR_MASK_PI << 16));
1244
1245	while (ql_read32(qdev, STS) & STS_PI) {
1246		memset(mbcp, 0, sizeof(struct mbox_params));
1247		mbcp->out_count = 1;
1248		/* Don't continue if an async event
1249		 * did not complete properly.
1250		 */
1251		err = ql_mpi_handler(qdev, mbcp);
1252		if (err)
1253			break;
1254	}
1255
1256	/* End polled mode for MPI */
1257	ql_write32(qdev, INTR_MASK, (INTR_MASK_PI << 16) | INTR_MASK_PI);
1258	mutex_unlock(&qdev->mpi_mutex);
1259	ql_enable_completion_interrupt(qdev, 0);
1260}
1261
1262void ql_mpi_reset_work(struct work_struct *work)
1263{
1264	struct ql_adapter *qdev =
1265	    container_of(work, struct ql_adapter, mpi_reset_work.work);
1266	cancel_delayed_work_sync(&qdev->mpi_work);
1267	cancel_delayed_work_sync(&qdev->mpi_port_cfg_work);
1268	cancel_delayed_work_sync(&qdev->mpi_idc_work);
1269	/* If we're not the dominant NIC function,
1270	 * then there is nothing to do.
1271	 */
1272	if (!ql_own_firmware(qdev)) {
1273		netif_err(qdev, drv, qdev->ndev, "Don't own firmware!\n");
1274		return;
1275	}
1276
1277	if (qdev->mpi_coredump && !ql_core_dump(qdev, qdev->mpi_coredump)) {
1278		netif_err(qdev, drv, qdev->ndev, "Core is dumped!\n");
1279		qdev->core_is_dumped = 1;
1280		queue_delayed_work(qdev->workqueue,
1281			&qdev->mpi_core_to_log, 5 * HZ);
1282	}
1283	ql_soft_reset_mpi_risc(qdev);
1284}
1