| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 1 | /***************************************************************************** | 
 | 2 |  *                                                                           * | 
 | 3 |  * File: espi.c                                                              * | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 4 |  * $Revision: 1.14 $                                                         * | 
 | 5 |  * $Date: 2005/05/14 00:59:32 $                                              * | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 6 |  * Description:                                                              * | 
 | 7 |  *  Ethernet SPI functionality.                                              * | 
 | 8 |  *  part of the Chelsio 10Gb Ethernet Driver.                                * | 
 | 9 |  *                                                                           * | 
 | 10 |  * This program is free software; you can redistribute it and/or modify      * | 
 | 11 |  * it under the terms of the GNU General Public License, version 2, as       * | 
 | 12 |  * published by the Free Software Foundation.                                * | 
 | 13 |  *                                                                           * | 
 | 14 |  * You should have received a copy of the GNU General Public License along   * | 
 | 15 |  * with this program; if not, write to the Free Software Foundation, Inc.,   * | 
 | 16 |  * 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.                 * | 
 | 17 |  *                                                                           * | 
 | 18 |  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED    * | 
 | 19 |  * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF      * | 
 | 20 |  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.                     * | 
 | 21 |  *                                                                           * | 
 | 22 |  * http://www.chelsio.com                                                    * | 
 | 23 |  *                                                                           * | 
 | 24 |  * Copyright (c) 2003 - 2005 Chelsio Communications, Inc.                    * | 
 | 25 |  * All rights reserved.                                                      * | 
 | 26 |  *                                                                           * | 
 | 27 |  * Maintainers: maintainers@chelsio.com                                      * | 
 | 28 |  *                                                                           * | 
 | 29 |  * Authors: Dimitrios Michailidis   <dm@chelsio.com>                         * | 
 | 30 |  *          Tina Yang               <tainay@chelsio.com>                     * | 
 | 31 |  *          Felix Marti             <felix@chelsio.com>                      * | 
 | 32 |  *          Scott Bardone           <sbardone@chelsio.com>                   * | 
 | 33 |  *          Kurt Ottaway            <kottaway@chelsio.com>                   * | 
 | 34 |  *          Frank DiMambro          <frank@chelsio.com>                      * | 
 | 35 |  *                                                                           * | 
 | 36 |  * History:                                                                  * | 
 | 37 |  *                                                                           * | 
 | 38 |  ****************************************************************************/ | 
 | 39 |  | 
 | 40 | #include "common.h" | 
 | 41 | #include "regs.h" | 
 | 42 | #include "espi.h" | 
 | 43 |  | 
 | 44 | struct peespi { | 
 | 45 | 	adapter_t *adapter; | 
 | 46 | 	struct espi_intr_counts intr_cnt; | 
 | 47 | 	u32 misc_ctrl; | 
 | 48 | 	spinlock_t lock; | 
 | 49 | }; | 
 | 50 |  | 
 | 51 | #define ESPI_INTR_MASK (F_DIP4ERR | F_RXDROP | F_TXDROP | F_RXOVERFLOW | \ | 
 | 52 | 			F_RAMPARITYERR | F_DIP2PARITYERR) | 
 | 53 | #define MON_MASK  (V_MONITORED_PORT_NUM(3) | F_MONITORED_DIRECTION \ | 
 | 54 | 		   | F_MONITORED_INTERFACE) | 
 | 55 |  | 
 | 56 | #define TRICN_CNFG 14 | 
 | 57 | #define TRICN_CMD_READ  0x11 | 
 | 58 | #define TRICN_CMD_WRITE 0x21 | 
 | 59 | #define TRICN_CMD_ATTEMPTS 10 | 
 | 60 |  | 
 | 61 | static int tricn_write(adapter_t *adapter, int bundle_addr, int module_addr, | 
 | 62 | 		       int ch_addr, int reg_offset, u32 wr_data) | 
 | 63 | { | 
 | 64 | 	int busy, attempts = TRICN_CMD_ATTEMPTS; | 
 | 65 |  | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 66 | 	writel(V_WRITE_DATA(wr_data) | | 
 | 67 | 	       V_REGISTER_OFFSET(reg_offset) | | 
 | 68 | 	       V_CHANNEL_ADDR(ch_addr) | V_MODULE_ADDR(module_addr) | | 
 | 69 | 	       V_BUNDLE_ADDR(bundle_addr) | | 
 | 70 | 	       V_SPI4_COMMAND(TRICN_CMD_WRITE), | 
 | 71 | 	       adapter->regs + A_ESPI_CMD_ADDR); | 
 | 72 | 	writel(0, adapter->regs + A_ESPI_GOSTAT); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 73 |  | 
 | 74 | 	do { | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 75 | 		busy = readl(adapter->regs + A_ESPI_GOSTAT) & F_ESPI_CMD_BUSY; | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 76 | 	} while (busy && --attempts); | 
 | 77 |  | 
 | 78 | 	if (busy) | 
 | 79 | 		CH_ERR("%s: TRICN write timed out\n", adapter->name); | 
 | 80 |  | 
 | 81 | 	return busy; | 
 | 82 | } | 
 | 83 |  | 
 | 84 | /* 1. Deassert rx_reset_core. */ | 
 | 85 | /* 2. Program TRICN_CNFG registers. */ | 
 | 86 | /* 3. Deassert rx_reset_link */ | 
 | 87 | static int tricn_init(adapter_t *adapter) | 
 | 88 | { | 
 | 89 | 	int     i               = 0; | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 90 | 	int     stat            = 0; | 
 | 91 | 	int     timeout         = 0; | 
 | 92 | 	int     is_ready        = 0; | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 93 |  | 
 | 94 | 	/* 1 */ | 
 | 95 | 	timeout=1000; | 
 | 96 | 	do { | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 97 | 		stat = readl(adapter->regs + A_ESPI_RX_RESET); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 98 | 		is_ready = (stat & 0x4); | 
 | 99 | 		timeout--; | 
 | 100 | 		udelay(5); | 
 | 101 | 	} while (!is_ready || (timeout==0)); | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 102 | 	writel(0x2, adapter->regs + A_ESPI_RX_RESET); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 103 | 	if (timeout==0) | 
 | 104 | 	{ | 
 | 105 | 		CH_ERR("ESPI : ERROR : Timeout tricn_init() \n"); | 
 | 106 | 		t1_fatal_err(adapter); | 
 | 107 | 	} | 
 | 108 |  | 
 | 109 | 	/* 2 */ | 
| Adrian Bunk | ded78e5 | 2006-03-10 00:06:53 +0100 | [diff] [blame] | 110 | 	tricn_write(adapter, 0, 0, 0, TRICN_CNFG, 0x81); | 
 | 111 | 	tricn_write(adapter, 0, 1, 0, TRICN_CNFG, 0x81); | 
 | 112 | 	tricn_write(adapter, 0, 2, 0, TRICN_CNFG, 0x81); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 113 | 	for (i=1; i<= 8; i++) tricn_write(adapter, 0, 0, i, TRICN_CNFG, 0xf1); | 
 | 114 | 	for (i=1; i<= 2; i++) tricn_write(adapter, 0, 1, i, TRICN_CNFG, 0xf1); | 
 | 115 | 	for (i=1; i<= 3; i++) tricn_write(adapter, 0, 2, i, TRICN_CNFG, 0xe1); | 
 | 116 | 	for (i=4; i<= 4; i++) tricn_write(adapter, 0, 2, i, TRICN_CNFG, 0xf1); | 
 | 117 | 	for (i=5; i<= 5; i++) tricn_write(adapter, 0, 2, i, TRICN_CNFG, 0xe1); | 
 | 118 | 	for (i=6; i<= 6; i++) tricn_write(adapter, 0, 2, i, TRICN_CNFG, 0xf1); | 
 | 119 | 	for (i=7; i<= 7; i++) tricn_write(adapter, 0, 2, i, TRICN_CNFG, 0x80); | 
 | 120 | 	for (i=8; i<= 8; i++) tricn_write(adapter, 0, 2, i, TRICN_CNFG, 0xf1); | 
 | 121 |  | 
 | 122 | 	/* 3 */ | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 123 | 	writel(0x3, adapter->regs + A_ESPI_RX_RESET); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 124 |  | 
 | 125 | 	return 0; | 
 | 126 | } | 
 | 127 |  | 
 | 128 | void t1_espi_intr_enable(struct peespi *espi) | 
 | 129 | { | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 130 | 	u32 enable, pl_intr = readl(espi->adapter->regs + A_PL_ENABLE); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 131 |  | 
 | 132 | 	/* | 
 | 133 | 	 * Cannot enable ESPI interrupts on T1B because HW asserts the | 
 | 134 | 	 * interrupt incorrectly, namely the driver gets ESPI interrupts | 
 | 135 | 	 * but no data is actually dropped (can verify this reading the ESPI | 
 | 136 | 	 * drop registers).  Also, once the ESPI interrupt is asserted it | 
 | 137 | 	 * cannot be cleared (HW bug). | 
 | 138 | 	 */ | 
 | 139 | 	enable = t1_is_T1B(espi->adapter) ? 0 : ESPI_INTR_MASK; | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 140 | 	writel(enable, espi->adapter->regs + A_ESPI_INTR_ENABLE); | 
 | 141 | 	writel(pl_intr | F_PL_INTR_ESPI, espi->adapter->regs + A_PL_ENABLE); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 142 | } | 
 | 143 |  | 
 | 144 | void t1_espi_intr_clear(struct peespi *espi) | 
 | 145 | { | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 146 | 	writel(0xffffffff, espi->adapter->regs + A_ESPI_INTR_STATUS); | 
 | 147 | 	writel(F_PL_INTR_ESPI, espi->adapter->regs + A_PL_CAUSE); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 148 | } | 
 | 149 |  | 
 | 150 | void t1_espi_intr_disable(struct peespi *espi) | 
 | 151 | { | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 152 | 	u32 pl_intr = readl(espi->adapter->regs + A_PL_ENABLE); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 153 |  | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 154 | 	writel(0, espi->adapter->regs + A_ESPI_INTR_ENABLE); | 
 | 155 | 	writel(pl_intr & ~F_PL_INTR_ESPI, espi->adapter->regs + A_PL_ENABLE); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 156 | } | 
 | 157 |  | 
 | 158 | int t1_espi_intr_handler(struct peespi *espi) | 
 | 159 | { | 
 | 160 | 	u32 cnt; | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 161 | 	u32 status = readl(espi->adapter->regs + A_ESPI_INTR_STATUS); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 162 |  | 
 | 163 | 	if (status & F_DIP4ERR) | 
 | 164 | 		espi->intr_cnt.DIP4_err++; | 
 | 165 | 	if (status & F_RXDROP) | 
 | 166 | 		espi->intr_cnt.rx_drops++; | 
 | 167 | 	if (status & F_TXDROP) | 
 | 168 | 		espi->intr_cnt.tx_drops++; | 
 | 169 | 	if (status & F_RXOVERFLOW) | 
 | 170 | 		espi->intr_cnt.rx_ovflw++; | 
 | 171 | 	if (status & F_RAMPARITYERR) | 
 | 172 | 		espi->intr_cnt.parity_err++; | 
 | 173 | 	if (status & F_DIP2PARITYERR) { | 
 | 174 | 		espi->intr_cnt.DIP2_parity_err++; | 
 | 175 |  | 
 | 176 | 		/* | 
 | 177 | 		 * Must read the error count to clear the interrupt | 
 | 178 | 		 * that it causes. | 
 | 179 | 		 */ | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 180 | 		cnt = readl(espi->adapter->regs + A_ESPI_DIP2_ERR_COUNT); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 181 | 	} | 
 | 182 |  | 
 | 183 | 	/* | 
 | 184 | 	 * For T1B we need to write 1 to clear ESPI interrupts.  For T2+ we | 
 | 185 | 	 * write the status as is. | 
 | 186 | 	 */ | 
 | 187 | 	if (status && t1_is_T1B(espi->adapter)) | 
 | 188 | 		status = 1; | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 189 | 	writel(status, espi->adapter->regs + A_ESPI_INTR_STATUS); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 190 | 	return 0; | 
 | 191 | } | 
 | 192 |  | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 193 | const struct espi_intr_counts *t1_espi_get_intr_counts(struct peespi *espi) | 
 | 194 | { | 
 | 195 |     return &espi->intr_cnt; | 
 | 196 | } | 
 | 197 |  | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 198 | static void espi_setup_for_pm3393(adapter_t *adapter) | 
 | 199 | { | 
 | 200 | 	u32 wmark = t1_is_T1B(adapter) ? 0x4000 : 0x3200; | 
 | 201 |  | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 202 | 	writel(0x1f4, adapter->regs + A_ESPI_SCH_TOKEN0); | 
 | 203 | 	writel(0x1f4, adapter->regs + A_ESPI_SCH_TOKEN1); | 
 | 204 | 	writel(0x1f4, adapter->regs + A_ESPI_SCH_TOKEN2); | 
 | 205 | 	writel(0x1f4, adapter->regs + A_ESPI_SCH_TOKEN3); | 
 | 206 | 	writel(0x100, adapter->regs + A_ESPI_RX_FIFO_ALMOST_EMPTY_WATERMARK); | 
 | 207 | 	writel(wmark, adapter->regs + A_ESPI_RX_FIFO_ALMOST_FULL_WATERMARK); | 
 | 208 | 	writel(3, adapter->regs + A_ESPI_CALENDAR_LENGTH); | 
 | 209 | 	writel(0x08000008, adapter->regs + A_ESPI_TRAIN); | 
 | 210 | 	writel(V_RX_NPORTS(1) | V_TX_NPORTS(1), adapter->regs + A_PORT_CONFIG); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 211 | } | 
 | 212 |  | 
 | 213 | /* T2 Init part --  */ | 
 | 214 | /* 1. Set T_ESPI_MISCCTRL_ADDR */ | 
 | 215 | /* 2. Init ESPI registers. */ | 
 | 216 | /* 3. Init TriCN Hard Macro */ | 
 | 217 | int t1_espi_init(struct peespi *espi, int mac_type, int nports) | 
 | 218 | { | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 219 | 	u32 cnt; | 
 | 220 |  | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 221 | 	u32 status_enable_extra = 0; | 
 | 222 | 	adapter_t *adapter = espi->adapter; | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 223 | 	u32 status, burstval = 0x800100; | 
 | 224 |  | 
 | 225 | 	/* Disable ESPI training.  MACs that can handle it enable it below. */ | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 226 | 	writel(0, adapter->regs + A_ESPI_TRAIN); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 227 |  | 
 | 228 | 	if (is_T2(adapter)) { | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 229 | 		writel(V_OUT_OF_SYNC_COUNT(4) | | 
 | 230 | 		       V_DIP2_PARITY_ERR_THRES(3) | | 
 | 231 | 		       V_DIP4_THRES(1), adapter->regs + A_ESPI_MISC_CONTROL); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 232 | 		if (nports == 4) { | 
 | 233 | 			/* T204: maxburst1 = 0x40, maxburst2 = 0x20 */ | 
 | 234 | 			burstval = 0x200040; | 
 | 235 | 		} | 
 | 236 | 	} | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 237 | 	writel(burstval, adapter->regs + A_ESPI_MAXBURST1_MAXBURST2); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 238 |  | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 239 | 	switch (mac_type) { | 
 | 240 | 	case CHBT_MAC_PM3393: | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 241 | 		espi_setup_for_pm3393(adapter); | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 242 | 		break; | 
 | 243 | 	default: | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 244 | 		return -1; | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 245 | 	} | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 246 |  | 
 | 247 | 	/* | 
 | 248 | 	 * Make sure any pending interrupts from the SPI are | 
 | 249 | 	 * Cleared before enabling the interrupt. | 
 | 250 | 	 */ | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 251 | 	writel(ESPI_INTR_MASK, espi->adapter->regs + A_ESPI_INTR_ENABLE); | 
 | 252 | 	status = readl(espi->adapter->regs + A_ESPI_INTR_STATUS); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 253 | 	if (status & F_DIP2PARITYERR) { | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 254 | 		cnt = readl(espi->adapter->regs + A_ESPI_DIP2_ERR_COUNT); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 255 | 	} | 
 | 256 |  | 
 | 257 | 	/* | 
 | 258 | 	 * For T1B we need to write 1 to clear ESPI interrupts.  For T2+ we | 
 | 259 | 	 * write the status as is. | 
 | 260 | 	 */ | 
 | 261 | 	if (status && t1_is_T1B(espi->adapter)) | 
 | 262 | 		status = 1; | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 263 | 	writel(status, espi->adapter->regs + A_ESPI_INTR_STATUS); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 264 |  | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 265 | 	writel(status_enable_extra | F_RXSTATUSENABLE, | 
 | 266 | 	       adapter->regs + A_ESPI_FIFO_STATUS_ENABLE); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 267 |  | 
 | 268 | 	if (is_T2(adapter)) { | 
 | 269 | 		tricn_init(adapter); | 
 | 270 | 		/* | 
 | 271 | 		 * Always position the control at the 1st port egress IN | 
 | 272 | 		 * (sop,eop) counter to reduce PIOs for T/N210 workaround. | 
 | 273 | 		 */ | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 274 | 		espi->misc_ctrl = (readl(adapter->regs + A_ESPI_MISC_CONTROL) | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 275 | 				   & ~MON_MASK) | (F_MONITORED_DIRECTION | 
 | 276 | 				   | F_MONITORED_INTERFACE); | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 277 | 		writel(espi->misc_ctrl, adapter->regs + A_ESPI_MISC_CONTROL); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 278 | 		spin_lock_init(&espi->lock); | 
 | 279 | 	} | 
 | 280 |  | 
 | 281 | 	return 0; | 
 | 282 | } | 
 | 283 |  | 
 | 284 | void t1_espi_destroy(struct peespi *espi) | 
 | 285 | { | 
 | 286 | 	kfree(espi); | 
 | 287 | } | 
 | 288 |  | 
 | 289 | struct peespi *t1_espi_create(adapter_t *adapter) | 
 | 290 | { | 
| Eric Sesterhenn | 2d66806 | 2006-03-05 01:16:00 +0300 | [diff] [blame] | 291 | 	struct peespi *espi = kzalloc(sizeof(*espi), GFP_KERNEL); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 292 |  | 
 | 293 | 	if (espi) | 
 | 294 | 		espi->adapter = adapter; | 
 | 295 | 	return espi; | 
 | 296 | } | 
 | 297 |  | 
 | 298 | void t1_espi_set_misc_ctrl(adapter_t *adapter, u32 val) | 
 | 299 | { | 
 | 300 | 	struct peespi *espi = adapter->espi; | 
 | 301 |  | 
 | 302 | 	if (!is_T2(adapter)) | 
 | 303 | 		return; | 
 | 304 | 	spin_lock(&espi->lock); | 
 | 305 | 	espi->misc_ctrl = (val & ~MON_MASK) | | 
 | 306 | 			  (espi->misc_ctrl & MON_MASK); | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 307 | 	writel(espi->misc_ctrl, adapter->regs + A_ESPI_MISC_CONTROL); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 308 | 	spin_unlock(&espi->lock); | 
 | 309 | } | 
 | 310 |  | 
 | 311 | u32 t1_espi_get_mon(adapter_t *adapter, u32 addr, u8 wait) | 
 | 312 | { | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 313 | 	u32 sel; | 
 | 314 |  | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 315 | 	struct peespi *espi = adapter->espi; | 
 | 316 |  | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 317 | 	if (!is_T2(adapter)) | 
 | 318 | 		return 0; | 
 | 319 | 	sel = V_MONITORED_PORT_NUM((addr & 0x3c) >> 2); | 
 | 320 | 	if (!wait) { | 
 | 321 | 		if (!spin_trylock(&espi->lock)) | 
 | 322 | 			return 0; | 
 | 323 | 	} | 
 | 324 | 	else | 
 | 325 | 		spin_lock(&espi->lock); | 
 | 326 | 	if ((sel != (espi->misc_ctrl & MON_MASK))) { | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 327 | 		writel(((espi->misc_ctrl & ~MON_MASK) | sel), | 
 | 328 | 		       adapter->regs + A_ESPI_MISC_CONTROL); | 
 | 329 | 		sel = readl(adapter->regs + A_ESPI_SCH_TOKEN3); | 
 | 330 | 		writel(espi->misc_ctrl, adapter->regs + A_ESPI_MISC_CONTROL); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 331 | 	} | 
 | 332 | 	else | 
| Scott Bardone | 559fb51 | 2005-06-23 01:40:19 -0400 | [diff] [blame] | 333 | 		sel = readl(adapter->regs + A_ESPI_SCH_TOKEN3); | 
| Christoph Lameter | 8199d3a | 2005-03-30 13:34:31 -0800 | [diff] [blame] | 334 | 	spin_unlock(&espi->lock); | 
 | 335 | 	return sel; | 
 | 336 | } |