xref: /onnv-gate/usr/src/uts/common/io/xge/hal/xgehal/xgehal-ring.c (revision 6937:a5e2c8b5c817)
11256Syl150051 /*
21256Syl150051  * CDDL HEADER START
31256Syl150051  *
41256Syl150051  * The contents of this file are subject to the terms of the
51256Syl150051  * Common Development and Distribution License (the "License").
61256Syl150051  * You may not use this file except in compliance with the License.
71256Syl150051  *
81256Syl150051  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
91256Syl150051  * or http://www.opensolaris.org/os/licensing.
101256Syl150051  * See the License for the specific language governing permissions
111256Syl150051  * and limitations under the License.
121256Syl150051  *
131256Syl150051  * When distributing Covered Code, include this CDDL HEADER in each
141256Syl150051  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
151256Syl150051  * If applicable, add the following below this CDDL HEADER, with the
161256Syl150051  * fields enclosed by brackets "[]" replaced with your own identifying
171256Syl150051  * information: Portions Copyright [yyyy] [name of copyright owner]
181256Syl150051  *
191256Syl150051  * CDDL HEADER END
201256Syl150051  *
213115Syl150051  * Copyright (c) 2002-2006 Neterion, Inc.
221256Syl150051  */
231256Syl150051 
241256Syl150051 #include "xgehal-ring.h"
251256Syl150051 #include "xgehal-device.h"
261256Syl150051 
271256Syl150051 #if defined(XGE_OS_DMA_REQUIRES_SYNC) && defined(XGE_HAL_DMA_DTR_STREAMING)
281256Syl150051 static ptrdiff_t
__hal_ring_item_dma_offset(xge_hal_mempool_h mempoolh,void * item)291256Syl150051 __hal_ring_item_dma_offset(xge_hal_mempool_h mempoolh,
301256Syl150051 			   void *item)
311256Syl150051 {
321256Syl150051 	int memblock_idx;
331256Syl150051 	void *memblock;
341256Syl150051 
351256Syl150051 	/* get owner memblock index */
361256Syl150051 	memblock_idx = __hal_ring_block_memblock_idx(item);
371256Syl150051 
381256Syl150051 	/* get owner memblock by memblock index */
391256Syl150051 	memblock = __hal_mempool_memblock(mempoolh, memblock_idx);
401256Syl150051 
411256Syl150051 	return (char*)item - (char*)memblock;
421256Syl150051 }
431256Syl150051 #endif
441256Syl150051 
451256Syl150051 static dma_addr_t
__hal_ring_item_dma_addr(xge_hal_mempool_h mempoolh,void * item,pci_dma_h * dma_handle)461256Syl150051 __hal_ring_item_dma_addr(xge_hal_mempool_h mempoolh, void *item,
471256Syl150051 		pci_dma_h *dma_handle)
481256Syl150051 {
491256Syl150051 	int memblock_idx;
501256Syl150051 	void *memblock;
511256Syl150051 	xge_hal_mempool_dma_t *memblock_dma_object;
521256Syl150051 	ptrdiff_t dma_item_offset;
531256Syl150051 
541256Syl150051 	/* get owner memblock index */
553115Syl150051 	memblock_idx = __hal_ring_block_memblock_idx((xge_hal_ring_block_t *) item);
561256Syl150051 
571256Syl150051 	/* get owner memblock by memblock index */
583115Syl150051 	memblock = __hal_mempool_memblock((xge_hal_mempool_t *) mempoolh,
593115Syl150051 										memblock_idx);
601256Syl150051 
611256Syl150051 	/* get memblock DMA object by memblock index */
621256Syl150051 	memblock_dma_object =
633115Syl150051 		__hal_mempool_memblock_dma((xge_hal_mempool_t *) mempoolh,
643115Syl150051 									memblock_idx);
651256Syl150051 
661256Syl150051 	/* calculate offset in the memblock of this item */
671256Syl150051 	dma_item_offset = (char*)item - (char*)memblock;
681256Syl150051 
691256Syl150051 	*dma_handle = memblock_dma_object->handle;
701256Syl150051 
711256Syl150051 	return memblock_dma_object->addr + dma_item_offset;
721256Syl150051 }
731256Syl150051 
741256Syl150051 static void
__hal_ring_rxdblock_link(xge_hal_mempool_h mempoolh,xge_hal_ring_t * ring,int from,int to)751256Syl150051 __hal_ring_rxdblock_link(xge_hal_mempool_h mempoolh,
761256Syl150051 			 xge_hal_ring_t *ring, int from, int to)
771256Syl150051 {
781256Syl150051 	xge_hal_ring_block_t *to_item, *from_item;
791256Syl150051 	dma_addr_t to_dma, from_dma;
801256Syl150051 	pci_dma_h to_dma_handle, from_dma_handle;
811256Syl150051 
821256Syl150051 	/* get "from" RxD block */
833115Syl150051 	from_item = (xge_hal_ring_block_t *)
843115Syl150051 				__hal_mempool_item((xge_hal_mempool_t *) mempoolh, from);
851256Syl150051 	xge_assert(from_item);
861256Syl150051 
871256Syl150051 	/* get "to" RxD block */
883115Syl150051 	to_item = (xge_hal_ring_block_t *)
893115Syl150051               __hal_mempool_item((xge_hal_mempool_t *) mempoolh, to);
901256Syl150051 	xge_assert(to_item);
911256Syl150051 
921256Syl150051 	/* return address of the beginning of previous RxD block */
931256Syl150051 	to_dma = __hal_ring_item_dma_addr(mempoolh, to_item, &to_dma_handle);
941256Syl150051 
951256Syl150051 	/* set next pointer for this RxD block to point on
961256Syl150051 	 * previous item's DMA start address */
971256Syl150051 	__hal_ring_block_next_pointer_set(from_item, to_dma);
981256Syl150051 
991256Syl150051 	/* return "from" RxD block's DMA start address */
1001256Syl150051 	from_dma =
1011256Syl150051 		__hal_ring_item_dma_addr(mempoolh, from_item, &from_dma_handle);
1021256Syl150051 
1031256Syl150051 #if defined(XGE_OS_DMA_REQUIRES_SYNC) && defined(XGE_HAL_DMA_DTR_STREAMING)
1041256Syl150051 	/* we must sync "from" RxD block, so hardware will see it */
1051256Syl150051 	xge_os_dma_sync(ring->channel.pdev,
1061256Syl150051 	              from_dma_handle,
1071256Syl150051 		      from_dma + XGE_HAL_RING_NEXT_BLOCK_POINTER_OFFSET,
1081256Syl150051 		      __hal_ring_item_dma_offset(mempoolh, from_item) +
1091256Syl150051 					XGE_HAL_RING_NEXT_BLOCK_POINTER_OFFSET,
1101256Syl150051 		      sizeof(u64),
1111256Syl150051 		      XGE_OS_DMA_DIR_TODEVICE);
1121256Syl150051 #endif
1131256Syl150051 
1143115Syl150051 	xge_debug_ring(XGE_TRACE, "block%d:0x"XGE_OS_LLXFMT" => block%d:0x"XGE_OS_LLXFMT,
1151256Syl150051 		from, (unsigned long long)from_dma, to,
1161256Syl150051 		(unsigned long long)to_dma);
1171256Syl150051 }
1181256Syl150051 
1191256Syl150051 static xge_hal_status_e
__hal_ring_mempool_item_alloc(xge_hal_mempool_h mempoolh,void * memblock,int memblock_index,xge_hal_mempool_dma_t * dma_object,void * item,int index,int is_last,void * userdata)1201256Syl150051 __hal_ring_mempool_item_alloc(xge_hal_mempool_h mempoolh,
1211256Syl150051 			      void *memblock,
1221256Syl150051 			      int memblock_index,
1231256Syl150051 			      xge_hal_mempool_dma_t *dma_object,
1241256Syl150051 			      void *item,
1251256Syl150051 			      int index,
1261256Syl150051 			      int is_last,
1271256Syl150051 			      void *userdata)
1281256Syl150051 {
1291256Syl150051 	int i;
1301256Syl150051 	xge_hal_ring_t *ring = (xge_hal_ring_t *)userdata;
1311256Syl150051 
1321256Syl150051 	xge_assert(item);
1331256Syl150051 	xge_assert(ring);
1341256Syl150051 
1351256Syl150051 
1361256Syl150051 	/* format rxds array */
1371256Syl150051 	for (i=ring->rxds_per_block-1; i>=0; i--) {
1381256Syl150051 		void *rxdblock_priv;
1391256Syl150051 		xge_hal_ring_rxd_priv_t *rxd_priv;
1401256Syl150051 		xge_hal_ring_rxd_1_t *rxdp;
1411256Syl150051 		int reserve_index = index * ring->rxds_per_block + i;
1421256Syl150051 		int memblock_item_idx;
1431256Syl150051 
1441256Syl150051 		ring->reserved_rxds_arr[reserve_index] = (char *)item +
1451256Syl150051 				(ring->rxds_per_block - 1 - i) * ring->rxd_size;
1461256Syl150051 
1471256Syl150051 		/* Note: memblock_item_idx is index of the item within
1481256Syl150051 		 *       the memblock. For instance, in case of three RxD-blocks
1491256Syl150051 		 *       per memblock this value can be 0,1 or 2. */
1501256Syl150051 		rxdblock_priv =
1513115Syl150051 			__hal_mempool_item_priv((xge_hal_mempool_t *) mempoolh,
1523115Syl150051 									memblock_index, item,
1533115Syl150051 									&memblock_item_idx);
1541256Syl150051 		rxdp = (xge_hal_ring_rxd_1_t *)
1551256Syl150051 			ring->reserved_rxds_arr[reserve_index];
1561256Syl150051 		rxd_priv = (xge_hal_ring_rxd_priv_t *) (void *)
1571256Syl150051 			((char*)rxdblock_priv + ring->rxd_priv_size * i);
1581256Syl150051 
1591256Syl150051 		/* pre-format per-RxD Ring's private */
1601256Syl150051 		rxd_priv->dma_offset = (char*)rxdp - (char*)memblock;
1611256Syl150051 		rxd_priv->dma_addr = dma_object->addr +  rxd_priv->dma_offset;
1621256Syl150051 		rxd_priv->dma_handle = dma_object->handle;
1631256Syl150051 #ifdef XGE_DEBUG_ASSERT
1641256Syl150051 		rxd_priv->dma_object = dma_object;
1651256Syl150051 #endif
1661256Syl150051 
1671256Syl150051 		/* pre-format Host_Control */
1681256Syl150051 #if defined(XGE_HAL_USE_5B_MODE)
1691256Syl150051 		if (ring->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_5) {
1701256Syl150051 			xge_hal_ring_rxd_5_t *rxdp_5 = (xge_hal_ring_rxd_5_t *)rxdp;
1711256Syl150051 #if defined(XGE_OS_PLATFORM_64BIT)
1721256Syl150051 			xge_assert(memblock_index <= 0xFFFF);
1731256Syl150051 			xge_assert(i <= 0xFFFF);
1741256Syl150051 			/* store memblock's index */
1751256Syl150051 			rxdp_5->host_control = (u32)memblock_index << 16;
1761256Syl150051 			/* store index of memblock's private */
1771256Syl150051 			rxdp_5->host_control |= (u32)(memblock_item_idx *
1781256Syl150051 						    ring->rxds_per_block + i);
1791256Syl150051 #else
1801256Syl150051 			/* 32-bit case */
1811256Syl150051 			rxdp_5->host_control = (u32)rxd_priv;
1821256Syl150051 #endif
1831256Syl150051 		} else {
1841256Syl150051 			/* 1b and 3b modes */
1851256Syl150051 			rxdp->host_control = (u64)(ulong_t)rxd_priv;
1861256Syl150051 		}
1871256Syl150051 #else
1881256Syl150051 		/* 1b and 3b modes */
1891256Syl150051 		rxdp->host_control = (u64)(ulong_t)rxd_priv;
1901256Syl150051 #endif
1911256Syl150051 	}
1921256Syl150051 
1933115Syl150051 	__hal_ring_block_memblock_idx_set((xge_hal_ring_block_t *) item, memblock_index);
1941256Syl150051 
1951256Syl150051 	if (is_last) {
1961256Syl150051 		/* link last one with first one */
1971256Syl150051 		__hal_ring_rxdblock_link(mempoolh, ring, 0, index);
1981256Syl150051 	}
1991256Syl150051 
2001256Syl150051 	if (index > 0 ) {
2011256Syl150051 		 /* link this RxD block with previous one */
2021256Syl150051 		__hal_ring_rxdblock_link(mempoolh, ring, index, index-1);
2031256Syl150051 	}
2041256Syl150051 
2051256Syl150051 	return XGE_HAL_OK;
2061256Syl150051 }
2071256Syl150051 
2081256Syl150051  xge_hal_status_e
__hal_ring_initial_replenish(xge_hal_channel_t * channel,xge_hal_channel_reopen_e reopen)2091256Syl150051 __hal_ring_initial_replenish(xge_hal_channel_t *channel,
2101256Syl150051 			     xge_hal_channel_reopen_e reopen)
2111256Syl150051 {
212*6937Sxw161283 	xge_hal_dtr_h dtr = NULL;
2131256Syl150051 
2143115Syl150051 	while (xge_hal_channel_dtr_count(channel) > 0) {
2151256Syl150051 		xge_hal_status_e status;
2161256Syl150051 
2171256Syl150051 		status = xge_hal_ring_dtr_reserve(channel, &dtr);
2181256Syl150051 		xge_assert(status == XGE_HAL_OK);
2191256Syl150051 
2201256Syl150051 		if (channel->dtr_init) {
2211256Syl150051 		    status = channel->dtr_init(channel,
2221256Syl150051                                         dtr, channel->reserve_length,
2231256Syl150051                                         channel->userdata,
2241256Syl150051 					reopen);
2251256Syl150051 			if (status != XGE_HAL_OK) {
2261256Syl150051 				xge_hal_ring_dtr_free(channel, dtr);
2271256Syl150051 				xge_hal_channel_abort(channel,
2281256Syl150051 					XGE_HAL_CHANNEL_OC_NORMAL);
2291256Syl150051 				return status;
2301256Syl150051 			}
2311256Syl150051 		}
2321256Syl150051 
2331256Syl150051 		xge_hal_ring_dtr_post(channel, dtr);
2341256Syl150051 	}
2351256Syl150051 
2361256Syl150051 	return XGE_HAL_OK;
2371256Syl150051 }
2381256Syl150051 
2391256Syl150051 xge_hal_status_e
__hal_ring_open(xge_hal_channel_h channelh,xge_hal_channel_attr_t * attr)2401256Syl150051 __hal_ring_open(xge_hal_channel_h channelh, xge_hal_channel_attr_t *attr)
2411256Syl150051 {
2421256Syl150051 	xge_hal_status_e status;
2431256Syl150051 	xge_hal_device_t *hldev;
2441256Syl150051 	xge_hal_ring_t *ring = (xge_hal_ring_t *)channelh;
2451256Syl150051 	xge_hal_ring_queue_t *queue;
2461256Syl150051 
2471256Syl150051 
2481256Syl150051 	/* Note: at this point we have channel.devh and channel.pdev
2491256Syl150051 	 *       pre-set only! */
2501256Syl150051 
2511256Syl150051 	hldev = (xge_hal_device_t *)ring->channel.devh;
2521256Syl150051 	ring->config = &hldev->config.ring;
2531256Syl150051 	queue = &ring->config->queue[attr->post_qid];
2541256Syl150051 	ring->indicate_max_pkts = queue->indicate_max_pkts;
2551256Syl150051 	ring->buffer_mode = queue->buffer_mode;
2561256Syl150051 
2571256Syl150051 	xge_assert(queue->configured);
2581256Syl150051 
2591256Syl150051 #if defined(XGE_HAL_RX_MULTI_RESERVE)
2601256Syl150051 	xge_os_spin_lock_init(&ring->channel.reserve_lock, hldev->pdev);
2611256Syl150051 #elif defined(XGE_HAL_RX_MULTI_RESERVE_IRQ)
2621256Syl150051 	xge_os_spin_lock_init_irq(&ring->channel.reserve_lock, hldev->irqh);
2631256Syl150051 #endif
2641256Syl150051 #if defined(XGE_HAL_RX_MULTI_POST)
2651256Syl150051 	xge_os_spin_lock_init(&ring->channel.post_lock, hldev->pdev);
2661256Syl150051 #elif defined(XGE_HAL_RX_MULTI_POST_IRQ)
2671256Syl150051 	xge_os_spin_lock_init_irq(&ring->channel.post_lock, hldev->irqh);
2681256Syl150051 #endif
2691256Syl150051 
2701256Syl150051 	ring->rxd_size = XGE_HAL_RING_RXD_SIZEOF(queue->buffer_mode);
2711256Syl150051 	ring->rxd_priv_size =
2721256Syl150051 		sizeof(xge_hal_ring_rxd_priv_t) + attr->per_dtr_space;
2731256Syl150051 
2741256Syl150051 	/* how many RxDs can fit into one block. Depends on configured
2751256Syl150051 	 * buffer_mode. */
2761256Syl150051 	ring->rxds_per_block = XGE_HAL_RING_RXDS_PER_BLOCK(queue->buffer_mode);
2771256Syl150051 
2781256Syl150051 	/* calculate actual RxD block private size */
2791256Syl150051 	ring->rxdblock_priv_size = ring->rxd_priv_size * ring->rxds_per_block;
2801256Syl150051 
2813115Syl150051 	ring->reserved_rxds_arr = (void **) xge_os_malloc(ring->channel.pdev,
2821256Syl150051 		      sizeof(void*) * queue->max * ring->rxds_per_block);
2833115Syl150051 
2841256Syl150051 	if (ring->reserved_rxds_arr == NULL) {
2851256Syl150051 		__hal_ring_close(channelh);
2861256Syl150051 		return XGE_HAL_ERR_OUT_OF_MEMORY;
2871256Syl150051 	}
2881256Syl150051 
2891256Syl150051 	ring->mempool = __hal_mempool_create(
2901256Syl150051 				     hldev->pdev,
2911256Syl150051 				     ring->config->memblock_size,
2921256Syl150051 				     XGE_HAL_RING_RXDBLOCK_SIZE,
2931256Syl150051 				     ring->rxdblock_priv_size,
2941256Syl150051 				     queue->initial, queue->max,
2951256Syl150051 				     __hal_ring_mempool_item_alloc,
2961256Syl150051 				     NULL, /* nothing to free */
2971256Syl150051 				     ring);
2981256Syl150051 	if (ring->mempool == NULL) {
2991256Syl150051 		__hal_ring_close(channelh);
3001256Syl150051 		return XGE_HAL_ERR_OUT_OF_MEMORY;
3011256Syl150051 	}
3021256Syl150051 
3031256Syl150051 	status = __hal_channel_initialize(channelh,
3041256Syl150051 					  attr,
3051256Syl150051 					  ring->reserved_rxds_arr,
3061256Syl150051 					  queue->initial * ring->rxds_per_block,
3071256Syl150051 					  queue->max * ring->rxds_per_block,
3081256Syl150051 					  0 /* no threshold for ring! */);
3091256Syl150051 	if (status != XGE_HAL_OK) {
3101256Syl150051 		__hal_ring_close(channelh);
3111256Syl150051 		return status;
3121256Syl150051 	}
3131256Syl150051 
3141256Syl150051 	/* sanity check that everything formatted ok */
3151256Syl150051 	xge_assert(ring->reserved_rxds_arr[0] ==
3161256Syl150051 		    (char *)ring->mempool->items_arr[0] +
3171256Syl150051 		      (ring->rxds_per_block * ring->rxd_size - ring->rxd_size));
3181256Syl150051 
3191256Syl150051         /* Note:
3201256Syl150051 	 * Specifying dtr_init callback means two things:
3211256Syl150051 	 * 1) dtrs need to be initialized by ULD at channel-open time;
3221256Syl150051 	 * 2) dtrs need to be posted at channel-open time
3231256Syl150051 	 *    (that's what the initial_replenish() below does)
3241256Syl150051 	 * Currently we don't have a case when the 1) is done without the 2).
3251256Syl150051 	 */
3261256Syl150051 	if (ring->channel.dtr_init) {
3273115Syl150051 		if ((status = __hal_ring_initial_replenish (
3283115Syl150051 						(xge_hal_channel_t *) channelh,
3293115Syl150051 						XGE_HAL_CHANNEL_OC_NORMAL) )
3303115Syl150051 						!= XGE_HAL_OK) {
3311256Syl150051 			__hal_ring_close(channelh);
3321256Syl150051 			return status;
3331256Syl150051 		}
3341256Syl150051 	}
3351256Syl150051 
3363115Syl150051 	/* initial replenish will increment the counter in its post() routine,
3373115Syl150051 	 * we have to reset it */
3383115Syl150051 	ring->channel.usage_cnt = 0;
3393115Syl150051 
3401256Syl150051 	return XGE_HAL_OK;
3411256Syl150051 }
3421256Syl150051 
3431256Syl150051 void
__hal_ring_close(xge_hal_channel_h channelh)3441256Syl150051 __hal_ring_close(xge_hal_channel_h channelh)
3451256Syl150051 {
3461256Syl150051 	xge_hal_ring_t *ring = (xge_hal_ring_t *)channelh;
3471256Syl150051 	xge_hal_ring_queue_t *queue;
3481256Syl150051 #if defined(XGE_HAL_RX_MULTI_RESERVE)||defined(XGE_HAL_RX_MULTI_RESERVE_IRQ)||\
3491256Syl150051     defined(XGE_HAL_RX_MULTI_POST) || defined(XGE_HAL_RX_MULTI_POST_IRQ)
3501256Syl150051 	xge_hal_device_t *hldev = (xge_hal_device_t *)ring->channel.devh;
3511256Syl150051 #endif
3521256Syl150051 
3531256Syl150051 	xge_assert(ring->channel.pdev);
3541256Syl150051 
3551256Syl150051 	queue = &ring->config->queue[ring->channel.post_qid];
3561256Syl150051 
3571256Syl150051 	if (ring->mempool) {
3581256Syl150051 		__hal_mempool_destroy(ring->mempool);
3591256Syl150051 	}
3601256Syl150051 
3611256Syl150051 	if (ring->reserved_rxds_arr) {
3621256Syl150051 		xge_os_free(ring->channel.pdev,
3631256Syl150051 		          ring->reserved_rxds_arr,
3641256Syl150051 			  sizeof(void*) * queue->max * ring->rxds_per_block);
3651256Syl150051 	}
3661256Syl150051 
3671256Syl150051 	__hal_channel_terminate(channelh);
3681256Syl150051 
3691256Syl150051 #if defined(XGE_HAL_RX_MULTI_RESERVE)
3701256Syl150051 	xge_os_spin_lock_destroy(&ring->channel.reserve_lock, hldev->pdev);
3711256Syl150051 #elif defined(XGE_HAL_RX_MULTI_RESERVE_IRQ)
3721256Syl150051 	xge_os_spin_lock_destroy_irq(&ring->channel.reserve_lock, hldev->pdev);
3731256Syl150051 #endif
3741256Syl150051 #if defined(XGE_HAL_RX_MULTI_POST)
3751256Syl150051 	xge_os_spin_lock_destroy(&ring->channel.post_lock, hldev->pdev);
3761256Syl150051 #elif defined(XGE_HAL_RX_MULTI_POST_IRQ)
3771256Syl150051 	xge_os_spin_lock_destroy_irq(&ring->channel.post_lock, hldev->pdev);
3781256Syl150051 #endif
3791256Syl150051 }
3801256Syl150051 
3811256Syl150051 void
__hal_ring_prc_enable(xge_hal_channel_h channelh)3821256Syl150051 __hal_ring_prc_enable(xge_hal_channel_h channelh)
3831256Syl150051 {
3841256Syl150051 	xge_hal_ring_t *ring = (xge_hal_ring_t *)channelh;
3851256Syl150051 	xge_hal_device_t *hldev = (xge_hal_device_t *)ring->channel.devh;
3861256Syl150051 	xge_hal_pci_bar0_t *bar0;
3871256Syl150051 	u64 val64;
3881256Syl150051 	void *first_block;
3891256Syl150051 	int block_num;
3901256Syl150051 	xge_hal_ring_queue_t *queue;
3911256Syl150051 	pci_dma_h dma_handle;
3921256Syl150051 
3931256Syl150051 	xge_assert(ring);
3941256Syl150051 	xge_assert(ring->channel.pdev);
3951256Syl150051 	bar0 = (xge_hal_pci_bar0_t *) (void *)
3961256Syl150051 			((xge_hal_device_t *)ring->channel.devh)->bar0;
3971256Syl150051 
3981256Syl150051 	queue = &ring->config->queue[ring->channel.post_qid];
3991256Syl150051 	xge_assert(queue->buffer_mode == 1 ||
4001256Syl150051 		    queue->buffer_mode == 3 ||
4011256Syl150051 		    queue->buffer_mode == 5);
4021256Syl150051 
4031256Syl150051 	/* last block in fact becomes first. This is just the way it
4041256Syl150051 	 * is filled up and linked by item_alloc() */
4051256Syl150051 
4061256Syl150051 	block_num = queue->initial;
4071256Syl150051 	first_block = __hal_mempool_item(ring->mempool, block_num - 1);
4081256Syl150051 	val64 = __hal_ring_item_dma_addr(ring->mempool,
4091256Syl150051 					 first_block, &dma_handle);
4101256Syl150051 	xge_os_pio_mem_write64(ring->channel.pdev, ring->channel.regh0,
4111256Syl150051 			val64, &bar0->prc_rxd0_n[ring->channel.post_qid]);
4121256Syl150051 
4133115Syl150051 	xge_debug_ring(XGE_TRACE, "ring%d PRC DMA addr 0x"XGE_OS_LLXFMT" initialized",
4141256Syl150051 			ring->channel.post_qid, (unsigned long long)val64);
4151256Syl150051 
4161256Syl150051 	val64 = xge_os_pio_mem_read64(ring->channel.pdev,
4171256Syl150051 		ring->channel.regh0, &bar0->prc_ctrl_n[ring->channel.post_qid]);
4181256Syl150051 	if (xge_hal_device_check_id(hldev) == XGE_HAL_CARD_HERC &&
4191256Syl150051 	    !queue->rth_en) {
4201256Syl150051 		val64 |= XGE_HAL_PRC_CTRL_RTH_DISABLE;
4211256Syl150051 	}
4221256Syl150051 	val64 |= XGE_HAL_PRC_CTRL_RC_ENABLED;
4231256Syl150051 
4241256Syl150051 	val64 |= vBIT((queue->buffer_mode >> 1),14,2);/* 1,3 or 5 => 0,1 or 2 */
4251256Syl150051 	val64 &= ~XGE_HAL_PRC_CTRL_RXD_BACKOFF_INTERVAL(0xFFFFFF);
4261256Syl150051 	val64 |= XGE_HAL_PRC_CTRL_RXD_BACKOFF_INTERVAL(
4271256Syl150051 		(hldev->config.pci_freq_mherz * queue->backoff_interval_us));
4281256Syl150051 
4291256Syl150051 	/* Beware: no snoop by the bridge if (no_snoop_bits) */
4301256Syl150051 	val64 |= XGE_HAL_PRC_CTRL_NO_SNOOP(queue->no_snoop_bits);
4311256Syl150051 
4321256Syl150051         /* Herc: always use group_reads */
4331256Syl150051 	if (xge_hal_device_check_id(hldev) == XGE_HAL_CARD_HERC)
4343115Syl150051 			val64 |= XGE_HAL_PRC_CTRL_GROUP_READS;
4351256Syl150051 
4363115Syl150051 	if (hldev->config.bimodal_interrupts)
4373115Syl150051 		if (xge_hal_device_check_id(hldev) == XGE_HAL_CARD_HERC)
4383115Syl150051 			val64 |= XGE_HAL_PRC_CTRL_BIMODAL_INTERRUPT;
4393115Syl150051 
4401256Syl150051 	xge_os_pio_mem_write64(ring->channel.pdev, ring->channel.regh0,
4411256Syl150051 			val64, &bar0->prc_ctrl_n[ring->channel.post_qid]);
4421256Syl150051 
4431256Syl150051 	/* Configure Receive Protocol Assist */
4441256Syl150051 	val64 = xge_os_pio_mem_read64(ring->channel.pdev,
4451256Syl150051 			ring->channel.regh0, &bar0->rx_pa_cfg);
4461256Syl150051 	val64 |= XGE_HAL_RX_PA_CFG_SCATTER_MODE(ring->config->scatter_mode);
4471256Syl150051 	val64 |= (XGE_HAL_RX_PA_CFG_IGNORE_SNAP_OUI | XGE_HAL_RX_PA_CFG_IGNORE_LLC_CTRL);
4481256Syl150051 	/* Clean STRIP_VLAN_TAG bit and set as config from upper layer */
4491256Syl150051 	val64 &= ~XGE_HAL_RX_PA_CFG_STRIP_VLAN_TAG_MODE(1);
4501256Syl150051 	val64 |= XGE_HAL_RX_PA_CFG_STRIP_VLAN_TAG_MODE(ring->config->strip_vlan_tag);
4511256Syl150051 
4521256Syl150051 	xge_os_pio_mem_write64(ring->channel.pdev, ring->channel.regh0,
4531256Syl150051 			val64, &bar0->rx_pa_cfg);
4541256Syl150051 
4551256Syl150051 	xge_debug_ring(XGE_TRACE, "ring%d enabled in buffer_mode %d",
4561256Syl150051 			ring->channel.post_qid, queue->buffer_mode);
4571256Syl150051 }
4581256Syl150051 
4591256Syl150051 void
__hal_ring_prc_disable(xge_hal_channel_h channelh)4601256Syl150051 __hal_ring_prc_disable(xge_hal_channel_h channelh)
4611256Syl150051 {
4621256Syl150051 	xge_hal_ring_t *ring = (xge_hal_ring_t *)channelh;
4631256Syl150051 	xge_hal_pci_bar0_t *bar0;
4641256Syl150051 	u64 val64;
4651256Syl150051 
4661256Syl150051 	xge_assert(ring);
4671256Syl150051 	xge_assert(ring->channel.pdev);
4681256Syl150051 	bar0 = (xge_hal_pci_bar0_t *) (void *)
4691256Syl150051 			((xge_hal_device_t *)ring->channel.devh)->bar0;
4701256Syl150051 
4711256Syl150051 	val64 = xge_os_pio_mem_read64(ring->channel.pdev,
4721256Syl150051 	ring->channel.regh0,
4731256Syl150051 			      &bar0->prc_ctrl_n[ring->channel.post_qid]);
4741256Syl150051 	val64 &= ~((u64) XGE_HAL_PRC_CTRL_RC_ENABLED);
4751256Syl150051 	xge_os_pio_mem_write64(ring->channel.pdev, ring->channel.regh0,
4761256Syl150051 			val64, &bar0->prc_ctrl_n[ring->channel.post_qid]);
4771256Syl150051 }
4781256Syl150051 
4791256Syl150051 void
__hal_ring_hw_initialize(xge_hal_device_h devh)4801256Syl150051 __hal_ring_hw_initialize(xge_hal_device_h devh)
4811256Syl150051 {
4821256Syl150051 	xge_hal_device_t *hldev = (xge_hal_device_t *)devh;
4831256Syl150051 	xge_hal_pci_bar0_t *bar0 = (xge_hal_pci_bar0_t *)(void *)hldev->bar0;
4841256Syl150051 	u64 val64;
4851256Syl150051 	int i, j;
4861256Syl150051 
4871256Syl150051 	/* Rx DMA intialization. */
4881256Syl150051 
4891256Syl150051 	val64 = 0;
4901256Syl150051 	for (i = 0; i < XGE_HAL_MAX_RING_NUM; i++) {
4911256Syl150051 		if (!hldev->config.ring.queue[i].configured)
4921256Syl150051 			continue;
4931256Syl150051 		val64 |= vBIT(hldev->config.ring.queue[i].priority,
4941256Syl150051 							(5 + (i * 8)), 3);
4951256Syl150051 	}
4961256Syl150051 	xge_os_pio_mem_write64(hldev->pdev, hldev->regh0, val64,
4971256Syl150051 			&bar0->rx_queue_priority);
4983115Syl150051 	xge_debug_ring(XGE_TRACE, "Rings priority configured to 0x"XGE_OS_LLXFMT,
4991256Syl150051 			(unsigned long long)val64);
5001256Syl150051 
5011256Syl150051 	/* Configuring ring queues according to per-ring configuration */
5021256Syl150051 	val64 = 0;
5031256Syl150051 	for (i = 0; i < XGE_HAL_MAX_RING_NUM; i++) {
5041256Syl150051 		if (!hldev->config.ring.queue[i].configured)
5051256Syl150051 			continue;
5061256Syl150051 		val64 |= vBIT(hldev->config.ring.queue[i].dram_size_mb,(i*8),8);
5071256Syl150051 	}
5081256Syl150051 	xge_os_pio_mem_write64(hldev->pdev, hldev->regh0, val64,
5091256Syl150051 	                     &bar0->rx_queue_cfg);
5103115Syl150051 	xge_debug_ring(XGE_TRACE, "DRAM configured to 0x"XGE_OS_LLXFMT,
5111256Syl150051 			(unsigned long long)val64);
5121256Syl150051 
513*6937Sxw161283 	if (!hldev->config.rts_qos_en &&
514*6937Sxw161283 	    !hldev->config.rts_port_en &&
515*6937Sxw161283 	    !hldev->config.rts_mac_en) {
516*6937Sxw161283 
517*6937Sxw161283 		/*
518*6937Sxw161283 		 * Activate default (QoS-based) Rx steering
519*6937Sxw161283 		 */
5201256Syl150051 
521*6937Sxw161283 		val64 = xge_os_pio_mem_read64(hldev->pdev, hldev->regh0,
522*6937Sxw161283 					      &bar0->rts_qos_steering);
523*6937Sxw161283 		for (j = 0; j < 8 /* QoS max */; j++)
524*6937Sxw161283 		{
525*6937Sxw161283 			for (i = 0; i < XGE_HAL_MAX_RING_NUM; i++)
526*6937Sxw161283 			{
527*6937Sxw161283 				if (!hldev->config.ring.queue[i].configured)
528*6937Sxw161283 					continue;
529*6937Sxw161283 				if (!hldev->config.ring.queue[i].rth_en)
530*6937Sxw161283 					val64 |= (BIT(i) >> (j*8));
531*6937Sxw161283 			}
532*6937Sxw161283 		}
533*6937Sxw161283 		xge_os_pio_mem_write64(hldev->pdev, hldev->regh0, val64,
534*6937Sxw161283 				       &bar0->rts_qos_steering);
535*6937Sxw161283 		xge_debug_ring(XGE_TRACE, "QoS steering configured to 0x"XGE_OS_LLXFMT,
536*6937Sxw161283 			       (unsigned long long)val64);
5373115Syl150051 
538*6937Sxw161283 	}
539*6937Sxw161283 
5401256Syl150051 	/* Note: If a queue does not exist, it should be assigned a maximum
5411256Syl150051 	 *	 length of zero. Otherwise, packet loss could occur.
5421256Syl150051 	 *	 P. 4-4 User guide.
5431256Syl150051 	 *
5441256Syl150051 	 * All configured rings will be properly set at device open time
5451256Syl150051 	 * by utilizing device_mtu_set() API call. */
5461256Syl150051 	for (i = 0; i < XGE_HAL_MAX_RING_NUM; i++) {
5471256Syl150051 		if (hldev->config.ring.queue[i].configured)
5481256Syl150051 			continue;
5491256Syl150051 		xge_os_pio_mem_write64(hldev->pdev, hldev->regh0, 0ULL,
5501256Syl150051 		                     &bar0->rts_frm_len_n[i]);
5511256Syl150051 	}
5521256Syl150051 
5531256Syl150051 #ifdef XGE_HAL_HERC_EMULATION
5541256Syl150051 	val64 = xge_os_pio_mem_read64(hldev->pdev, hldev->regh0,
5551256Syl150051 		((u8 *)bar0 + 0x2e60)); /* mc_rldram_mrs_herc */
5561256Syl150051 	val64 |= 0x0000000000010000;
5571256Syl150051 	xge_os_pio_mem_write64(hldev->pdev, hldev->regh0, val64,
5581256Syl150051 		((u8 *)bar0 + 0x2e60));
5591256Syl150051 
5601256Syl150051 	val64 |= 0x003a000000000000;
5611256Syl150051 	xge_os_pio_mem_write64(hldev->pdev, hldev->regh0, val64,
5621256Syl150051 		((u8 *)bar0 + 0x2e40)); /* mc_rldram_ref_herc */
5631256Syl150051 	xge_os_mdelay(2000);
5641256Syl150051 #endif
5651256Syl150051 
5661256Syl150051 	/* now enabling MC-RLDRAM after setting MC_QUEUE sizes */
5671256Syl150051 	val64 = xge_os_pio_mem_read64(hldev->pdev, hldev->regh0,
5681256Syl150051 	                            &bar0->mc_rldram_mrs);
5691256Syl150051 	val64 |= XGE_HAL_MC_RLDRAM_QUEUE_SIZE_ENABLE |
5701256Syl150051 		 XGE_HAL_MC_RLDRAM_MRS_ENABLE;
5711256Syl150051 	__hal_pio_mem_write32_upper(hldev->pdev, hldev->regh0, (u32)(val64>>32),
5721256Syl150051 	                     &bar0->mc_rldram_mrs);
5731256Syl150051 	xge_os_wmb();
5741256Syl150051 	__hal_pio_mem_write32_lower(hldev->pdev, hldev->regh0, (u32)val64,
5751256Syl150051 	                     &bar0->mc_rldram_mrs);
5761256Syl150051 
5771256Syl150051 	/* RLDRAM initialization procedure require 500us to complete */
5781256Syl150051 	xge_os_mdelay(1);
5791256Syl150051 
5801256Syl150051 	/* Temporary fixes for Herc RLDRAM */
5811256Syl150051 	if (xge_hal_device_check_id(hldev) == XGE_HAL_CARD_HERC) {
5821256Syl150051 		val64 = XGE_HAL_MC_RLDRAM_SET_REF_PERIOD(0x0279);
5831256Syl150051 		xge_os_pio_mem_write64(hldev->pdev, hldev->regh0, val64,
5841256Syl150051 		                     &bar0->mc_rldram_ref_per_herc);
5851256Syl150051 
5861256Syl150051 		val64 = xge_os_pio_mem_read64(hldev->pdev, hldev->regh0,
5871256Syl150051 	                            &bar0->mc_rldram_mrs_herc);
5883115Syl150051 		xge_debug_ring(XGE_TRACE, "default mc_rldram_mrs_herc 0x"XGE_OS_LLXFMT,
5891256Syl150051 			       (unsigned long long)val64);
5901256Syl150051 
5911256Syl150051 		val64 = 0x0003570003010300ULL;
5921256Syl150051 		xge_os_pio_mem_write64(hldev->pdev, hldev->regh0, val64,
5931256Syl150051 		                       &bar0->mc_rldram_mrs_herc);
5941256Syl150051 
5951256Syl150051 		xge_os_mdelay(1);
5961256Syl150051 	}
597*6937Sxw161283 
598*6937Sxw161283 	if (hldev->config.intr_mode != XGE_HAL_INTR_MODE_MSIX)
599*6937Sxw161283 		return;
600*6937Sxw161283 
601*6937Sxw161283 	/*
602*6937Sxw161283 	 * Assign MSI-X vectors
603*6937Sxw161283 	 */
604*6937Sxw161283 	for (i = 0; i < XGE_HAL_MAX_RING_NUM; i++) {
605*6937Sxw161283 		xge_list_t *item;
606*6937Sxw161283 		xge_hal_channel_t *channel = NULL;
607*6937Sxw161283 
608*6937Sxw161283 		if (!hldev->config.ring.queue[i].configured ||
609*6937Sxw161283 		    !hldev->config.ring.queue[i].intr_vector)
610*6937Sxw161283 			continue;
611*6937Sxw161283 
612*6937Sxw161283 		/* find channel */
613*6937Sxw161283 		xge_list_for_each(item, &hldev->free_channels) {
614*6937Sxw161283 			xge_hal_channel_t *tmp;
615*6937Sxw161283 			tmp = xge_container_of(item, xge_hal_channel_t,
616*6937Sxw161283 						   item);
617*6937Sxw161283 			if (tmp->type == XGE_HAL_CHANNEL_TYPE_RING &&
618*6937Sxw161283 			    tmp->post_qid == i) {
619*6937Sxw161283 				channel = tmp;
620*6937Sxw161283 				break;
621*6937Sxw161283 			}
622*6937Sxw161283 		}
623*6937Sxw161283 
624*6937Sxw161283 		if (channel) {
625*6937Sxw161283 			(void) xge_hal_channel_msix_set(channel,
626*6937Sxw161283 				hldev->config.ring.queue[i].intr_vector);
627*6937Sxw161283 		}
628*6937Sxw161283 	}
629*6937Sxw161283 
6301256Syl150051 	xge_debug_ring(XGE_TRACE, "%s", "ring channels initialized");
6311256Syl150051 }
6321256Syl150051 
6331256Syl150051 void
__hal_ring_mtu_set(xge_hal_device_h devh,int new_frmlen)6341256Syl150051 __hal_ring_mtu_set(xge_hal_device_h devh, int new_frmlen)
6351256Syl150051 {
6361256Syl150051 	int i;
6371256Syl150051 	xge_hal_device_t *hldev = (xge_hal_device_t *)devh;
6381256Syl150051 	xge_hal_pci_bar0_t *bar0 = (xge_hal_pci_bar0_t *)(void *)hldev->bar0;
6391256Syl150051 
6401256Syl150051 	for (i = 0; i < XGE_HAL_MAX_RING_NUM; i++) {
6411256Syl150051 		if (!hldev->config.ring.queue[i].configured)
6421256Syl150051 			continue;
6431256Syl150051 		if (hldev->config.ring.queue[i].max_frm_len !=
6441256Syl150051 						XGE_HAL_RING_USE_MTU) {
6451256Syl150051 			xge_os_pio_mem_write64(hldev->pdev, hldev->regh0,
6461256Syl150051 			        XGE_HAL_MAC_RTS_FRM_LEN_SET(
6471256Syl150051 				hldev->config.ring.queue[i].max_frm_len),
6481256Syl150051 				&bar0->rts_frm_len_n[i]);
6491256Syl150051 		} else {
6501256Syl150051 			xge_os_pio_mem_write64(hldev->pdev, hldev->regh0,
6511256Syl150051 				       XGE_HAL_MAC_RTS_FRM_LEN_SET(new_frmlen),
6521256Syl150051 				       &bar0->rts_frm_len_n[i]);
6531256Syl150051 		}
6541256Syl150051 	}
6551256Syl150051 	xge_os_pio_mem_write64(hldev->pdev, hldev->regh0,
6561256Syl150051 			       XGE_HAL_RMAC_MAX_PYLD_LEN(new_frmlen),
6571256Syl150051 				       &bar0->rmac_max_pyld_len);
6581256Syl150051 }
659