mirror of
https://github.com/chinawrj/rtl8812au
synced 2024-12-02 18:02:43 +00:00
2535 lines
65 KiB
C
2535 lines
65 KiB
C
/******************************************************************************
|
|
*
|
|
* 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 _RTW_MP_IOCTL_C_
|
|
|
|
#include <drv_types.h>
|
|
#include <rtw_mp_ioctl.h>
|
|
#include "../hal/phydm/phydm_precomp.h"
|
|
|
|
/* **************** oid_rtl_seg_81_85 section start **************** */
|
|
NDIS_STATUS oid_rt_wireless_mode_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(u8))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
if (poid_par_priv->type_of_oid == SET_OID)
|
|
Adapter->registrypriv.wireless_mode = *(u8 *)poid_par_priv->information_buf;
|
|
else if (poid_par_priv->type_of_oid == QUERY_OID) {
|
|
*(u8 *)poid_par_priv->information_buf = Adapter->registrypriv.wireless_mode;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
} else
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
|
|
return status;
|
|
}
|
|
/* **************** oid_rtl_seg_81_87_80 section start **************** */
|
|
NDIS_STATUS oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
struct bb_reg_param *pbbreg;
|
|
u16 offset;
|
|
u32 value;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf);
|
|
|
|
offset = (u16)(pbbreg->offset) & 0xFFF; /* 0ffset :0x800~0xfff */
|
|
if (offset < BB_REG_BASE_ADDR)
|
|
offset |= BB_REG_BASE_ADDR;
|
|
|
|
value = pbbreg->value;
|
|
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
write_bbreg(Adapter, offset, 0xFFFFFFFF, value);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
struct bb_reg_param *pbbreg;
|
|
u16 offset;
|
|
u32 value;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf);
|
|
|
|
offset = (u16)(pbbreg->offset) & 0xFFF; /* 0ffset :0x800~0xfff */
|
|
if (offset < BB_REG_BASE_ADDR)
|
|
offset |= BB_REG_BASE_ADDR;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
value = read_bbreg(Adapter, offset, 0xFFFFFFFF);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
pbbreg->value = value;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
struct rf_reg_param *pbbreg;
|
|
u8 path;
|
|
u8 offset;
|
|
u32 value;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf);
|
|
|
|
if (pbbreg->path >= MAX_RF_PATH_NUMS)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
if (pbbreg->offset > 0xFF)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
if (pbbreg->value > 0xFFFFF)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
path = (u8)pbbreg->path;
|
|
offset = (u8)pbbreg->offset;
|
|
value = pbbreg->value;
|
|
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
write_rfreg(Adapter, path, offset, value);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
struct rf_reg_param *pbbreg;
|
|
u8 path;
|
|
u8 offset;
|
|
u32 value;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf);
|
|
|
|
if (pbbreg->path >= MAX_RF_PATH_NUMS)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
if (pbbreg->offset > 0xFF)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
path = (u8)pbbreg->path;
|
|
offset = (u8)pbbreg->offset;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
value = read_rfreg(Adapter, path, offset);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
pbbreg->value = value;
|
|
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
|
|
return status;
|
|
}
|
|
/* **************** oid_rtl_seg_81_87_00 section end****************
|
|
* ------------------------------------------------------------------------------ */
|
|
|
|
/* **************** oid_rtl_seg_81_80_00 section start ****************
|
|
* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_set_data_rate_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u32 ratevalue;/* 4 */
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len != sizeof(u32))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
ratevalue = *((u32 *)poid_par_priv->information_buf); /* 4 */
|
|
if (ratevalue >= MPT_RATE_LAST)
|
|
return NDIS_STATUS_INVALID_DATA;
|
|
|
|
Adapter->mppriv.rateidx = ratevalue;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
SetDataRate(Adapter);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_start_test_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u32 mode;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (Adapter->registrypriv.mp_mode == 0)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
/* IQCalibrateBcut(Adapter); */
|
|
|
|
mode = *((u32 *)poid_par_priv->information_buf);
|
|
Adapter->mppriv.mode = mode;/* 1 for loopback */
|
|
|
|
if (mp_start_test(Adapter) == _FAIL) {
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
goto exit;
|
|
}
|
|
|
|
exit:
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_stop_test_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
mp_stop_test(Adapter);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u32 Channel;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->information_buf_len != sizeof(u32))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
if (poid_par_priv->type_of_oid == QUERY_OID) {
|
|
*((u32 *)poid_par_priv->information_buf) = Adapter->mppriv.channel;
|
|
return NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
Channel = *((u32 *)poid_par_priv->information_buf);
|
|
if (Channel > 14)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
Adapter->mppriv.channel = Channel;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
SetChannel(Adapter);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_set_bandwidth_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u16 bandwidth;
|
|
u16 channel_offset;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(u32))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
bandwidth = *((u32 *)poid_par_priv->information_buf); /* 4 */
|
|
channel_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
|
|
|
|
if (bandwidth != CHANNEL_WIDTH_40)
|
|
bandwidth = CHANNEL_WIDTH_20;
|
|
padapter->mppriv.bandwidth = (u8)bandwidth;
|
|
padapter->mppriv.prime_channel_offset = (u8)channel_offset;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
SetBandwidth(padapter);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u32 antenna;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->information_buf_len != sizeof(u32))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
if (poid_par_priv->type_of_oid == SET_OID) {
|
|
antenna = *(u32 *)poid_par_priv->information_buf;
|
|
|
|
Adapter->mppriv.antenna_tx = (u16)((antenna & 0xFFFF0000) >> 16);
|
|
Adapter->mppriv.antenna_rx = (u16)(antenna & 0x0000FFFF);
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
SetAntenna(Adapter);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
} else {
|
|
antenna = (Adapter->mppriv.antenna_tx << 16) | Adapter->mppriv.antenna_rx;
|
|
*(u32 *)poid_par_priv->information_buf = antenna;
|
|
}
|
|
|
|
|
|
return status;
|
|
}
|
|
|
|
NDIS_STATUS oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u32 tx_pwr_idx;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len != sizeof(u32))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
tx_pwr_idx = *((u32 *)poid_par_priv->information_buf);
|
|
if (tx_pwr_idx > MAX_TX_PWR_INDEX_N_MODE)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
Adapter->mppriv.txpoweridx = (u8)tx_pwr_idx;
|
|
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
SetTxPower(Adapter);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
|
|
/* ------------------------------------------------------------------------------
|
|
* **************** oid_rtl_seg_81_80_20 section start ****************
|
|
* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID) {
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
return status;
|
|
}
|
|
|
|
if (poid_par_priv->information_buf_len == sizeof(ULONG)) {
|
|
*(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.tx_pktcount;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
} else
|
|
status = NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID) {
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
return status;
|
|
}
|
|
if (poid_par_priv->information_buf_len == sizeof(ULONG)) {
|
|
*(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.rx_pktcount;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
} else
|
|
status = NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID) {
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
return status;
|
|
}
|
|
if (poid_par_priv->information_buf_len == sizeof(ULONG)) {
|
|
*(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.rx_crcerrpktcount;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
} else
|
|
status = NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
|
|
NDIS_STATUS oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID) {
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
return status;
|
|
}
|
|
|
|
Adapter->mppriv.tx_pktcount = 0;
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID) {
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
return status;
|
|
}
|
|
|
|
if (poid_par_priv->information_buf_len == sizeof(ULONG)) {
|
|
Adapter->mppriv.rx_pktcount = 0;
|
|
Adapter->mppriv.rx_crcerrpktcount = 0;
|
|
} else
|
|
status = NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID) {
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
return status;
|
|
}
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
ResetPhyRxPktCount(Adapter);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len != sizeof(ULONG))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
*(ULONG *)poid_par_priv->information_buf = GetPhyRxPktReceived(Adapter);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
|
|
if (poid_par_priv->information_buf_len != sizeof(ULONG))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
*(ULONG *)poid_par_priv->information_buf = GetPhyRxPktCRC32Error(Adapter);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
|
|
return status;
|
|
}
|
|
/* **************** oid_rtl_seg_81_80_20 section end **************** */
|
|
NDIS_STATUS oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u32 bStartTest;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
bStartTest = *((u32 *)poid_par_priv->information_buf);
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
SetContinuousTx(Adapter, (u8)bStartTest);
|
|
if (bStartTest) {
|
|
struct mp_priv *pmp_priv = &Adapter->mppriv;
|
|
if (pmp_priv->tx.stop == 0) {
|
|
pmp_priv->tx.stop = 1;
|
|
RTW_INFO("%s: pkt tx is running...\n", __func__);
|
|
rtw_msleep_os(5);
|
|
}
|
|
pmp_priv->tx.stop = 0;
|
|
pmp_priv->tx.count = 1;
|
|
SetPacketTx(Adapter);
|
|
}
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
|
|
NDIS_STATUS oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u32 bStartTest;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
bStartTest = *((u32 *)poid_par_priv->information_buf);
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
SetSingleCarrierTx(Adapter, (u8)bStartTest);
|
|
if (bStartTest) {
|
|
struct mp_priv *pmp_priv = &Adapter->mppriv;
|
|
if (pmp_priv->tx.stop == 0) {
|
|
pmp_priv->tx.stop = 1;
|
|
RTW_INFO("%s: pkt tx is running...\n", __func__);
|
|
rtw_msleep_os(5);
|
|
}
|
|
pmp_priv->tx.stop = 0;
|
|
pmp_priv->tx.count = 1;
|
|
SetPacketTx(Adapter);
|
|
}
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
|
|
NDIS_STATUS oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u32 bStartTest;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
bStartTest = *((u32 *)poid_par_priv->information_buf);
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
SetCarrierSuppressionTx(Adapter, (u8)bStartTest);
|
|
if (bStartTest) {
|
|
struct mp_priv *pmp_priv = &Adapter->mppriv;
|
|
if (pmp_priv->tx.stop == 0) {
|
|
pmp_priv->tx.stop = 1;
|
|
RTW_INFO("%s: pkt tx is running...\n", __func__);
|
|
rtw_msleep_os(5);
|
|
}
|
|
pmp_priv->tx.stop = 0;
|
|
pmp_priv->tx.count = 1;
|
|
SetPacketTx(Adapter);
|
|
}
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
|
|
NDIS_STATUS oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u32 bStartTest;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
bStartTest = *((u32 *)poid_par_priv->information_buf);
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
SetSingleToneTx(Adapter, (u8)bStartTest);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
|
|
NDIS_STATUS oid_rt_pro_set_modulation_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
NDIS_STATUS oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
rtw_hal_set_hwreg(Adapter, HW_VAR_TRIGGER_GPIO_0, 0);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
/* **************** oid_rtl_seg_81_80_00 section end ****************
|
|
* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro8711_join_bss_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
PNDIS_802_11_SSID pssid;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
*poid_par_priv->bytes_needed = (u32)sizeof(NDIS_802_11_SSID);
|
|
*poid_par_priv->bytes_rw = 0;
|
|
if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed)
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
pssid = (PNDIS_802_11_SSID)poid_par_priv->information_buf;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
if (mp_start_joinbss(Adapter, pssid) == _FAIL)
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
*poid_par_priv->bytes_rw = sizeof(NDIS_802_11_SSID);
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_read_register_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
pRW_Reg RegRWStruct;
|
|
u32 offset, width;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
RegRWStruct = (pRW_Reg)poid_par_priv->information_buf;
|
|
offset = RegRWStruct->offset;
|
|
width = RegRWStruct->width;
|
|
|
|
if (offset > 0xFFF)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
switch (width) {
|
|
case 1:
|
|
RegRWStruct->value = rtw_read8(Adapter, offset);
|
|
break;
|
|
case 2:
|
|
RegRWStruct->value = rtw_read16(Adapter, offset);
|
|
break;
|
|
default:
|
|
width = 4;
|
|
RegRWStruct->value = rtw_read32(Adapter, offset);
|
|
break;
|
|
}
|
|
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
*poid_par_priv->bytes_rw = width;
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_write_register_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
pRW_Reg RegRWStruct;
|
|
u32 offset, width, value;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
RegRWStruct = (pRW_Reg)poid_par_priv->information_buf;
|
|
offset = RegRWStruct->offset;
|
|
width = RegRWStruct->width;
|
|
value = RegRWStruct->value;
|
|
|
|
if (offset > 0xFFF)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
switch (RegRWStruct->width) {
|
|
case 1:
|
|
if (value > 0xFF) {
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
break;
|
|
}
|
|
rtw_write8(padapter, offset, (u8)value);
|
|
break;
|
|
case 2:
|
|
if (value > 0xFFFF) {
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
break;
|
|
}
|
|
rtw_write16(padapter, offset, (u16)value);
|
|
break;
|
|
case 4:
|
|
rtw_write32(padapter, offset, value);
|
|
break;
|
|
default:
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
break;
|
|
}
|
|
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_burst_read_register_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
pBurst_RW_Reg pBstRwReg;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
rtw_read_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_burst_write_register_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
pBurst_RW_Reg pBstRwReg;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
rtw_write_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_write_txcmd_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
|
|
TX_CMD_Desc *TxCmd_Info;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
|
|
TxCmd_Info = (TX_CMD_Desc *)poid_par_priv->information_buf;
|
|
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
rtw_write32(Adapter, TxCmd_Info->offset + 0, (unsigned int)TxCmd_Info->TxCMD.value[0]);
|
|
rtw_write32(Adapter, TxCmd_Info->offset + 4, (unsigned int)TxCmd_Info->TxCMD.value[1]);
|
|
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
pEEPROM_RWParam pEEPROM;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
pEEPROM->value = eeprom_read16(padapter, (u16)(pEEPROM->offset >> 1));
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_write16_eeprom_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
pEEPROM_RWParam pEEPROM;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
eeprom_write16(padapter, (u16)(pEEPROM->offset >> 1), pEEPROM->value);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
struct mp_wiparam *pwi_param;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(struct mp_wiparam))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
if (Adapter->mppriv.workparam.bcompleted == _FALSE)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
pwi_param = (struct mp_wiparam *)poid_par_priv->information_buf;
|
|
|
|
_rtw_memcpy(pwi_param, &Adapter->mppriv.workparam, sizeof(struct mp_wiparam));
|
|
Adapter->mppriv.act_in_progress = _FALSE;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(uint) * 2) {
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
}
|
|
|
|
if (*(uint *)poid_par_priv->information_buf == 1) /* init==1 */
|
|
Adapter->mppriv.rx_pktloss = 0;
|
|
|
|
*((uint *)poid_par_priv->information_buf + 1) = Adapter->mppriv.rx_pktloss;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_rd_attrib_mem_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue;
|
|
struct intf_hdl *pintfhdl = &pio_queue->intf;
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
#ifdef CONFIG_SDIO_HCI
|
|
void (*_attrib_read)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem);
|
|
#endif
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
#ifdef CONFIG_SDIO_HCI
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
{
|
|
u32 *plmem = (u32 *)poid_par_priv->information_buf + 2;
|
|
_attrib_read = pintfhdl->io_ops._attrib_read;
|
|
_attrib_read(pintfhdl, *((u32 *)poid_par_priv->information_buf),
|
|
*((u32 *)poid_par_priv->information_buf + 1), (u8 *)plmem);
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
}
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
#endif
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_wr_attrib_mem_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue;
|
|
struct intf_hdl *pintfhdl = &pio_queue->intf;
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
#ifdef CONFIG_SDIO_HCI
|
|
void (*_attrib_write)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem);
|
|
#endif
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
#ifdef CONFIG_SDIO_HCI
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
{
|
|
u32 *plmem = (u32 *)poid_par_priv->information_buf + 2;
|
|
_attrib_write = pintfhdl->io_ops._attrib_write;
|
|
_attrib_write(pintfhdl, *(u32 *)poid_par_priv->information_buf,
|
|
*((u32 *)poid_par_priv->information_buf + 1), (u8 *)plmem);
|
|
}
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
#endif
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
if (rtw_setrfintfs_cmd(Adapter, *(unsigned char *)poid_par_priv->information_buf) == _FAIL)
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_poll_rx_status_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_rtw_memcpy(poid_par_priv->information_buf, (unsigned char *)&Adapter->mppriv.rxstat, sizeof(struct recv_stat));
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
PCFG_DBG_MSG_STRUCT pdbg_msg;
|
|
|
|
|
|
|
|
#if 0/*#ifdef CONFIG_DEBUG_RTL871X*/
|
|
|
|
pdbg_msg = (PCFG_DBG_MSG_STRUCT)(poid_par_priv->information_buf);
|
|
|
|
if (poid_par_priv->type_of_oid == SET_OID) {
|
|
|
|
GlobalDebugLevel = pdbg_msg->DebugLevel;
|
|
GlobalDebugComponents = (pdbg_msg->DebugComponent_H32 << 32) | pdbg_msg->DebugComponent_L32;
|
|
} else {
|
|
pdbg_msg->DebugLevel = GlobalDebugLevel;
|
|
pdbg_msg->DebugComponent_H32 = (u32)(GlobalDebugComponents >> 32);
|
|
pdbg_msg->DebugComponent_L32 = (u32)GlobalDebugComponents;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
if (rtw_setdatarate_cmd(Adapter, poid_par_priv->information_buf) != _SUCCESS)
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ----------------------------------------------------------------------------- */
|
|
NDIS_STATUS oid_rt_get_thermal_meter_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
u8 thermal = 0;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(u32))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
GetThermalMeter(Adapter, &thermal);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
*(u32 *)poid_par_priv->information_buf = (u32)thermal;
|
|
*poid_par_priv->bytes_rw = sizeof(u32);
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ----------------------------------------------------------------------------- */
|
|
NDIS_STATUS oid_rt_pro_read_tssi_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (Adapter->mppriv.act_in_progress == _TRUE)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(u8))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
/* init workparam */
|
|
Adapter->mppriv.act_in_progress = _TRUE;
|
|
Adapter->mppriv.workparam.bcompleted = _FALSE;
|
|
Adapter->mppriv.workparam.act_type = MPT_READ_TSSI;
|
|
Adapter->mppriv.workparam.io_offset = 0;
|
|
Adapter->mppriv.workparam.io_value = 0xFFFFFFFF;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
if (!rtw_gettssi_cmd(Adapter, 0, (u8 *)&Adapter->mppriv.workparam.io_value))
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
/* if (poid_par_priv->type_of_oid != SET_OID)
|
|
* return NDIS_STATUS_NOT_ACCEPTED; */
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(u8))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
if (poid_par_priv->type_of_oid == SET_OID) {
|
|
u8 enable;
|
|
|
|
enable = *(u8 *)poid_par_priv->information_buf;
|
|
|
|
SetPowerTracking(Adapter, enable);
|
|
} else
|
|
GetPowerTracking(Adapter, (u8 *)poid_par_priv->information_buf);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ----------------------------------------------------------------------------- */
|
|
NDIS_STATUS oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u32 ratevalue;
|
|
u8 datarates[NumRates];
|
|
int i;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
#if 0
|
|
ratevalue = *((u32 *)poid_par_priv->information_buf);
|
|
|
|
for (i = 0; i < NumRates; i++) {
|
|
if (ratevalue == mpdatarate[i])
|
|
datarates[i] = mpdatarate[i];
|
|
else
|
|
datarates[i] = 0xff;
|
|
}
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
if (rtw_setbasicrate_cmd(padapter, datarates) != _SUCCESS)
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
#endif
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < 8)
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
*poid_par_priv->bytes_rw = 8;
|
|
_rtw_memcpy(poid_par_priv->information_buf, &(adapter_to_pwrctl(Adapter)->pwr_mode), 8);
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
uint pwr_mode, smart_ps;
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
*poid_par_priv->bytes_rw = 0;
|
|
*poid_par_priv->bytes_needed = 8;
|
|
|
|
if (poid_par_priv->information_buf_len < 8)
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
pwr_mode = *(uint *)(poid_par_priv->information_buf);
|
|
smart_ps = *(uint *)((int)poid_par_priv->information_buf + 4);
|
|
|
|
*poid_par_priv->bytes_rw = 8;
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
struct setratable_parm *prate_table;
|
|
u8 res;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
*poid_par_priv->bytes_needed = sizeof(struct setratable_parm);
|
|
if (poid_par_priv->information_buf_len < sizeof(struct setratable_parm))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
prate_table = (struct setratable_parm *)poid_par_priv->information_buf;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
res = rtw_setrttbl_cmd(Adapter, prate_table);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
if (res == _FAIL)
|
|
status = NDIS_STATUS_FAILURE;
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
#if 0
|
|
struct mp_wi_cntx *pmp_wi_cntx = &(Adapter->mppriv.wi_cntx);
|
|
u8 res = _SUCCESS;
|
|
DEBUG_INFO(("===> Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n"));
|
|
|
|
if (pmp_wi_cntx->bmp_wi_progress == _TRUE) {
|
|
DEBUG_ERR(("\n mp workitem is progressing, not allow to set another workitem right now!!!\n"));
|
|
Status = NDIS_STATUS_NOT_ACCEPTED;
|
|
break;
|
|
} else {
|
|
pmp_wi_cntx->bmp_wi_progress = _TRUE;
|
|
pmp_wi_cntx->param.bcompleted = _FALSE;
|
|
pmp_wi_cntx->param.act_type = MPT_GET_RATE_TABLE;
|
|
pmp_wi_cntx->param.io_offset = 0x0;
|
|
pmp_wi_cntx->param.bytes_cnt = sizeof(struct getratable_rsp);
|
|
pmp_wi_cntx->param.io_value = 0xffffffff;
|
|
|
|
res = rtw_getrttbl_cmd(Adapter, (struct getratable_rsp *)pmp_wi_cntx->param.data);
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
if (res != _SUCCESS)
|
|
Status = NDIS_STATUS_NOT_ACCEPTED;
|
|
}
|
|
DEBUG_INFO(("\n <=== Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n"));
|
|
#endif
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
|
|
/* **************** oid_rtl_seg_87_12_00 section start **************** */
|
|
NDIS_STATUS oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
struct security_priv *psecuritypriv = &Adapter->securitypriv;
|
|
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
ENCRY_CTRL_STATE encry_mode;
|
|
|
|
|
|
*poid_par_priv->bytes_needed = sizeof(u8);
|
|
if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed)
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
if (poid_par_priv->type_of_oid == SET_OID) {
|
|
encry_mode = *((u8 *)poid_par_priv->information_buf);
|
|
switch (encry_mode) {
|
|
case HW_CONTROL:
|
|
#if 0
|
|
Adapter->registrypriv.software_decrypt = _FALSE;
|
|
Adapter->registrypriv.software_encrypt = _FALSE;
|
|
#else
|
|
psecuritypriv->sw_decrypt = _FALSE;
|
|
psecuritypriv->sw_encrypt = _FALSE;
|
|
#endif
|
|
break;
|
|
case SW_CONTROL:
|
|
#if 0
|
|
Adapter->registrypriv.software_decrypt = _TRUE;
|
|
Adapter->registrypriv.software_encrypt = _TRUE;
|
|
#else
|
|
psecuritypriv->sw_decrypt = _TRUE;
|
|
psecuritypriv->sw_encrypt = _TRUE;
|
|
#endif
|
|
break;
|
|
case HW_ENCRY_SW_DECRY:
|
|
#if 0
|
|
Adapter->registrypriv.software_decrypt = _TRUE;
|
|
Adapter->registrypriv.software_encrypt = _FALSE;
|
|
#else
|
|
psecuritypriv->sw_decrypt = _TRUE;
|
|
psecuritypriv->sw_encrypt = _FALSE;
|
|
#endif
|
|
break;
|
|
case SW_ENCRY_HW_DECRY:
|
|
#if 0
|
|
Adapter->registrypriv.software_decrypt = _FALSE;
|
|
Adapter->registrypriv.software_encrypt = _TRUE;
|
|
#else
|
|
psecuritypriv->sw_decrypt = _FALSE;
|
|
psecuritypriv->sw_encrypt = _TRUE;
|
|
#endif
|
|
break;
|
|
}
|
|
|
|
} else {
|
|
#if 0
|
|
if (Adapter->registrypriv.software_encrypt == _FALSE) {
|
|
if (Adapter->registrypriv.software_decrypt == _FALSE)
|
|
encry_mode = HW_CONTROL;
|
|
else
|
|
encry_mode = HW_ENCRY_SW_DECRY;
|
|
} else {
|
|
if (Adapter->registrypriv.software_decrypt == _FALSE)
|
|
encry_mode = SW_ENCRY_HW_DECRY;
|
|
else
|
|
encry_mode = SW_CONTROL;
|
|
}
|
|
#else
|
|
|
|
if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _FALSE))
|
|
encry_mode = HW_CONTROL;
|
|
else if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _TRUE))
|
|
encry_mode = HW_ENCRY_SW_DECRY;
|
|
else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _FALSE))
|
|
encry_mode = SW_ENCRY_HW_DECRY;
|
|
else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _TRUE))
|
|
encry_mode = SW_CONTROL;
|
|
|
|
#endif
|
|
|
|
*(u8 *)poid_par_priv->information_buf = encry_mode;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
}
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_add_sta_info_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
struct sta_info *psta = NULL;
|
|
UCHAR *macaddr;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
*poid_par_priv->bytes_needed = ETH_ALEN;
|
|
if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed)
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
macaddr = (UCHAR *) poid_par_priv->information_buf ;
|
|
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
psta = rtw_get_stainfo(&Adapter->stapriv, macaddr);
|
|
|
|
if (psta == NULL) { /* the sta have been in sta_info_queue => do nothing */
|
|
psta = rtw_alloc_stainfo(&Adapter->stapriv, macaddr);
|
|
|
|
if (psta == NULL) {
|
|
status = NDIS_STATUS_FAILURE;
|
|
}
|
|
}
|
|
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
struct sta_info *psta = NULL;
|
|
UCHAR *macaddr;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
*poid_par_priv->bytes_needed = ETH_ALEN;
|
|
if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed)
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
macaddr = (UCHAR *) poid_par_priv->information_buf ;
|
|
|
|
psta = rtw_get_stainfo(&Adapter->stapriv, macaddr);
|
|
if (psta != NULL) {
|
|
/* _enter_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); */
|
|
rtw_free_stainfo(Adapter, psta);
|
|
/* _exit_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); */
|
|
}
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
#if 0
|
|
static u32 mp_query_drv_var(_adapter *padapter, u8 offset, u32 var)
|
|
{
|
|
#ifdef CONFIG_SDIO_HCI
|
|
|
|
if (offset == 1) {
|
|
u16 tmp_blk_num;
|
|
tmp_blk_num = rtw_read16(padapter, SDIO_RX0_RDYBLK_NUM);
|
|
if (adapter_to_dvobj(padapter)->rxblknum != tmp_blk_num) {
|
|
/* sd_recv_rxfifo(padapter); */
|
|
}
|
|
}
|
|
|
|
#if 0
|
|
if (offset <= 100) { /* For setting data rate and query data rate */
|
|
if (offset == 100) { /* For query data rate */
|
|
var = padapter->registrypriv.tx_rate;
|
|
|
|
} else if (offset < 0x1d) { /* For setting data rate */
|
|
padapter->registrypriv.tx_rate = offset;
|
|
var = padapter->registrypriv.tx_rate;
|
|
padapter->registrypriv.use_rate = _TRUE;
|
|
} else { /* not use the data rate */
|
|
padapter->registrypriv.use_rate = _FALSE;
|
|
}
|
|
} else if (offset <= 110) { /* for setting debug level */
|
|
if (offset == 110) { /* For query data rate */
|
|
padapter->registrypriv.dbg_level = GlobalDebugLevel;
|
|
var = padapter->registrypriv.dbg_level;
|
|
} else if (offset < 110 && offset > 100) {
|
|
padapter->registrypriv.dbg_level = GlobalDebugLevel = offset - 100;
|
|
var = padapter->registrypriv.dbg_level;
|
|
|
|
}
|
|
} else if (offset > 110 && offset < 116) {
|
|
if (115 == offset) {
|
|
} else {
|
|
switch (offset) {
|
|
case 111:
|
|
adapter_to_dvobj(padapter)->tx_block_mode = 1;
|
|
adapter_to_dvobj(padapter)->rx_block_mode = 1;
|
|
break;
|
|
case 112:
|
|
adapter_to_dvobj(padapter)->tx_block_mode = 1;
|
|
adapter_to_dvobj(padapter)->rx_block_mode = 0;
|
|
break;
|
|
case 113:
|
|
adapter_to_dvobj(padapter)->tx_block_mode = 0;
|
|
adapter_to_dvobj(padapter)->rx_block_mode = 1;
|
|
break;
|
|
case 114:
|
|
adapter_to_dvobj(padapter)->tx_block_mode = 0;
|
|
adapter_to_dvobj(padapter)->rx_block_mode = 0;
|
|
break;
|
|
default:
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else if (offset >= 127) {
|
|
u64 prnt_dbg_comp;
|
|
u8 chg_idx;
|
|
u64 tmp_dbg_comp;
|
|
chg_idx = offset - 0x80;
|
|
tmp_dbg_comp = BIT(chg_idx);
|
|
prnt_dbg_comp = padapter->registrypriv.dbg_component = GlobalDebugComponents;
|
|
if (offset == 127) {
|
|
/* prnt_dbg_comp=padapter->registrypriv.dbg_component= GlobalDebugComponents; */
|
|
var = (u32)(padapter->registrypriv.dbg_component);
|
|
prnt_dbg_comp = GlobalDebugComponents;
|
|
prnt_dbg_comp = GlobalDebugComponents = padapter->registrypriv.dbg_component;
|
|
|
|
} else {
|
|
prnt_dbg_comp = GlobalDebugComponents;
|
|
prnt_dbg_comp = GlobalDebugComponents = padapter->registrypriv.dbg_component;
|
|
|
|
if (GlobalDebugComponents & tmp_dbg_comp) {
|
|
/* this bit is already set, now clear it */
|
|
GlobalDebugComponents = GlobalDebugComponents & (~tmp_dbg_comp);
|
|
} else {
|
|
/* this bit is not set, now set it. */
|
|
GlobalDebugComponents = GlobalDebugComponents | tmp_dbg_comp;
|
|
}
|
|
prnt_dbg_comp = GlobalDebugComponents;
|
|
|
|
var = (u32)(GlobalDebugComponents);
|
|
/* GlobalDebugComponents=padapter->registrypriv.dbg_component; */
|
|
|
|
}
|
|
}
|
|
#endif
|
|
#endif
|
|
|
|
return var;
|
|
}
|
|
#endif
|
|
|
|
NDIS_STATUS oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
DR_VARIABLE_STRUCT *pdrv_var;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
*poid_par_priv->bytes_needed = sizeof(DR_VARIABLE_STRUCT);
|
|
if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed)
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
|
|
pdrv_var = (struct _DR_VARIABLE_STRUCT_ *)poid_par_priv->information_buf;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
pdrv_var->variable = mp_query_drv_var(Adapter, pdrv_var->offset, pdrv_var->variable);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(UCHAR)) {
|
|
status = NDIS_STATUS_INVALID_LENGTH;
|
|
*poid_par_priv->bytes_needed = sizeof(UCHAR);
|
|
return status;
|
|
}
|
|
|
|
if (poid_par_priv->type_of_oid == SET_OID) {
|
|
Adapter->mppriv.rx_with_status = *(UCHAR *) poid_par_priv->information_buf;
|
|
|
|
|
|
} else {
|
|
*(UCHAR *) poid_par_priv->information_buf = Adapter->mppriv.rx_with_status;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
/* *(u32 *)&Adapter->eeprompriv.mac_addr[0]=rtw_read32(Adapter, 0x10250050); */
|
|
/* *(u16 *)&Adapter->eeprompriv.mac_addr[4]=rtw_read16(Adapter, 0x10250054); */
|
|
}
|
|
#endif
|
|
|
|
return NDIS_STATUS_SUCCESS;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
PEFUSE_ACCESS_STRUCT pefuse;
|
|
u8 *data;
|
|
u16 addr = 0, cnts = 0, max_available_size = 0;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(EFUSE_ACCESS_STRUCT))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf;
|
|
addr = pefuse->start_addr;
|
|
cnts = pefuse->cnts;
|
|
data = pefuse->data;
|
|
|
|
|
|
EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE);
|
|
|
|
if ((addr + cnts) > max_available_size) {
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
}
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
if (rtw_efuse_access(Adapter, _FALSE, addr, cnts, data) == _FAIL) {
|
|
status = NDIS_STATUS_FAILURE;
|
|
} else
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
PEFUSE_ACCESS_STRUCT pefuse;
|
|
u8 *data;
|
|
u16 addr = 0, cnts = 0, max_available_size = 0;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf;
|
|
addr = pefuse->start_addr;
|
|
cnts = pefuse->cnts;
|
|
data = pefuse->data;
|
|
|
|
|
|
EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE);
|
|
|
|
if ((addr + cnts) > max_available_size) {
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
}
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
if (rtw_efuse_access(Adapter, _TRUE, addr, cnts, data) == _FAIL)
|
|
status = NDIS_STATUS_FAILURE;
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
PPGPKT_STRUCT ppgpkt;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
|
|
*poid_par_priv->bytes_rw = 0;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(PGPKT_STRUCT))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
ppgpkt = (PPGPKT_STRUCT)poid_par_priv->information_buf;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
if (poid_par_priv->type_of_oid == QUERY_OID) {
|
|
|
|
Efuse_PowerSwitch(Adapter, _FALSE, _TRUE);
|
|
if (Efuse_PgPacketRead(Adapter, ppgpkt->offset, ppgpkt->data, _FALSE) == _TRUE)
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
else
|
|
status = NDIS_STATUS_FAILURE;
|
|
Efuse_PowerSwitch(Adapter, _FALSE, _FALSE);
|
|
} else {
|
|
|
|
Efuse_PowerSwitch(Adapter, _TRUE, _TRUE);
|
|
if (Efuse_PgPacketWrite(Adapter, ppgpkt->offset, ppgpkt->word_en, ppgpkt->data, _FALSE) == _TRUE)
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
else
|
|
status = NDIS_STATUS_FAILURE;
|
|
Efuse_PowerSwitch(Adapter, _TRUE, _FALSE);
|
|
}
|
|
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u16 size;
|
|
u8 ret;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(u32))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
ret = efuse_GetCurrentSize(Adapter, &size);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
if (ret == _SUCCESS) {
|
|
*(u32 *)poid_par_priv->information_buf = size;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
} else
|
|
status = NDIS_STATUS_FAILURE;
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_get_efuse_max_size_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(u32))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
*(u32 *)poid_par_priv->information_buf = efuse_GetMaxSize(Adapter);
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
NDIS_STATUS status;
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid == QUERY_OID)
|
|
status = oid_rt_pro_read_efuse_hdl(poid_par_priv);
|
|
else
|
|
status = oid_rt_pro_write_efuse_hdl(poid_par_priv);
|
|
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u8 *data;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
u16 mapLen = 0;
|
|
|
|
|
|
|
|
EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE);
|
|
|
|
*poid_par_priv->bytes_rw = 0;
|
|
|
|
if (poid_par_priv->information_buf_len < mapLen)
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
data = (u8 *)poid_par_priv->information_buf;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
if (poid_par_priv->type_of_oid == QUERY_OID) {
|
|
|
|
if (rtw_efuse_map_read(Adapter, 0, mapLen, data) == _SUCCESS)
|
|
*poid_par_priv->bytes_rw = mapLen;
|
|
else {
|
|
status = NDIS_STATUS_FAILURE;
|
|
}
|
|
} else {
|
|
/* SET_OID */
|
|
|
|
if (rtw_efuse_map_write(Adapter, 0, mapLen, data) == _SUCCESS)
|
|
*poid_par_priv->bytes_rw = mapLen;
|
|
else {
|
|
status = NDIS_STATUS_FAILURE;
|
|
}
|
|
}
|
|
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
|
|
return status;
|
|
}
|
|
|
|
NDIS_STATUS oid_rt_set_crystal_cap_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
|
|
u32 crystal_cap = 0;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(u32))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
crystal_cap = *((u32 *)poid_par_priv->information_buf); /* 4 */
|
|
if (crystal_cap > 0xf)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
Adapter->mppriv.curr_crystalcap = crystal_cap;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
SetCrystalCap(Adapter);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
#endif
|
|
return status;
|
|
}
|
|
|
|
NDIS_STATUS oid_rt_set_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u8 rx_pkt_type;
|
|
/* u32 rcr_val32; */
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
/* PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); */
|
|
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(u8))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
rx_pkt_type = *((u8 *)poid_par_priv->information_buf); /* 4 */
|
|
|
|
#if 0
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
#if 0
|
|
rcr_val8 = rtw_read8(Adapter, 0x10250048);/* RCR */
|
|
rcr_val8 &= ~(RCR_AB | RCR_AM | RCR_APM | RCR_AAP);
|
|
|
|
if (rx_pkt_type == RX_PKT_BROADCAST)
|
|
rcr_val8 |= (RCR_AB | RCR_ACRC32);
|
|
else if (rx_pkt_type == RX_PKT_DEST_ADDR)
|
|
rcr_val8 |= (RCR_AAP | RCR_AM | RCR_ACRC32);
|
|
else if (rx_pkt_type == RX_PKT_PHY_MATCH)
|
|
rcr_val8 |= (RCR_APM | RCR_ACRC32);
|
|
else
|
|
rcr_val8 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32);
|
|
rtw_write8(padapter, 0x10250048, rcr_val8);
|
|
#else
|
|
rcr_val32 = rtw_read32(padapter, RCR);/* RCR = 0x10250048 */
|
|
rcr_val32 &= ~(RCR_CBSSID | RCR_AB | RCR_AM | RCR_APM | RCR_AAP);
|
|
#if 0
|
|
if (rx_pkt_type == RX_PKT_BROADCAST)
|
|
rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32);
|
|
else if (rx_pkt_type == RX_PKT_DEST_ADDR) {
|
|
/* rcr_val32 |= (RCR_CBSSID|RCR_AAP|RCR_AM|RCR_ACRC32); */
|
|
rcr_val32 |= (RCR_CBSSID | RCR_APM | RCR_ACRC32);
|
|
} else if (rx_pkt_type == RX_PKT_PHY_MATCH) {
|
|
rcr_val32 |= (RCR_APM | RCR_ACRC32);
|
|
/* rcr_val32 |= (RCR_AAP|RCR_ACRC32); */
|
|
} else
|
|
rcr_val32 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32);
|
|
#else
|
|
switch (rx_pkt_type) {
|
|
case RX_PKT_BROADCAST:
|
|
rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32);
|
|
break;
|
|
case RX_PKT_DEST_ADDR:
|
|
rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32);
|
|
break;
|
|
case RX_PKT_PHY_MATCH:
|
|
rcr_val32 |= (RCR_APM | RCR_ACRC32);
|
|
break;
|
|
default:
|
|
rcr_val32 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32);
|
|
break;
|
|
}
|
|
|
|
if (rx_pkt_type == RX_PKT_DEST_ADDR)
|
|
padapter->mppriv.check_mp_pkt = 1;
|
|
else
|
|
padapter->mppriv.check_mp_pkt = 0;
|
|
#endif
|
|
rtw_write32(padapter, RCR, rcr_val32);
|
|
|
|
#endif
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
#endif
|
|
|
|
return status;
|
|
}
|
|
|
|
NDIS_STATUS oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
u32 txagc;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(u32))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
txagc = *(u32 *)poid_par_priv->information_buf;
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
SetTxAGCOffset(Adapter, txagc);
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
|
|
NDIS_STATUS oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
|
|
struct mlme_priv *pmlmepriv = &Adapter->mlmepriv;
|
|
struct mp_priv *pmppriv = &Adapter->mppriv;
|
|
u32 type;
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID)
|
|
return NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
if (poid_par_priv->information_buf_len < sizeof(u32))
|
|
return NDIS_STATUS_INVALID_LENGTH;
|
|
|
|
type = *(u32 *)poid_par_priv->information_buf;
|
|
|
|
if (_LOOPBOOK_MODE_ == type) {
|
|
pmppriv->mode = type;
|
|
set_fwstate(pmlmepriv, WIFI_MP_LPBK_STATE); /* append txdesc */
|
|
} else if (_2MAC_MODE_ == type) {
|
|
pmppriv->mode = type;
|
|
_clr_fwstate_(pmlmepriv, WIFI_MP_LPBK_STATE);
|
|
} else
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
|
|
unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
PMP_XMIT_PARM pparm;
|
|
PADAPTER padapter;
|
|
struct mp_priv *pmp_priv;
|
|
struct pkt_attrib *pattrib;
|
|
|
|
|
|
pparm = (PMP_XMIT_PARM)poid_par_priv->information_buf;
|
|
padapter = (PADAPTER)poid_par_priv->adapter_context;
|
|
pmp_priv = &padapter->mppriv;
|
|
|
|
if (poid_par_priv->type_of_oid == QUERY_OID) {
|
|
pparm->enable = !pmp_priv->tx.stop;
|
|
pparm->count = pmp_priv->tx.sended;
|
|
} else {
|
|
if (pparm->enable == 0)
|
|
pmp_priv->tx.stop = 1;
|
|
else if (pmp_priv->tx.stop == 1) {
|
|
pmp_priv->tx.stop = 0;
|
|
pmp_priv->tx.count = pparm->count;
|
|
pmp_priv->tx.payload = pparm->payload_type;
|
|
pattrib = &pmp_priv->tx.attrib;
|
|
pattrib->pktlen = pparm->length;
|
|
_rtw_memcpy(pattrib->dst, pparm->da, ETH_ALEN);
|
|
SetPacketTx(padapter);
|
|
} else
|
|
return NDIS_STATUS_FAILURE;
|
|
}
|
|
|
|
return NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
#if 0
|
|
unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
unsigned char *pframe, *pmp_pkt;
|
|
struct ethhdr *pethhdr;
|
|
struct pkt_attrib *pattrib;
|
|
struct rtw_ieee80211_hdr *pwlanhdr;
|
|
unsigned short *fctrl;
|
|
int llc_sz, payload_len;
|
|
struct mp_xmit_frame *pxframe = NULL;
|
|
struct mp_xmit_packet *pmp_xmitpkt = (struct mp_xmit_packet *)param;
|
|
u8 addr3[] = {0x02, 0xE0, 0x4C, 0x87, 0x66, 0x55};
|
|
|
|
/* RTW_INFO("+mp_ioctl_xmit_packet_hdl\n"); */
|
|
|
|
pxframe = alloc_mp_xmitframe(&padapter->mppriv);
|
|
if (pxframe == NULL) {
|
|
DEBUG_ERR(("Can't alloc pmpframe %d:%s\n", __LINE__, __FILE__));
|
|
return -1;
|
|
}
|
|
|
|
/* mp_xmit_pkt */
|
|
payload_len = pmp_xmitpkt->len - 14;
|
|
pmp_pkt = (unsigned char *)pmp_xmitpkt->mem;
|
|
pethhdr = (struct ethhdr *)pmp_pkt;
|
|
|
|
/* RTW_INFO("payload_len=%d, pkt_mem=0x%x\n", pmp_xmitpkt->len, (void*)pmp_xmitpkt->mem); */
|
|
|
|
/* RTW_INFO("pxframe=0x%x\n", (void*)pxframe); */
|
|
/* RTW_INFO("pxframe->mem=0x%x\n", (void*)pxframe->mem); */
|
|
|
|
/* update attribute */
|
|
pattrib = &pxframe->attrib;
|
|
memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib));
|
|
pattrib->pktlen = pmp_xmitpkt->len;
|
|
pattrib->ether_type = ntohs(pethhdr->h_proto);
|
|
pattrib->hdrlen = 24;
|
|
pattrib->nr_frags = 1;
|
|
pattrib->priority = 0;
|
|
#ifndef CONFIG_MP_LINUX
|
|
if (IS_MCAST(pethhdr->h_dest))
|
|
pattrib->mac_id = 4;
|
|
else
|
|
pattrib->mac_id = 5;
|
|
#else
|
|
pattrib->mac_id = 5;
|
|
#endif
|
|
|
|
/* */
|
|
memset(pxframe->mem, 0 , WLANHDR_OFFSET);
|
|
pframe = (u8 *)(pxframe->mem) + WLANHDR_OFFSET;
|
|
|
|
pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
|
|
|
|
fctrl = &(pwlanhdr->frame_ctl);
|
|
*(fctrl) = 0;
|
|
SetFrameSubType(pframe, WIFI_DATA);
|
|
|
|
_rtw_memcpy(pwlanhdr->addr1, pethhdr->h_dest, ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr2, pethhdr->h_source, ETH_ALEN);
|
|
|
|
_rtw_memcpy(pwlanhdr->addr3, addr3, ETH_ALEN);
|
|
|
|
pwlanhdr->seq_ctl = 0;
|
|
pframe += pattrib->hdrlen;
|
|
|
|
llc_sz = rtw_put_snap(pframe, pattrib->ether_type);
|
|
pframe += llc_sz;
|
|
|
|
_rtw_memcpy(pframe, (void *)(pmp_pkt + 14), payload_len);
|
|
|
|
pattrib->last_txcmdsz = pattrib->hdrlen + llc_sz + payload_len;
|
|
|
|
DEBUG_INFO(("issuing mp_xmit_frame, tx_len=%d, ether_type=0x%x\n", pattrib->last_txcmdsz, pattrib->ether_type));
|
|
xmit_mp_frame(padapter, pxframe);
|
|
|
|
return _SUCCESS;
|
|
}
|
|
#endif
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_set_power_down_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#ifdef PLATFORM_OS_XP
|
|
_irqL oldirql;
|
|
#endif
|
|
u8 bpwrup;
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
#ifdef PLATFORM_LINUX
|
|
#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)
|
|
PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
#endif
|
|
#endif
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != SET_OID) {
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
return status;
|
|
}
|
|
|
|
|
|
_irqlevel_changed_(&oldirql, LOWER);
|
|
|
|
bpwrup = *(u8 *)poid_par_priv->information_buf;
|
|
/* CALL the power_down function */
|
|
#ifdef PLATFORM_LINUX
|
|
#if defined(CONFIG_RTL8712) /* Linux MP insmod unknown symbol */
|
|
dev_power_down(padapter, bpwrup);
|
|
#endif
|
|
#endif
|
|
_irqlevel_changed_(&oldirql, RAISE);
|
|
|
|
/* DEBUG_ERR(("\n <=== Query OID_RT_PRO_READ_REGISTER. */
|
|
/* Add:0x%08x Width:%d Value:0x%08x\n",RegRWStruct->offset,RegRWStruct->width,RegRWStruct->value)); */
|
|
|
|
|
|
return status;
|
|
}
|
|
/* ------------------------------------------------------------------------------ */
|
|
NDIS_STATUS oid_rt_get_power_mode_hdl(struct oid_par_priv *poid_par_priv)
|
|
{
|
|
#if 0
|
|
NDIS_STATUS status = NDIS_STATUS_SUCCESS;
|
|
PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context);
|
|
/* #ifdef PLATFORM_OS_XP */
|
|
/* _irqL oldirql;
|
|
* #endif */
|
|
|
|
|
|
if (poid_par_priv->type_of_oid != QUERY_OID) {
|
|
status = NDIS_STATUS_NOT_ACCEPTED;
|
|
return status;
|
|
}
|
|
if (poid_par_priv->information_buf_len < sizeof(u32)) {
|
|
status = NDIS_STATUS_INVALID_LENGTH;
|
|
return status;
|
|
}
|
|
|
|
|
|
/* _irqlevel_changed_(&oldirql, LOWER); */
|
|
*(int *)poid_par_priv->information_buf = Adapter->registrypriv.low_power ? POWER_LOW : POWER_NORMAL;
|
|
*poid_par_priv->bytes_rw = poid_par_priv->information_buf_len;
|
|
/* _irqlevel_changed_(&oldirql, RAISE); */
|
|
|
|
|
|
return status;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|