staging: r8188eu: Add files for new driver - part 17

/******************************************************************************

 *

 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms of version 2 of the GNU General Public License as

 * published by the Free Software Foundation.

 *

 * This program is distributed in the hope that it will be useful, but WITHOUT

 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or

 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for

 * more details.

 *

 * You should have received a copy of the GNU General Public License along with

 * this program; if not, write to the Free Software Foundation, Inc.,

 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA

 *

 *

 ******************************************************************************/

#include <osdep_service.h>

#include <drv_types.h>

#include <rtl8188e_hal.h>

#include <rtl8188e_led.h>

/*  LED object. */

/*  LED_819xUsb routines. */

/*	Description: */

/*		Turn on LED according to LedPin specified. */

void SwLedOn(struct adapter *padapter, struct LED_871x *pLed)

{

	u8	LedCfg;

	if (padapter->bSurpriseRemoved || padapter->bDriverStopped)

		return;

	LedCfg = rtw_read8(padapter, REG_LEDCFG2);

	switch (pLed->LedPin) {

	case LED_PIN_LED0:

		rtw_write8(padapter, REG_LEDCFG2, (LedCfg&0xf0)|BIT5|BIT6); /*  SW control led0 on. */

		break;

	case LED_PIN_LED1:

		rtw_write8(padapter, REG_LEDCFG2, (LedCfg&0x0f)|BIT5); /*  SW control led1 on. */

		break;

	default:

		break;

	}

	pLed->bLedOn = true;

}

/*	Description: */

/*		Turn off LED according to LedPin specified. */

void SwLedOff(struct adapter *padapter, struct LED_871x *pLed)

{

	u8	LedCfg;

	struct hal_data_8188e	*pHalData = GET_HAL_DATA(padapter);

	if (padapter->bSurpriseRemoved || padapter->bDriverStopped)

		goto exit;

	LedCfg = rtw_read8(padapter, REG_LEDCFG2);/* 0x4E */

	switch (pLed->LedPin) {

	case LED_PIN_LED0:

		if (pHalData->bLedOpenDrain) {

			/*  Open-drain arrangement for controlling the LED) */

			LedCfg &= 0x90; /*  Set to software control. */

			rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3));

			LedCfg = rtw_read8(padapter, REG_MAC_PINMUX_CFG);

			LedCfg &= 0xFE;

			rtw_write8(padapter, REG_MAC_PINMUX_CFG, LedCfg);

		} else {

			rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3|BIT5|BIT6));

		}

		break;

	case LED_PIN_LED1:

		LedCfg &= 0x0f; /*  Set to software control. */

		rtw_write8(padapter, REG_LEDCFG2, (LedCfg|BIT3));

		break;

	default:

		break;

	}

exit:

	pLed->bLedOn = false;

}

/*  Interface to manipulate LED objects. */

/*  Default LED behavior. */

/*	Description: */

/*		Initialize all LED_871x objects. */

void rtl8188eu_InitSwLeds(struct adapter *padapter)

{

	struct led_priv *pledpriv = &(padapter->ledpriv);

	pledpriv->LedControlHandler = LedControl871x;

	InitLed871x(padapter, &(pledpriv->SwLed0), LED_PIN_LED0);

	InitLed871x(padapter, &(pledpriv->SwLed1), LED_PIN_LED1);

}

/*	Description: */

/*		DeInitialize all LED_819xUsb objects. */

void rtl8188eu_DeInitSwLeds(struct adapter *padapter)

{

	struct led_priv	*ledpriv = &(padapter->ledpriv);

	DeInitLed871x(&(ledpriv->SwLed0));

	DeInitLed871x(&(ledpriv->SwLed1));

}

/******************************************************************************

 *

 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms of version 2 of the GNU General Public License as

 * published by the Free Software Foundation.

 *

 * This program is distributed in the hope that it will be useful, but WITHOUT

 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or

 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for

 * more details.

 *

 * You should have received a copy of the GNU General Public License along with

 * this program; if not, write to the Free Software Foundation, Inc.,

 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA

 *

 *

 ******************************************************************************/

#define _RTL8188EU_RECV_C_

#include <osdep_service.h>

#include <drv_types.h>

#include <recv_osdep.h>

#include <mlme_osdep.h>

#include <ip.h>

#include <if_ether.h>

#include <ethernet.h>

#include <usb_ops.h>

#include <wifi.h>

#include <rtl8188e_hal.h>

void rtl8188eu_init_recvbuf(struct adapter *padapter, struct recv_buf *precvbuf)

{

	precvbuf->transfer_len = 0;

	precvbuf->len = 0;

	precvbuf->ref_cnt = 0;

	if (precvbuf->pbuf) {

		precvbuf->pdata = precvbuf->pbuf;

		precvbuf->phead = precvbuf->pbuf;

		precvbuf->ptail = precvbuf->pbuf;

		precvbuf->pend = precvbuf->pdata + MAX_RECVBUF_SZ;

	}

}

int	rtl8188eu_init_recv_priv(struct adapter *padapter)

{

	struct recv_priv	*precvpriv = &padapter->recvpriv;

	int	i, res = _SUCCESS;

	struct recv_buf *precvbuf;

	tasklet_init(&precvpriv->recv_tasklet,

		     (void(*)(unsigned long))rtl8188eu_recv_tasklet,

		     (unsigned long)padapter);

	/* init recv_buf */

	_rtw_init_queue(&precvpriv->free_recv_buf_queue);

	precvpriv->pallocated_recv_buf = rtw_zmalloc(NR_RECVBUFF * sizeof(struct recv_buf) + 4);

	if (precvpriv->pallocated_recv_buf == NULL) {

		res = _FAIL;

		RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("alloc recv_buf fail!\n"));

		goto exit;

	}

	_rtw_memset(precvpriv->pallocated_recv_buf, 0, NR_RECVBUFF * sizeof(struct recv_buf) + 4);

	precvpriv->precv_buf = (u8 *)N_BYTE_ALIGMENT((size_t)(precvpriv->pallocated_recv_buf), 4);

	precvbuf = (struct recv_buf *)precvpriv->precv_buf;

	for (i = 0; i < NR_RECVBUFF; i++) {

		_rtw_init_listhead(&precvbuf->list);

		_rtw_spinlock_init(&precvbuf->recvbuf_lock);

		precvbuf->alloc_sz = MAX_RECVBUF_SZ;

		res = rtw_os_recvbuf_resource_alloc(padapter, precvbuf);

		if (res == _FAIL)

			break;

		precvbuf->ref_cnt = 0;

		precvbuf->adapter = padapter;

		precvbuf++;

	}

	precvpriv->free_recv_buf_queue_cnt = NR_RECVBUFF;

	skb_queue_head_init(&precvpriv->rx_skb_queue);

	{

		int i;

		size_t tmpaddr = 0;

		size_t alignment = 0;

		struct sk_buff *pskb = NULL;

		skb_queue_head_init(&precvpriv->free_recv_skb_queue);

		for (i = 0; i < NR_PREALLOC_RECV_SKB; i++) {

			pskb = __netdev_alloc_skb(padapter->pnetdev, MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ, GFP_KERNEL);

			if (pskb) {

				pskb->dev = padapter->pnetdev;

				tmpaddr = (size_t)pskb->data;

				alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1);

				skb_reserve(pskb, (RECVBUFF_ALIGN_SZ - alignment));

				skb_queue_tail(&precvpriv->free_recv_skb_queue, pskb);

			}

			pskb = NULL;

		}

	}

exit:

	return res;

}

void rtl8188eu_free_recv_priv(struct adapter *padapter)

{

	int	i;

	struct recv_buf	*precvbuf;

	struct recv_priv	*precvpriv = &padapter->recvpriv;

	precvbuf = (struct recv_buf *)precvpriv->precv_buf;

	for (i = 0; i < NR_RECVBUFF; i++) {

		rtw_os_recvbuf_resource_free(padapter, precvbuf);

		precvbuf++;

	}

	kfree(precvpriv->pallocated_recv_buf);

	if (skb_queue_len(&precvpriv->rx_skb_queue))

		DBG_88E(KERN_WARNING "rx_skb_queue not empty\n");

	skb_queue_purge(&precvpriv->rx_skb_queue);

	if (skb_queue_len(&precvpriv->free_recv_skb_queue))

		DBG_88E(KERN_WARNING "free_recv_skb_queue not empty, %d\n", skb_queue_len(&precvpriv->free_recv_skb_queue));

	skb_queue_purge(&precvpriv->free_recv_skb_queue);

}