yikestone/MT7601u
1
0
Fork 0
mirror of https://github.com/YikeStone/MT7601u.git synced 2025-08-02 19:04:09 +05:30
Code Issues Projects Releases Wiki Activity
MT7601u/src/common/cmm_dfs.c
Murat Demirtas 612db32659 FIXED
2016-10-30 14:40:00 +00:00

3137 lines
87 KiB
C
Raw Blame History

/*
***************************************************************************
* Ralink Tech Inc.
* 4F, No. 2 Technology 5th Rd.
* Science-based Industrial Park
* Hsin-chu, Taiwan, R.O.C.
*
* (c) Copyright 2002, Ralink Technology, Inc.
*
* All rights reserved. Ralink's source code is an unpublished work and the
* use of a copyright notice does not imply otherwise. This source code
* contains confidential trade secret material of Ralink Tech. Any attemp
* or participation in deciphering, decoding, reverse engineering or in any
* way altering the source code is stricitly prohibited, unless the prior
* written consent of Ralink Technology, Inc. is obtained.
***************************************************************************
Module Name:
ap_dfs.c
Abstract:
Support DFS function.
Revision History:
Who When What
-------- ---------- ----------------------------------------------
*/
#include "rt_config.h"
#ifdef DFS_SUPPORT
#ifdef CONFIG_AP_SUPPORT
#ifdef DFS_DEBUG
NewDFSDebugResult TestResult[1000];
#endif
NewDFSValidRadar NewDFSValidTable[] =
{
/* FCC-1 && (Japan W53 Radar 1 / W56 Radar 2)*/
{
(NEW_DFS_FCC | NEW_DFS_JAP | NEW_DFS_JAP_W53),
7,
10, 1000,
0,
4,
0, 0,
28570 - 70,
150
},
/* FCC-2*/
{
(NEW_DFS_FCC | NEW_DFS_JAP),
7,
13, 1000,
0,
1,
3000, 4600 - 20,
0,
25
},
/* FCC-3 & FCC-4*/
{
(NEW_DFS_FCC | NEW_DFS_JAP),
7,
/*120, 200, FCC-3 */
/*220, 400, FCC-4*/
100, 1500,
0,
1,
4000, 10000 - 40,
0,
60
},
/* FCC-6*/
{
(NEW_DFS_FCC | NEW_DFS_JAP),
7,
12, 1000,
0,
1,
0, 0,
6660-10,
35
},
/* Japan W53 Radar 2*/
{
NEW_DFS_JAP_W53,
7,
40, 1000,
0,
1,
0, 0,
76923 - 30,
180
},
/* Japan W56 Radar 1*/
{
NEW_DFS_JAP,
7,
5, 500,
0,
2,
0, 0,
27777 - 30,
70
},
/* Japan W56 Radar 3*/
{
NEW_DFS_JAP,
7,
30, 1000,
0,
1,
0, 0,
80000 - 50,
200
},
/* CE Staggered radar*/
{
/* EN-1*/
/* width 0.8 - 5 us*/
/* PRF 200 - 1000 Hz*/
/* PRI 5000 - 1000 us (T: 20000 - 100000)*/
/* */
NEW_DFS_EU,
0xf,
10, 1000,
0,
1,
20000-15, 100000-70,
0,
120
},
/* EN-2*/
/* width 0.8 - 15 us*/
/* PRF 200 - 1600 Hz*/
/* PRI 5000 - 625 us (T: 12500 - 100000)*/
{
NEW_DFS_EU,
0xf,
10, 2000,
0,
1,
12500 - 10, 100000 - 70,
0,
120
},
/* EN-3*/
/* width 0.8 - 15 us*/
/* PRF 2300 - 4000 Hz*/
/* PRI 434 - 250 us (T: 5000 - 8695)*/
{
NEW_DFS_EU,
0xf,
21, 2000,
0,
1,
5000 - 4, 8695 - 7,
0,
50
},
/* EN-4*/
/* width 20 - 30 us*/
/* PRF 2000 - 4000 Hz*/
/* PRI 500 - 250 us (T: 5000 - 10000)*/
/* Note : with Chirp Modulation +- 2,5Mhz*/
{
NEW_DFS_EU,
0xf,
380, 3000,
0,
4,
5000 - 4, 10000 - 8,
0,
60
},
/* EN-5*/
/* width 0.8 - 2 us*/
/* PRF 300 - 400 Hz*/
/* PRI 3333 - 2500 us (T: 50000 - 66666)*/
/* Staggered PRF, 20 - 50 pps*/
{
NEW_DFS_EU,
0xf,
10, 800,
0,
1,
50000 - 35, 66666 + 50,
0,
30
},
/* EN-6*/
/* width 0.8 - 2 us*/
/* PRF 400 - 1200 Hz*/
/* PRI 2500 - 833 us (T: 16666 - 50000)*/
/* Staggered PRF, 80 - 400 pps*/
{
NEW_DFS_EU,
0xf,
10, 800,
0,
1,
16666 - 13, 50000 + 35,
0,
30
},
{
NEW_DFS_END,
0,
0, 0,
0,
0,
0, 0,
0,
0,
},
};
static NewDFSTable NewDFSTable1[] =
{
{
/* ch, mode(0~7), M(~511), el, eh(~4095), wl, wh(~4095), err_w, tl, th, err_t, bl, bh*/
NEW_DFS_FCC,
{
{0, 0, 10, 8, 16, 6, 2000, 5, 2900, 29000, 5, 0, 0},
{1, 0, 70, 42, 126, 20, 5000, 5, 2900, 29000, 10, 0, 0},
{2, 0, 100, 42, 160, 20, 5000, 25, 2900, 10100, 20, 0, 0},
{3, 2, 200, 20, 150, 900, 2200, 50, 1000, 999999999, 200, 0, 999999999},
}
},
{
NEW_DFS_EU,
{
{0, 0, 10, 10, 18, 4, 4095, 5, 7800, 101000, 5, 0, 0},
{1, 0, 70, 42, 90, 20, 4095, 3, 4900, 101000, 10, 0, 0},
{2, 0, 100, 42, 160, 20, 4095, 5, 4900, 101000, 20, 0, 0},
{3, 3, 200, 20, 150, 200, 4095, 100, 4900, 11000, 200, 0, 0},
{4, 8, 0, 8, 17, 7, 70, 2, 32500, 200500, 10, 0, 0},
/*{5, 1, 0, 12, 16, 8, 700, 5, 33000, 135000, 100, 0, 0},*/
}
},
{
NEW_DFS_JAP,
{
{0, 0, 10, 8, 16, 4, 2000, 5, 2900, 85000, 5, 0, 0},
{1, 0, 70, 48, 126, 20, 5000, 5, 2900, 85000, 10, 0, 0},
{2, 0, 100, 48, 160, 20, 5000, 25, 2900, 85000, 20, 0, 0},
{3, 2, 200, 20, 150, 900, 2200, 50, 1000, 999999999, 200, 0, 999999999},
}
},
{
NEW_DFS_JAP_W53,
{
{0, 0, 10, 8, 16, 8, 2000, 5, 28000, 85000, 10},
{1, 0, 32, 24, 64, 20, 2000, 5, 28000, 85000, 10},
{2, 0, 100, 42, 160, 20, 2000, 25, 28000, 85000, 10},
/*{3, 2, 200, 20, 150, 300, 2000, 50, 15000, 45000, 200},*/
}
},
};
static void dfs_sw_init(
IN PRTMP_ADAPTER pAd);
static BOOLEAN StagerRadarCheck(
IN PRTMP_ADAPTER pAd,
UINT8 dfs_channel);
static BOOLEAN ChirpRadarCheck(
IN PRTMP_ADAPTER pAd);
static BOOLEAN DfsEventDataFetch(
IN PRTMP_ADAPTER pAd,
IN PUCHAR pData,
OUT PDFS_EVENT pDfsEvent);
static VOID DfsCheckBusyIdle(
IN PRTMP_ADAPTER pAd);
static BOOLEAN DfsChannelCheck(
IN PRTMP_ADAPTER pAd,
IN UINT8 DfsChannel);
static VOID ChannelSelectOnRadarDetection(
IN PRTMP_ADAPTER pAd);
static BOOLEAN DfsEventDrop(
IN PRTMP_ADAPTER pAd,
IN PDFS_EVENT pDfsEvent);
static inline BOOLEAN NewRadarDetectionMcuStart(PRTMP_ADAPTER pAd)
{
/*
8051 firmware don't care parameter Token, Arg0 and Arg1
*/
return AsicSendCommandToMcu(pAd, DFS_ONOFF_MCU_CMD, 0xff, 0x01, 0x01, FALSE);
}
static inline BOOLEAN NewRadarDetectionMcuStop(PRTMP_ADAPTER pAd)
{
/*
8051 firmware don't care parameter Token, Arg0 and Arg1
*/
return AsicSendCommandToMcu(pAd, DFS_ONOFF_MCU_CMD, 0xff, 0x01, 0x00, FALSE);
}
#ifdef RTMP_MAC_USB
static VOID SwCheckDfsEventWithFw(
IN PRTMP_ADAPTER pAd);
#endif /*RTMP_MAC_USB */
/*
========================================================================
Routine Description:
Radar wave detection. The API should be invoke each second.
Arguments:
pAd - Adapter pointer
Return Value:
None
========================================================================
*/
VOID ApRadarDetectPeriodic(
IN PRTMP_ADAPTER pAd)
{
INT i;
pAd->Dot11_H.InServiceMonitorCount++;
for (i=0; i<pAd->ChannelListNum; i++)
{
if (pAd->ChannelList[i].RemainingTimeForUse > 0)
{
pAd->ChannelList[i].RemainingTimeForUse --;
if ((pAd->Mlme.PeriodicRound%5) == 0)
{
DBGPRINT(RT_DEBUG_INFO, ("RadarDetectPeriodic - ch=%d, RemainingTimeForUse=%d\n",
pAd->ChannelList[i].Channel, pAd->ChannelList[i].RemainingTimeForUse));
}
}
}
/*radar detect*/
if ((pAd->CommonCfg.Channel > 14)
&& (pAd->CommonCfg.bIEEE80211H == 1)
&& RadarChannelCheck(pAd, pAd->CommonCfg.Channel))
{
RadarDetectPeriodic(pAd);
}
return;
}
/* 0 = Switch Channel when Radar Hit (Normal mode)
1 = Don't Switch Channel when Radar Hit */
INT Set_RadarDebug_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
pRadarDetect->McuRadarDebug = simple_strtol(arg, 0, 16);
if (pRadarDetect->McuRadarDebug & RADAR_DONT_SWITCH)
printk("Dont Switch Channel\n");
if (pRadarDetect->McuRadarDebug & RADAR_DEBUG_SILENCE)
printk("Silence\n");
if (pRadarDetect->McuRadarDebug & RADAR_DEBUG_EVENT)
{
if (pRadarDetect->bDfsSwDisable == 1)
DBGPRINT(RT_DEBUG_ERROR, ("%s(): Warning!! DfsSwDisable is 1\n", __FUNCTION__));
printk("Show effective event\n");
}
if (pRadarDetect->McuRadarDebug & RADAR_DEBUG_SW_SILENCE)
printk("SW detection Silence\n");
return TRUE;
}
INT Set_ResetRadarHwDetect_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
UCHAR channel = 0;
#ifdef RT65xx
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
/* Reset status */
RTMP_BBP_IO_WRITE32(pAd, DFS_R1, pRadarDetect->EnabledChMask);
#else
/*Set BBP_R140=0x02 and Read BBP_R141 to store at channel */
RTMP_DFS_IO_READ8(pAd, 0x2, &channel);
/* reset the radar channel for new counting */
RTMP_DFS_IO_WRITE8(pAd, 0x2, channel);
#endif
printk("==>reset the radar channel for new counting channel =0x%x\n",channel);
return TRUE;
}
INT Set_DfsLowerLimit_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
pRadarDetect->DfsLowerLimit = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_DfsUpperLimit_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
pRadarDetect->DfsUpperLimit = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_DfsSwDisable_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
pRadarDetect->bDfsSwDisable = simple_strtol(arg, 0, 10);
DBGPRINT(RT_DEBUG_TRACE, ("pRadarDetect->bDfsSwDisable = %u\n", pRadarDetect->bDfsSwDisable));
return TRUE;
}
INT Set_DfsEnvtDropAdjTime_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
pDfsSwParam->EvtDropAdjTime = simple_strtol(arg, 0, 10);
DBGPRINT(RT_DEBUG_TRACE, ("EventDropAdjTime = %u\n", pDfsSwParam->EvtDropAdjTime));
return TRUE;
}
INT Set_RadarStart_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_PROGRAM_PARAM pDfsProgramParam = &pAd->CommonCfg.RadarDetect.DfsProgramParam;
if (simple_strtol(arg, 0, 10) == 0)
{
NewRadarDetectionStart(pAd);
}
else if ((simple_strtol(arg, 0, 10) >= 1) && (simple_strtol(arg, 0, 10) <= pAd->CommonCfg.RadarDetect.EnabledChMask))
{
pDfsProgramParam->ChEnable = simple_strtol(arg, 0, 10);
printk("Ch Enable == 0x%x\n", pDfsProgramParam->ChEnable);
NewRadarDetectionStart(pAd);
}
return TRUE;
}
INT Set_RadarStop_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
NewRadarDetectionStop(pAd);
return TRUE;
}
INT Set_RadarSetTbl1_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PUCHAR p2 = arg;
ULONG idx, value;
PDFS_PROGRAM_PARAM pDfsProgramParam = &pAd->CommonCfg.RadarDetect.DfsProgramParam;
while((*p2 != ':') && (*p2 != '\0'))
{
p2++;
}
if (*p2 == ':')
{
A2Dec(idx, arg);
A2Dec(value, p2+ 1);
if (idx == 0)
{
pDfsProgramParam->DeltaDelay = value;
printk("Delta_Delay = %d\n", pDfsProgramParam->DeltaDelay);
}
else
modify_table1(pAd, idx, value);
NewRadarDetectionStart(pAd);
}
else
printk("please enter iwpriv ra0 set RadarT1=xxx:yyy\n");
return TRUE;
}
INT Set_RadarSetTbl2_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PUCHAR p2 = arg;
ULONG idx, value;
while((*p2 != ':') && (*p2 != '\0'))
{
p2++;
}
if (*p2 == ':')
{
A2Dec(idx, arg);
A2Dec(value, p2+ 1);
modify_table2(pAd, idx, value);
}
else
printk("please enter iwpriv ra0 set RadarT2=xxx:yyy\n");
return TRUE;
}
INT Set_Fcc5Thrd_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
pDfsSwParam->fcc_5_threshold = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_ChBusyThrd_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
int i;
PUCHAR p1 = arg, p2;
ULONG value;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
pRadarDetect->fdf_num = 0;
for (i = 0; i < MAX_FDF_NUMBER; i++)
{
p2 = p1;
while((*p2 != ':') && (*p2 != '\0'))
{
p2++;
}
if (*p2 == ':')
{
if (*p1 == '-')
{
p1++;
A2Dec(value, p1);
value *= -1;
}
else
A2Dec(value, p1);
pRadarDetect->ch_busy_threshold[i] = value;
printk("pRadarDetect->ch_busy_threshold[%d] = %d\n", i, pRadarDetect->ch_busy_threshold[i]);
pRadarDetect->fdf_num++;
p1 = p2 + 1;
}
else
{
pRadarDetect->ch_busy_threshold[i] = simple_strtol(p1, 0, 10);
printk("pRadarDetect->ch_busy_threshold[%d] = %d\n", i, pRadarDetect->ch_busy_threshold[i]);
pRadarDetect->fdf_num++;
break;
}
}
printk("pRadarDetect->fdf_num = %d\n", pRadarDetect->fdf_num);
return TRUE;
}
INT Set_RssiThrd_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
int i;
PUCHAR p1 = arg, p2;
ULONG value;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
pRadarDetect->fdf_num = 0;
for (i = 0; i < MAX_FDF_NUMBER; i++)
{
p2 = p1;
while((*p2 != ':') && (*p2 != '\0'))
{
p2++;
}
if (*p2 == ':')
{
if (*p1 == '-')
{
p1++;
A2Dec(value, p1);
value *= -1;
}
else
A2Dec(value, p1);
pRadarDetect->rssi_threshold[i] = value;
printk("pRadarDetect->rssi_threshold[%d] = %d\n", i, pRadarDetect->rssi_threshold[i]);
pRadarDetect->fdf_num++;
p1 = p2 + 1;
}
else
{
pRadarDetect->rssi_threshold[i] = simple_strtol(p1, 0, 10);
printk("pRadarDetect->rssi_threshold[%d] = %d\n", i, pRadarDetect->rssi_threshold[i]);
pRadarDetect->fdf_num++;
break;
}
}
printk("pRadarDetect->fdf_num = %d\n", pRadarDetect->fdf_num);
return TRUE;
pRadarDetect->rssi_threshold[0] = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_PollTime_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
pRadarDetect->PollTime = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_Ch0LErr_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
pDfsSwParam->dfs_width_ch0_err_L = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_DeclareThres_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
pDfsSwParam->dfs_declare_thres = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_CheckLoop_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
pDfsSwParam->dfs_check_loop = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_MaxPeriod_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
pDfsSwParam->dfs_max_period = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_PeriodErr_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
pDfsSwParam->dfs_period_err = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_Ch0HErr_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
pDfsSwParam->dfs_width_ch0_err_H = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_Ch1Shift_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
pDfsSwParam->dfs_width_diff_ch1_Shift = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_Ch2Shift_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
pDfsSwParam->dfs_width_diff_ch2_Shift = simple_strtol(arg, 0, 10);
return TRUE;
}
#ifdef DFS_DEBUG
INT Set_CEPrintDebug_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
int i;
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
if (simple_strtol(arg, 0, 10) == 0)
{
pDfsSwParam->DebugPortPrint = 1;
}
if (simple_strtol(arg, 0, 10) == 1)
{
if (pDfsSwParam->DebugPortPrint == 3)
{
for (i = 0; i < 384; i++)
{
printk("%02x ", pDfsSwParam->DebugPort[i]);
if (((i+1) % 18) == 0)
printk("\n");
}
pDfsSwParam->DebugPortPrint = 0;
}
}
return TRUE;
}
#endif /* DFS_DEBUG */
INT Set_RadarSim_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
int i=0, id=0;
int dfs_data[] = { 208, 142172,
160, 260514,
208, 363873,
160, 482216,
208, 585575,
164, 703918,
208, 807277,
160, 925620,
208, 1028979,
164, 1147321};
pDfsSwParam->dfs_w_counter++;
for (i = 0; i < 10; i++)
{
pDfsSwParam->DFS_W[id][pDfsSwParam->dfs_w_idx[id]].counter = pDfsSwParam->dfs_w_counter;
pDfsSwParam->DFS_W[id][pDfsSwParam->dfs_w_idx[id]].timestamp = dfs_data[2*i+1];
pDfsSwParam->DFS_W[id][pDfsSwParam->dfs_w_idx[id]].width = dfs_data[2*i];
pDfsSwParam->dfs_w_last_idx[id] = pDfsSwParam->dfs_w_idx[id];
pDfsSwParam->dfs_w_idx[id]++;
if (pDfsSwParam->dfs_w_idx[id] >= NEW_DFS_DBG_PORT_ENT_NUM)
pDfsSwParam->dfs_w_idx[id] = 0;
}
pDfsSwParam->hw_idx[0] = pDfsSwParam->dfs_w_idx[0];
SWRadarCheck(pAd, 0);
return TRUE;
}
INT Set_PrintBusyIdle_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
pRadarDetect->print_ch_busy_sta = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_BusyIdleRatio_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
pRadarDetect->ch_busy_idle_ratio = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_DfsRssiHigh_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
pRadarDetect->DfsRssiHigh = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_DfsRssiLow_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
pRadarDetect->DfsRssiLow = simple_strtol(arg, 0, 10);
return TRUE;
}
INT Set_EventExpire_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_PROGRAM_PARAM pDfsProgramParam = &pAd->CommonCfg.RadarDetect.DfsProgramParam;
UINT8 dfs_channel, bbp_val;
UINT32 EventExpiration = 0;
STRING StrBuf[64];
PSTRING SubStr = NULL;
strncpy(StrBuf, arg, 64);
if ((SubStr = strchr(StrBuf, '_')) != NULL)
{
*SubStr = '\0';
SubStr++;
EventExpiration = (UINT32) simple_strtol(SubStr, 0, 16);
dfs_channel = (UINT8) simple_strtol(StrBuf, 0, 16);
DBGPRINT(RT_DEBUG_TRACE,
("%s(): dfs_channel = %u, EventExpiration = 0x%08x\n",
__FUNCTION__, dfs_channel, EventExpiration));
pDfsProgramParam->RadarEventExpire[dfs_channel] = EventExpiration;
RTMP_BBP_IO_WRITE32(pAd, DFS_R0, dfs_channel); /* disable DFS and select channel */
RTMP_BBP_IO_WRITE32(pAd, DFS_R17, EventExpiration); /* set value */
/* Enable detection*/
bbp_val = (pDfsProgramParam->ChEnable << 16);
RTMP_BBP_IO_WRITE32(pAd, DFS_R0, bbp_val);
}
else
{
DBGPRINT(RT_DEBUG_ERROR,
("%s(): Input format Error. (should be <Channel>_<value>)\n", __FUNCTION__));
return 0;
}
return TRUE;
}
INT Set_CEPrint_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
int i, j, id = simple_strtol(arg, 0, 10);
int n = pDfsSwParam->dfs_w_last_idx[id];
if ((id >= 0) && (id <= 3))
{
printk("Last Idx = %d\n", n);
for (i = 0; i < NEW_DFS_DBG_PORT_ENT_NUM; i++)
{
printk("Cnt=%u, w= %u Time=%u\n", (unsigned int)(pDfsSwParam->DFS_W[id][i].counter),
pDfsSwParam->DFS_W[id][i].width,
(unsigned int)pDfsSwParam->DFS_W[id][i].timestamp);
if (pDfsSwParam->DFS_W[id][i].counter == 0)
break;
}
}
if ((id >= 10) && (id < 13))
{
id -= 10;
for (i = 0; i < NEW_DFS_MPERIOD_ENT_NUM; i++)
{
printk("T=%u, w1= %u(%u), w2= %u(%u)\n", (unsigned int)(pDfsSwParam->DFS_T[id][i].period),
pDfsSwParam->DFS_T[id][i].width, pDfsSwParam->DFS_T[id][i].idx,
pDfsSwParam->DFS_T[id][i].width2, pDfsSwParam->DFS_T[id][i].idx2);
if (pDfsSwParam->DFS_T[id][i].period == 0)
break;
}
}
if (id == 77)
{
for (i = 0; i < 4; i++)
{
for (j = 0; j < NEW_DFS_DBG_PORT_ENT_NUM; j++)
{
pDfsSwParam->DFS_W[i][j].counter = 0;
pDfsSwParam->DFS_W[i][j].width = 0;
pDfsSwParam->DFS_W[i][j].timestamp = 0;
}
for (j = 0; j < NEW_DFS_MPERIOD_ENT_NUM; j++)
{
pDfsSwParam->DFS_T[i][j].period = 0;
pDfsSwParam->DFS_T[i][j].width = 0;
pDfsSwParam->DFS_T[i][j].width2 = 0;
pDfsSwParam->DFS_T[i][j].idx = 0;
pDfsSwParam->DFS_T[i][j].idx2 = 0;
}
}
}
#ifdef DFS_DEBUG
if (id > 20)
{
pDfsSwParam->BBP127Repeat = id - 20;
}
if (id == 5)
{
for (i = 0; i < NEW_DFS_DBG_PORT_ENT_NUM; i++)
{
printk("Cnt=%u, w= %u Time=%lu, start_idx = %u end_idx = %u\n", (unsigned int)(pDfsSwParam->CE_DebugCh0[i].counter),
(unsigned int)pDfsSwParam->CE_DebugCh0[i].width, pDfsSwParam->CE_DebugCh0[i].timestamp,
pDfsSwParam->CE_DebugCh0[i].start_idx, pDfsSwParam->CE_DebugCh0[i].end_idx);
}
for (i = 0; i < NEW_DFS_MPERIOD_ENT_NUM; i++)
{
printk("T=%lu, w1= %u(%u), w2= %u(%u)\n", (pDfsSwParam->CE_TCh0[i].period),
pDfsSwParam->CE_TCh0[i].width, pDfsSwParam->CE_TCh0[i].idx,
pDfsSwParam->CE_TCh0[i].width2, pDfsSwParam->CE_TCh0[i].idx2);
}
}
#endif /* DFS_DEBUG */
return TRUE;
}
INT Set_RfReg_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
printk("1 %x\n", pAd->LatchRfRegs.R1);
printk("2 %x\n", pAd->LatchRfRegs.R2);
printk("3 %x\n", pAd->LatchRfRegs.R3);
printk("4 %x\n", pAd->LatchRfRegs.R4);
return TRUE;
}
INT Show_BlockCh_Proc(
IN PRTMP_ADAPTER pAd,
IN PSTRING arg)
{
int i;
for (i=0; i<pAd->ChannelListNum; i++)
{
if (pAd->ChannelList[i].RemainingTimeForUse != 0)
{
DBGPRINT(RT_DEBUG_ERROR, ("Ch%d: RemainingTimeForUse:%d sec;\n",
pAd->ChannelList[i].Channel, pAd->ChannelList[i].RemainingTimeForUse));
}
}
return TRUE;
}
VOID DFSInit(PRTMP_ADAPTER pAd)
{
INT i;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
PDFS_PROGRAM_PARAM pDfsProgramParam = &pRadarDetect->DfsProgramParam;
pRadarDetect->ch_busy_countdown = -1;
pRadarDetect->EnabledChMask = ((1 << pAd->chipCap.DfsEngineNum) -1);
pRadarDetect->PollTime = 3;
pRadarDetect->DfsRssiHigh = -30;
pRadarDetect->DfsRssiLow = -90;
pRadarDetect->DFSWatchDogIsRunning=FALSE;
pRadarDetect->use_tasklet = 1;
pRadarDetect->McuRadarDebug = RADAR_DONT_SWITCH; //snowpin test 0;
pRadarDetect->radarDeclared = 0;
pRadarDetect->dfs_func = HARDWARE_DFS_V2;
pDfsProgramParam->DeltaDelay = 0x3;
pDfsProgramParam->ChEnable = pRadarDetect->EnabledChMask;
for (i=0; i < pAd->chipCap.DfsEngineNum; i++)
{
if ((i == 3) &&
(pAd->CommonCfg.RDDurRegion == FCC || pAd->CommonCfg.RDDurRegion == JAP))
pDfsProgramParam->RadarEventExpire[i] = 0x10000000; /* for Chirp Radar */
else
pDfsProgramParam->RadarEventExpire[i] = 0x1000000;
}
/*pDfsProgramParam->RadarEventExpire[0] = 0x1000000;*/
/*pDfsProgramParam->RadarEventExpire[3] = 0x99999999;*/
pDfsProgramParam->Symmetric_Round = 1;
pDfsProgramParam->VGA_Mask = 45;
pDfsProgramParam->Packet_End_Mask = 45;
pDfsProgramParam->Rx_PE_Mask = 45;
/*pAd->CommonCfg.ce_sw_check = CE_SW_CHECK;*/
/*pDfsSwParam->ce_sw_id_check = 0;*/
/*pDfsSwParam->ce_sw_t_diff = 14;*/
/* from dfs_mcu.c, one time init */
dfs_sw_init(pAd);
}
void NewRadarDetectionStart(PRTMP_ADAPTER pAd)
{
pNewDFSTable pDFS2Table;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
/*PDFS_PROGRAM_PARAM pDfsProgramParam = &pRadarDetect->DfsProgramParam;*/
pRadarDetect->bDfsInit = FALSE;
DBGPRINT(RT_DEBUG_TRACE, ("--->NewRadarDetectionStart()\n"));
DFSInit(pAd);
#ifdef RTMP_MAC_USB
INIT_DFS_EVENT_BUFF_SHARED_MEMORY(pAd, BBPR127TABLE_OFFSET, 8, 0xfe);
#endif /* RTMP_MAC_USB */
RTMP_CHIP_RADAR_GLRT_COMPENSATE(pAd);
if ((pAd->CommonCfg.RDDurRegion == CE) && RESTRICTION_BAND_1(pAd))
pAd->Dot11_H.ChMovingTime = 605;
else
pAd->Dot11_H.ChMovingTime = 65;
if (pAd->CommonCfg.RDDurRegion == FCC)
{
if (pRadarDetect->ch_busy_idle_ratio == 0)
pRadarDetect->ch_busy_idle_ratio = 2;
pDFS2Table = &NewDFSTable1[0];
DBGPRINT(RT_DEBUG_TRACE,("DFS start, use FCC table\n"));
}
else if (pAd->CommonCfg.RDDurRegion == CE)
{
if (pRadarDetect->ch_busy_idle_ratio == 0)
pRadarDetect->ch_busy_idle_ratio = 3;
pDFS2Table = &NewDFSTable1[1];
DBGPRINT(RT_DEBUG_TRACE,("DFS start, use CE table\n"));
}
else /* JAP*/
{
if ((pAd->CommonCfg.Channel >= 52) && (pAd->CommonCfg.Channel <= 64))
{
pDFS2Table = &NewDFSTable1[3];
if (pRadarDetect->ch_busy_idle_ratio == 0)
pRadarDetect->ch_busy_idle_ratio = 3;
}
else
{
pDFS2Table = &NewDFSTable1[2];
/*pDfsProgramParam->Symmetric_Round = 1;*/
if (pRadarDetect->ch_busy_idle_ratio == 0)
pRadarDetect->ch_busy_idle_ratio = 2;
}
DBGPRINT(RT_DEBUG_TRACE,("DFS start, use JAP table\n"));
}
NewRadarDetectionProgram(pAd, pDFS2Table);
/*the usage of dfs_sw_init*/
/*dfs_sw_init(pAd);*/
#ifdef RTMP_MAC_USB
if (NewRadarDetectionMcuStart(pAd) == FALSE)
{
DBGPRINT(RT_DEBUG_ERROR, ("NewRadarDetectionMcuStart failed.\n"));
}
#endif /* RTMP_MAC_USB */
pRadarDetect->bDfsInit = TRUE;
DBGPRINT(RT_DEBUG_TRACE,("Poll Time=%d\n", pRadarDetect->PollTime));
}
VOID NewRadarDetectionStop(
IN PRTMP_ADAPTER pAd)
{
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
DBGPRINT(RT_DEBUG_TRACE, ("NewRadarDetectionStop\n"));
/* set init bit = false to prevent dfs rotines */
pRadarDetect->bDfsInit = FALSE;
pRadarDetect->radarDeclared = 0;
#ifdef RT65xx
/* Disable detection*/
RTMP_BBP_IO_WRITE32(pAd, DFS_R0, 0);
/* Clear status */
RTMP_BBP_IO_WRITE32(pAd, DFS_R1, pRadarDetect->EnabledChMask);
#else
/* Disable detection*/
RTMP_DFS_IO_WRITE8(pAd, 0x1, 0);
/* Clear Status */
RTMP_DFS_IO_WRITE8(pAd, 0x2, pRadarDetect->EnabledChMask);
#endif
#ifdef RTMP_MAC_USB
if (NewRadarDetectionMcuStop(pAd) == FALSE)
{
DBGPRINT(RT_DEBUG_ERROR, ("NewRadarDetectionMcuStop failed.\n"));
}
#endif /* RTMP_MAC_USB */
}
/* the debug port have timestamp 22 digit, the max number is 0x3fffff, each unit is 25ns for 40Mhz mode and 50ns for 20Mhz mode*/
/* so a round of timestamp is about 25 * 0x3fffff / 1000 = 104857us (about 100ms) or*/
/* 50 * 0x3fffff / 1000 = 209715us (about 200ms) in 20Mhz mode*/
/* 3ms = 3000,000 ns / 25ns = 120000 -- a unit */
/* 0x3fffff/120000 = 34.9 ~= 35*/
/* CE Staggered radar check*/
/* At beginning, the goal is to detect staggered radar, now, we also detect regular radar with this function.*/
int SWRadarCheck(
IN PRTMP_ADAPTER pAd, USHORT id)
{
int i, j, start_idx, end_idx;
pNewDFSDebugPort pCurrent, p1, pEnd;
ULONG period;
int radar_detected = 0;
USHORT widthsum;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
PDFS_SW_DETECT_PARAM pDfsSwParam = &pRadarDetect->DfsSwParam;
/*ENTRY_PLUS could be replace by (pDfsSwParam->sw_idx[id]+1)%128*/
USHORT Total, SwIdxPlus = ENTRY_PLUS(pDfsSwParam->sw_idx[id], 1, NEW_DFS_DBG_PORT_ENT_NUM);
UCHAR CounterToCheck;
if (!DFS_CHECK_FLAGS(pAd, pRadarDetect) ||
(SwIdxPlus == pDfsSwParam->hw_idx[id])) /* no entry to process*/
return 0;
/* process how many entries?? total NEW_DFS_DBG_PORT_ENT_NUM*/
if (pDfsSwParam->hw_idx[id] > SwIdxPlus)
Total = pDfsSwParam->hw_idx[id] - SwIdxPlus;
else
Total = pDfsSwParam->hw_idx[id] + NEW_DFS_DBG_PORT_ENT_NUM - SwIdxPlus;
if (Total > NEW_DFS_DBG_PORT_ENT_NUM)
pDfsSwParam->pr_idx[id] = ENTRY_PLUS(pDfsSwParam->sw_idx[id], MAX_PROCESS_ENTRY, NEW_DFS_DBG_PORT_ENT_NUM);
else
pDfsSwParam->pr_idx[id] = ENTRY_PLUS(pDfsSwParam->sw_idx[id], Total, NEW_DFS_DBG_PORT_ENT_NUM);
start_idx = ENTRY_PLUS(pDfsSwParam->pr_idx[id], 1, NEW_DFS_DBG_PORT_ENT_NUM);
end_idx = pDfsSwParam->pr_idx[id];
pEnd = &pDfsSwParam->DFS_W[id][end_idx];
/*printk("start_idx = %d, end_idx=%d, counter=%d\n", start_idx, end_idx, pEnd->counter);*/
/*if (pDfsSwParam->dfs_w_counter != pEnd->counter)*/
/* return 0;*/
if (start_idx > end_idx)
end_idx += NEW_DFS_DBG_PORT_ENT_NUM;
pDfsSwParam->sw_idx[id] = pDfsSwParam->pr_idx[id];
/* FCC && Japan*/
if (pAd->CommonCfg.RDDurRegion != CE)
{
ULONG minPeriod = (3000 << 1);
/* Calculate how many counters to check*/
/* if pRadarDetect->PollTime is 1ms, a round of timestamp is 107 for 20Mhz, 53 for 40Mhz*/
/* if pRadarDetect->PollTime is 2ms, a round of timestamp is 71 for 20Mhz, 35 for 40Mhz*/
/* if pRadarDetect->PollTime is 3ms, a round of timestamp is 53 for 20Mhz, 27 for 40Mhz*/
/* if pRadarDetect->PollTime is 4ms, a round of timestamp is 43 for 20Mhz, 21 for 40Mhz*/
/* the max period to check for 40Mhz for FCC is 28650 * 2*/
/* the max period to check for 40Mhz for Japan is 80000 * 2*/
/* 0x40000 = 4194304 / 57129 = 73.xxx*/
/* 0x40000 = 4194304 / 160000 = 26.2144*/
/* 53/73 < 1 (1+1)*/
/* 53/26.2144 = 2.02... (2+1)*/
/* 27/26.2144 = 1.02... (1+1)*/
/* 20M should use the same value as 40Mhz mode*/
if (pRadarDetect->MCURadarRegion == NEW_DFS_JAP_W53)
{
minPeriod = 28500 << 1;
}
if (pAd->CommonCfg.RDDurRegion == FCC)
{
CounterToCheck = 1+1;
}
else /* if (pAd->CommonCfg.RDDurRegion == JAP)*/
{
if (pRadarDetect->PollTime <= 2)
CounterToCheck = 2+1;
else
CounterToCheck = 1+1;
}
/* First Loop for FCC/JAP*/
for (i = end_idx; i > start_idx; i--)
{
pCurrent = &pDfsSwParam->DFS_W[id][i & NEW_DFS_DBG_PORT_MASK];
/* we only handle entries has same counter with the last one*/
if (pCurrent->counter != pEnd->counter)
break;
pCurrent->start_idx = 0xffff;
/* calculate if any two pulse become a valid period, add it in period table,*/
for (j = i - 1; j > start_idx; j--)
{
p1 = &pDfsSwParam->DFS_W[id][j & NEW_DFS_DBG_PORT_MASK];
/* check period, must within max period*/
if (pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40)
{
if (p1->counter + CounterToCheck < pCurrent->counter)
break;
widthsum = p1->width + pCurrent->width;
if (id == 0)
{
if (widthsum < 600)
pDfsSwParam->dfs_width_diff = pDfsSwParam->dfs_width_ch0_err_L;
else
pDfsSwParam->dfs_width_diff = widthsum >> pDfsSwParam->dfs_width_diff_ch2_Shift;
}
else if (id == 1)
pDfsSwParam->dfs_width_diff = widthsum >> pDfsSwParam->dfs_width_diff_ch1_Shift;
else if (id == 2)
pDfsSwParam->dfs_width_diff = widthsum >> pDfsSwParam->dfs_width_diff_ch2_Shift;
if ( (pAd->Dot11_H.RDMode == RD_SILENCE_MODE) ||
(PERIOD_MATCH(p1->width, pCurrent->width, pDfsSwParam->dfs_width_diff)) )
{
if (p1->timestamp >= pCurrent->timestamp)
period = 0x400000 + pCurrent->timestamp - p1->timestamp;
else
period = pCurrent->timestamp - p1->timestamp;
if ((period >= (minPeriod - 2)) && (period <= pDfsSwParam->dfs_max_period))
{
/* add in period table*/
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].idx = (i & NEW_DFS_DBG_PORT_MASK);
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].width = pCurrent->width;
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].idx2 = (j & NEW_DFS_DBG_PORT_MASK);
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].width2 = p1->width;
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].period = period;
if (pCurrent->start_idx == 0xffff)
pCurrent->start_idx = pDfsSwParam->dfs_t_idx[id];
pCurrent->end_idx = pDfsSwParam->dfs_t_idx[id];
pDfsSwParam->dfs_t_idx[id]++;
if (pDfsSwParam->dfs_t_idx[id] >= NEW_DFS_MPERIOD_ENT_NUM)
pDfsSwParam->dfs_t_idx[id] = 0;
}
else if (period > pDfsSwParam->dfs_max_period)
break;
}
}
else
{
if (p1->counter + CounterToCheck < pCurrent->counter)
break;
widthsum = p1->width + pCurrent->width;
if (id == 0)
{
if (widthsum < 600)
pDfsSwParam->dfs_width_diff = pDfsSwParam->dfs_width_ch0_err_L;
else
pDfsSwParam->dfs_width_diff = widthsum >> pDfsSwParam->dfs_width_diff_ch2_Shift;
}
else if (id == 1)
pDfsSwParam->dfs_width_diff = widthsum >> pDfsSwParam->dfs_width_diff_ch1_Shift;
else if (id == 2)
pDfsSwParam->dfs_width_diff = widthsum >> pDfsSwParam->dfs_width_diff_ch2_Shift;
if ( (pAd->Dot11_H.RDMode == RD_SILENCE_MODE) ||
(PERIOD_MATCH(p1->width, pCurrent->width, pDfsSwParam->dfs_width_diff)) )
{
if (p1->timestamp >= pCurrent->timestamp)
period = 0x400000 + pCurrent->timestamp - p1->timestamp;
else
period = pCurrent->timestamp - p1->timestamp;
if ((period >= ((minPeriod >> 1) - 2)) && (period <= (pDfsSwParam->dfs_max_period >> 1)))
{
/* add in period table*/
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].idx = (i & NEW_DFS_DBG_PORT_MASK);
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].width = pCurrent->width;
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].idx2 = (j & NEW_DFS_DBG_PORT_MASK);
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].width2 = p1->width;
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].period = period;
if (pCurrent->start_idx == 0xffff)
pCurrent->start_idx = pDfsSwParam->dfs_t_idx[id];
pCurrent->end_idx = pDfsSwParam->dfs_t_idx[id];
pDfsSwParam->dfs_t_idx[id]++;
if (pDfsSwParam->dfs_t_idx[id] >= NEW_DFS_MPERIOD_ENT_NUM)
pDfsSwParam->dfs_t_idx[id] = 0;
}
else if (period > (pDfsSwParam->dfs_max_period >> 1))
break;
}
}
} /* for (j = i - 1; j > start_idx; j--)*/
} /* for (i = end_idx; i > start_idx; i--)*/
/* Second Loop for FCC/JAP*/
for (i = end_idx; i > start_idx; i--)
{
pCurrent = &pDfsSwParam->DFS_W[id][i & NEW_DFS_DBG_PORT_MASK];
/* we only handle entries has same counter with the last one*/
if (pCurrent->counter != pEnd->counter)
break;
if (pCurrent->start_idx != 0xffff)
{
/*pNewDFSDebugPort p2, p3, p4, p5, p6;*/
pNewDFSDebugPort p2, p3;
pNewDFSMPeriod pCE_T;
ULONG idx[10], T[10];
for (idx[0] = pCurrent->start_idx; idx[0] <= pCurrent->end_idx; idx[0]++)
{
pCE_T = &pDfsSwParam->DFS_T[id][idx[0]];
p2 = &pDfsSwParam->DFS_W[id][pCE_T->idx2];
if (p2->start_idx == 0xffff)
continue;
T[0] = pCE_T->period;
for (idx[1] = p2->start_idx; idx[1] <= p2->end_idx; idx[1]++)
{
pCE_T = &pDfsSwParam->DFS_T[id][idx[1]];
p3 = &pDfsSwParam->DFS_W[id][pCE_T->idx2];
if (idx[0] == idx[1])
continue;
if (p3->start_idx == 0xffff)
continue;
T[1] = pCE_T->period;
if ( PERIOD_MATCH(T[0], T[1], pDfsSwParam->dfs_period_err))
{
if (id <= 2) /* && (id >= 0)*/
{
/*if (((pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40) && (T[1] > minPeriod)) ||*/
/* ((pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_20) && (T[1] > (minPeriod >> 1))) )*/
{
unsigned int loop, PeriodMatched = 0, idx1;
for (loop = 1; loop < pDfsSwParam->dfs_check_loop; loop++)
{
idx1 = (idx[1] >= loop)? (idx[1] - loop): (NEW_DFS_MPERIOD_ENT_NUM + idx[1] - loop);
if (PERIOD_MATCH(pDfsSwParam->DFS_T[id][idx1].period, T[1], pDfsSwParam->dfs_period_err))
{
#ifdef DFS_DEBUG
if (PeriodMatched < 5)
{
pDfsSwParam->CounterStored[PeriodMatched] = pDfsSwParam->DFS_W[id][pDfsSwParam->DFS_T[id][idx1].idx].counter;
pDfsSwParam->CounterStored2[PeriodMatched] = loop;
pDfsSwParam->CounterStored3 = idx[1];
}
#endif
/*printk("%d %d\n", loop, pDfsSwParam->DFS_T[id][idx[1]-loop].period);*/
PeriodMatched++;
}
}
if (PeriodMatched > pDfsSwParam->dfs_declare_thres)
{
#ifdef DFS_DEBUG
if (PeriodMatched == 3)
{
pDfsSwParam->T_Matched_3++;
/*printk("counter=%d %d %d\n", pDfsSwParam->CounterStored[0], pDfsSwParam->CounterStored[1], pDfsSwParam->CounterStored[2]);*/
/*printk("idx[1]=%d, loop =%d %d %d\n", pDfsSwParam->CounterStored3, pDfsSwParam->CounterStored2[0], pDfsSwParam->CounterStored2[1], pDfsSwParam->CounterStored2[2]);*/
}
else if (PeriodMatched == 4)
{
pDfsSwParam->T_Matched_4++;
/*printk("counter=%d %d %d %d\n", pDfsSwParam->CounterStored[0], pDfsSwParam->CounterStored[1], pDfsSwParam->CounterStored[2], pDfsSwParam->CounterStored[3]);*/
/*printk("idx[1]=%d, loop =%d %d %d %d\n", pDfsSwParam->CounterStored3, pDfsSwParam->CounterStored2[0], pDfsSwParam->CounterStored2[1], pDfsSwParam->CounterStored2[2], pDfsSwParam->CounterStored2[3]);*/
}
else
{
pDfsSwParam->T_Matched_5++;
/*printk("counter=%d %d %d %d %d\n", pDfsSwParam->CounterStored[0], pDfsSwParam->CounterStored[1], pDfsSwParam->CounterStored[2], pDfsSwParam->CounterStored[3], pDfsSwParam->CounterStored[4]);*/
/*printk("idx[1]=%d, loop =%d %d %d %d %d\n", pDfsSwParam->CounterStored3, pDfsSwParam->CounterStored2[0], pDfsSwParam->CounterStored2[1], pDfsSwParam->CounterStored2[2], pDfsSwParam->CounterStored2[3], pDfsSwParam->CounterStored2[4]);*/
}
pDfsSwParam->DebugPortPrint = 1;
#endif
{
pNewDFSValidRadar pDFSValidRadar;
ULONG T1 = (pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40)? (T[1]>>1) : T[1];
pDFSValidRadar = &NewDFSValidTable[0];
while (pDFSValidRadar->type != NEW_DFS_END)
{
if ((pDFSValidRadar->type & pRadarDetect->MCURadarRegion) == 0)
{
pDFSValidRadar++;
continue;
}
if (pDFSValidRadar->TLow)
{
if ( (T1 > (pDFSValidRadar->TLow - pDFSValidRadar->TMargin)) &&
(T1 < (pDFSValidRadar->THigh + pDFSValidRadar->TMargin)) )
{
radar_detected = 1;
}
}
else
{
if ( (T1 > (pDFSValidRadar->T - pDFSValidRadar->TMargin)) &&
(T1 < (pDFSValidRadar->T + pDFSValidRadar->TMargin)) )
{
radar_detected = 1;
break;
}
}
pDFSValidRadar++;
}
if (radar_detected == 1)
{
DBGPRINT(RT_DEBUG_TRACE, ("W=%d, T=%d (%d), period matched=%d\n", (unsigned int)pCE_T->width, (unsigned int)T1, (unsigned int)id, PeriodMatched));
printk("SWRadarCheck: Radar Detected\n");
return radar_detected;
}
else if (pRadarDetect->MCURadarRegion != NEW_DFS_JAP_W53)
DBGPRINT(RT_DEBUG_TRACE, ("W=%d, T=%d (%d), period matched=%d\n", (unsigned int)pCE_T->width, (unsigned int)T1, (unsigned int)id, PeriodMatched));
}
}
#ifdef DFS_DEBUG
else if (PeriodMatched == 2)
{
pDfsSwParam->T_Matched_2++;
}
#endif
}
} /* if (id <= 2) && (id >= 0)*/
}
} /* for (idx[1] = p2->start_idx; idx[1] <= p2->end_idx; idx[1]++)*/
/* increase FCC-1 detection*/
if (id <= 2)
{
if (IS_FCC_RADAR_1((pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40), T[0]))
{
int loop, idx1, PeriodMatched_fcc1 = 0;
for (loop = 1; loop < pDfsSwParam->dfs_check_loop; loop++)
{
idx1 = (idx[0] >= loop)? (idx[0] - loop): (NEW_DFS_MPERIOD_ENT_NUM + idx[0] - loop);
if ( IS_FCC_RADAR_1((pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40), pDfsSwParam->DFS_T[id][idx1].period) )
{
/*printk("%d %d %d\n", PeriodMatched_fcc1, pDfsSwParam->DFS_T[id][idx1].period, loop);*/
PeriodMatched_fcc1++;
}
}
if (PeriodMatched_fcc1 > 3)
{
DBGPRINT(RT_DEBUG_TRACE, ("PeriodMatched_fcc1 = %d (%d)\n", PeriodMatched_fcc1, id));
radar_detected = 1;
return radar_detected;
}
}
}
/* increase W56-3 detection*/
if ((pRadarDetect->MCURadarRegion == NEW_DFS_JAP) && (id <= 2))
{
if (IS_W56_RADAR_3((pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40), T[0]))
{
int loop, idx1, PeriodMatched_w56_3 = 0;
for (loop = 1; loop < pDfsSwParam->dfs_check_loop; loop++)
{
idx1 = (idx[0] >= loop)? (idx[0] - loop): (NEW_DFS_MPERIOD_ENT_NUM + idx[0] - loop);
if ( IS_W56_RADAR_3((pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40), pDfsSwParam->DFS_T[id][idx1].period) )
{
/*printk("%d %d %d\n", PeriodMatched_w56_3, pDfsSwParam->DFS_T[id][idx1].period, loop);*/
PeriodMatched_w56_3++;
}
}
if (PeriodMatched_w56_3 > 3)
{
DBGPRINT(RT_DEBUG_TRACE, ("PeriodMatched_w56_3 = %d (%d)\n", PeriodMatched_w56_3, id));
radar_detected = 1;
return radar_detected;
}
}
}
if ((pRadarDetect->MCURadarRegion == NEW_DFS_JAP_W53) && (id <= 2) && IS_W53_RADAR_2((pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40), T[0]))
{
int loop, idx1, PeriodMatched_W56_2 = 0;
for (loop = 1; loop < pDfsSwParam->dfs_check_loop; loop++)
{
idx1 = (idx[0] >= loop)? (idx[0] - loop): (NEW_DFS_MPERIOD_ENT_NUM + idx[0] - loop);
if ( IS_W53_RADAR_2((pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40), pDfsSwParam->DFS_T[id][idx1].period) )
{
/*printk("%d %d %d\n", PeriodMatched_W56_2, pDfsSwParam->DFS_T[id][idx1].period, loop);*/
PeriodMatched_W56_2++;
}
}
if (PeriodMatched_W56_2 >= 3)
{
DBGPRINT(RT_DEBUG_TRACE, ("PeriodMatched_W56_2 = %d(%d)\n", PeriodMatched_W56_2, id));
radar_detected = 1;
return radar_detected;
}
}
} /* for (idx[0] = pCurrent->start_idx; idx[0] <= pCurrent->end_idx; idx[0]++)*/
} /* if (pCurrent->start_idx != 0xffff)*/
} /* for (i = end_idx; i > start_idx; i--)*/
return radar_detected;
}
/* CE have staggered radar */
/* Calculate how many counters to check*/
/* if pRadarDetect->PollTime is 1ms, a round of timestamp is 107 for 20Mhz, 53 for 40Mhz*/
/* if pRadarDetect->PollTime is 2ms, a round of timestamp is 71 for 20Mhz, 35 for 40Mhz*/
/* if pRadarDetect->PollTime is 3ms, a round of timestamp is 53 for 20Mhz, 27 for 40Mhz*/
/* if pRadarDetect->PollTime is 4ms, a round of timestamp is 43 for 20Mhz, 21 for 40Mhz*/
/* if pRadarDetect->PollTime is 8ms, a round of timestamp is ?? for 20Mhz, 12 for 40Mhz*/
/* the max period to check for 40Mhz is 133333 + 125000 + 117647 = 375980*/
/* 0x40000 = 4194304 / 375980 = 11.1556*/
/* 53/11.1556 = 4.75...*/
/* 35/11.1556 = 3.1374, (4+1) is safe, (3+1) to save CPU power, but may lost some data*/
/* 27/11.1556 = 2.42, (3+1) is OK*/
/* 21/11.1556 = 1.88, (2+1) is OK*/
/* 20M should use the same value as 40Mhz mode*/
if (pRadarDetect->PollTime == 1)
CounterToCheck = 5+1;
else if (pRadarDetect->PollTime == 2)
CounterToCheck = 4+1;
else if (pRadarDetect->PollTime == 3)
CounterToCheck = 3+1;
else if (pRadarDetect->PollTime <= 8)
CounterToCheck = 2+1;
else
CounterToCheck = 1+1;
/* First Loop for CE*/
for (i = end_idx; i > start_idx; i--)
{
pCurrent = &pDfsSwParam->DFS_W[id][i & NEW_DFS_DBG_PORT_MASK];
/* we only handle entries has same counter with the last one*/
if (pCurrent->counter != pEnd->counter)
break;
pCurrent->start_idx = 0xffff;
/* calculate if any two pulse become a valid period, add it in period table,*/
for (j = i - 1; j > start_idx; j--)
{
p1 = &pDfsSwParam->DFS_W[id][j & NEW_DFS_DBG_PORT_MASK];
/* check period, must within 16666 ~ 66666*/
if (pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40)
{
if (p1->counter + CounterToCheck < pCurrent->counter)
break;
widthsum = p1->width + pCurrent->width;
if (id == 0)
{
if (((p1->width > 310) && (pCurrent->width < 300)) || ((pCurrent->width > 310) && ((p1->width < 300))) )
continue;
if (widthsum < 620)
pDfsSwParam->dfs_width_diff = pDfsSwParam->dfs_width_ch0_err_H;
else
pDfsSwParam->dfs_width_diff = pDfsSwParam->dfs_width_ch0_err_L;
}
else if (id == 1)
pDfsSwParam->dfs_width_diff = widthsum >> pDfsSwParam->dfs_width_diff_ch1_Shift;
else if (id == 2)
pDfsSwParam->dfs_width_diff = widthsum >> pDfsSwParam->dfs_width_diff_ch2_Shift;
if ( (pAd->Dot11_H.RDMode == RD_SILENCE_MODE) ||
(PERIOD_MATCH(p1->width, pCurrent->width, pDfsSwParam->dfs_width_diff)) )
{
if (p1->timestamp >= pCurrent->timestamp)
period = 0x400000 + pCurrent->timestamp - p1->timestamp;
else
period = pCurrent->timestamp - p1->timestamp;
/*if ((period >= (33333 - 20)) && (period <= (133333 + 20)))*/
if ((period >= (33333 - 20)) && (period <= pDfsSwParam->dfs_max_period))
//if ((period >= (10000 - 2)) && (period <= pDfsSwParam->dfs_max_period))
{
/* add in period table*/
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].idx = (i & NEW_DFS_DBG_PORT_MASK);
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].width = pCurrent->width;
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].idx2 = (j & NEW_DFS_DBG_PORT_MASK);
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].width2 = p1->width;
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].period = period;
if (pCurrent->start_idx == 0xffff)
pCurrent->start_idx = pDfsSwParam->dfs_t_idx[id];
pCurrent->end_idx = pDfsSwParam->dfs_t_idx[id];
pDfsSwParam->dfs_t_idx[id]++;
if (pDfsSwParam->dfs_t_idx[id] >= NEW_DFS_MPERIOD_ENT_NUM)
pDfsSwParam->dfs_t_idx[id] = 0;
}
else if (period > pDfsSwParam->dfs_max_period) /* to allow miss a pulse*/
break;
}
}
else
{
if (p1->counter + CounterToCheck < pCurrent->counter)
break;
widthsum = p1->width + pCurrent->width;
if (id == 0)
{
if (((p1->width > 300) && (pCurrent->width < 300)) || ((pCurrent->width > 300) && ((p1->width < 300))) )
continue;
if (widthsum < 620)
pDfsSwParam->dfs_width_diff = pDfsSwParam->dfs_width_ch0_err_H;
else
pDfsSwParam->dfs_width_diff = pDfsSwParam->dfs_width_ch0_err_L;
}
else if (id == 1)
{
pDfsSwParam->dfs_width_diff = widthsum >> 3; /* for 20M verified */
//printk("dfs_width_diff = %u\n",pDfsSwParam->dfs_width_diff);
}
else if (id == 2)
pDfsSwParam->dfs_width_diff = widthsum >> 6;
if ( (pAd->Dot11_H.RDMode == RD_SILENCE_MODE) ||
(PERIOD_MATCH(p1->width, pCurrent->width, pDfsSwParam->dfs_width_diff)) )
{
if (p1->timestamp >= pCurrent->timestamp)
period = 0x400000 + pCurrent->timestamp - p1->timestamp;
else
period = pCurrent->timestamp - p1->timestamp;
//if ((period >= (5000 - 2)) && (period <= (pDfsSwParam->dfs_max_period >> 1)))
if ((period >= (16666 - 20)) && (period <= (pDfsSwParam->dfs_max_period >> 1)))//neil modify for ce 5-1
{
/* add in period table*/
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].idx = (i & NEW_DFS_DBG_PORT_MASK);
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].width = pCurrent->width;
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].idx2 = (j & NEW_DFS_DBG_PORT_MASK);
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].width2 = p1->width;
pDfsSwParam->DFS_T[id][pDfsSwParam->dfs_t_idx[id]].period = period;
if (pCurrent->start_idx == 0xffff)
pCurrent->start_idx = pDfsSwParam->dfs_t_idx[id];
pCurrent->end_idx = pDfsSwParam->dfs_t_idx[id];
pDfsSwParam->dfs_t_idx[id]++;
if (pDfsSwParam->dfs_t_idx[id] >= NEW_DFS_MPERIOD_ENT_NUM)
pDfsSwParam->dfs_t_idx[id] = 0;
}
else if (period > (pDfsSwParam->dfs_max_period >> 1))
break;
}
}
} /* for (j = i - 1; j > start_idx; j--)*/
}
/* Second Loop for CE*/
for (i = end_idx; i > start_idx; i--)
{
pCurrent = &pDfsSwParam->DFS_W[id][i & NEW_DFS_DBG_PORT_MASK];
/* we only handle entries has same counter with the last one*/
if (pCurrent->counter != pEnd->counter)
break;
/* Check Staggered radar*/
if (pCurrent->start_idx != 0xffff)
{
pNewDFSDebugPort p2, p3;
pNewDFSMPeriod pCE_T;
ULONG idx[10], T[10];
/*printk("pCurrent=%d, idx=%d~%d\n", pCurrent->timestamp, pCurrent->start_idx, pCurrent->end_idx);*/
for (idx[0] = pCurrent->start_idx; idx[0] <= pCurrent->end_idx; idx[0]++)
{
pCE_T = &pDfsSwParam->DFS_T[id][idx[0]];
p2 = &pDfsSwParam->DFS_W[id][pCE_T->idx2];
/*printk("idx[0]= %d, idx=%d p2=%d, idx=%d~%d\n", idx[0], pCE_T->idx2, p2->timestamp, p2->start_idx, p2->end_idx);*/
if (p2->start_idx == 0xffff)
continue;
T[0] = pCE_T->period;
for (idx[1] = p2->start_idx; idx[1] <= p2->end_idx; idx[1]++)
{
pCE_T = &pDfsSwParam->DFS_T[id][idx[1]];
p3 = &pDfsSwParam->DFS_W[id][pCE_T->idx2];
/*printk("p3=%d, idx=%d~%d\n", p3->timestamp, p3->start_idx, p3->end_idx);*/
if (idx[0] == idx[1])
continue;
if (p3->start_idx == 0xffff)
continue;
T[1] = pCE_T->period;
if (PERIOD_MATCH(T[0], T[1], pDfsSwParam->dfs_period_err))
{
if (id <= 2) /* && (id >= 0)*/
{
if (((pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40) && (T[1] > 66666)) ||
((pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_20) && (T[1] > 33333)) )
{
unsigned int loop, PeriodMatched = 0, idx1;
for (loop = 1; loop < pDfsSwParam->dfs_check_loop; loop++)
{
idx1 = (idx[1] >= loop)? (idx[1] - loop): (NEW_DFS_MPERIOD_ENT_NUM + idx[1] - loop);
if (PERIOD_MATCH(pDfsSwParam->DFS_T[id][idx1].period, T[1], pDfsSwParam->dfs_period_err))
{
#ifdef DFS_DEBUG
if (PeriodMatched < 5)
{
pDfsSwParam->CounterStored[PeriodMatched] = pDfsSwParam->DFS_W[id][pDfsSwParam->DFS_T[id][idx1].idx].counter;
pDfsSwParam->CounterStored2[PeriodMatched] = loop;
pDfsSwParam->CounterStored3 = idx[1];
}
#endif
/*printk("%d %d\n", loop, pDfsSwParam->DFS_T[id][idx[1]-loop].period);*/
PeriodMatched++;
}
}
if (PeriodMatched > pDfsSwParam->dfs_declare_thres)
{
#ifdef DFS_DEBUG
if (PeriodMatched == 3)
{
pDfsSwParam->T_Matched_3++;
/*printk("counter=%d %d %d\n", pDfsSwParam->CounterStored[0], pDfsSwParam->CounterStored[1], pDfsSwParam->CounterStored[2]);*/
/*printk("idx[1]=%d, loop =%d %d %d\n", pDfsSwParam->CounterStored3, pDfsSwParam->CounterStored2[0], pDfsSwParam->CounterStored2[1], pDfsSwParam->CounterStored2[2]);*/
}
else if (PeriodMatched == 4)
{
pDfsSwParam->T_Matched_4++;
/*printk("counter=%d %d %d %d\n", pDfsSwParam->CounterStored[0], pDfsSwParam->CounterStored[1], pDfsSwParam->CounterStored[2], pDfsSwParam->CounterStored[3]);*/
/*printk("idx[1]=%d, loop =%d %d %d %d\n", pDfsSwParam->CounterStored3, pDfsSwParam->CounterStored2[0], pDfsSwParam->CounterStored2[1], pDfsSwParam->CounterStored2[2], pDfsSwParam->CounterStored2[3]);*/
}
else
{
pDfsSwParam->T_Matched_5++;
/*printk("counter=%d %d %d %d %d\n", pDfsSwParam->CounterStored[0], pDfsSwParam->CounterStored[1], pDfsSwParam->CounterStored[2], pDfsSwParam->CounterStored[3], pDfsSwParam->CounterStored[4]);*/
/*printk("idx[1]=%d, loop =%d %d %d %d %d\n", pDfsSwParam->CounterStored3, pDfsSwParam->CounterStored2[0], pDfsSwParam->CounterStored2[1], pDfsSwParam->CounterStored2[2], pDfsSwParam->CounterStored2[3], pDfsSwParam->CounterStored2[4]);*/
}
pDfsSwParam->DebugPortPrint = 1;
#endif
printk("Radar Detected(CE), W=%d, T=%d (%d), period matched=%d\n", (unsigned int)pCE_T->width, (unsigned int)T[1], (unsigned int)id, PeriodMatched);
if (PeriodMatched > (pDfsSwParam->dfs_declare_thres + 1))
radar_detected = 1;
return radar_detected;
}
#ifdef DFS_DEBUG
else if (PeriodMatched == 2)
{
pDfsSwParam->T_Matched_2++;
/*printk("counter=%d %d\n", pDfsSwParam->CounterStored[0], pDfsSwParam->CounterStored[1]);*/
/*printk("idx[1]=%d, loop =%d %d\n", pDfsSwParam->CounterStored3, pDfsSwParam->CounterStored2[0], pDfsSwParam->CounterStored2[1]);*/
}
#endif
}
}
}
} /* for (idx[1] = p2->start_idx; idx[1] <= p2->end_idx; idx[1]++)*/
} /* for (idx[0] = pCurrent->start_idx; idx[0] <= pCurrent->end_idx; idx[0]++)*/
}
} /* for (i = end_idx; i < start_idx; i--)*/
return radar_detected;
}
/*
==========================================================================
Description:
Recheck DFS radar of stager type.
Arguments:
pAdapter Pointer to our adapter
dfs_channel DFS detect channel
Return Value:
"TRUE" if check pass, "FALSE" otherwise.
Note:
==========================================================================
*/
static BOOLEAN StagerRadarCheck(IN PRTMP_ADAPTER pAd, UINT8 dfs_channel)
{
UINT T1=0, T2=0, T3=0, T_all=0, F1, F2, F3 = 0, Fmax = 0, freq_diff_min, freq_diff_max;
UINT8 dfs_stg2=0, dfs_typ5=0; /*, bbp141=0;*/
UINT F_MAX, F_MID, F_MIN;
DBGPRINT(RT_DEBUG_TRACE, ("--->StagerRadarCheck()\n"));
{
UINT32 bbp_val = 0;
PDFS_PROGRAM_PARAM pDfsProgramParam = &pAd->CommonCfg.RadarDetect.DfsProgramParam;
/* select channel */
bbp_val = (pDfsProgramParam->ChEnable << 16) | dfs_channel;
RTMP_BBP_IO_WRITE32(pAd, DFS_R0, bbp_val);
RTMP_BBP_IO_READ32(pAd, DFS_R19, &T_all);
RTMP_BBP_IO_READ32(pAd, DFS_R22, &T1);
RTMP_BBP_IO_READ32(pAd, DFS_R25, &T2);
}
T3 = T_all - T1 -T2;
if (T3 < 5)
T3 = 0;
/*1. Check radar stagger2 or stagger3*/
if (T3 == 0 || ((T3 > (T1 + T2) ? (T3 - T1 - T2) : (T1 + T2 - T3)) < 25))
{
DBGPRINT(RT_DEBUG_TRACE, ("stg2 confirmed\n"));
dfs_stg2 =1;
F1 = 20000000/T1; /*hz*/
F2 = 20000000/T2;
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("stg3 confirmed\n"));
F1 = 20000000/T1; /*hz*/
F2 = 20000000/T2;
F3 = 20000000/T3;
}
F_MAX = (F1 > F2) ? ( (F1 > F3) ? F1 : F3 ) : ( (F2 > F3) ? F2 : F3 );
F_MIN = (F1 < F2) ? ( (F1 < F3) ? F1 : F3 ) : ( (F2 < F3) ? F2 : F3 );
F_MID = (F1 > F2) ? ((F1 < F3) ? F1 : ( (F2 > F3) ? F2 : F3 )) : ( F2 < F3 ? F2 : ((F1 > F3) ? F1 :F3) );
DBGPRINT(RT_DEBUG_TRACE, ("F_MAX=%d F_MID=%d F_MIN=%d\n", F_MAX, F_MID, F_MIN));
F1 = F_MAX;
F2 = F_MID;
F3 = F_MIN;
Fmax = F1;
/*2. Check radar type 5 or type6*/
if (Fmax>295 && Fmax<=405)
{
dfs_typ5 = 1;
DBGPRINT(RT_DEBUG_TRACE, ("type5 confirmed\n"));
freq_diff_min = 20;
freq_diff_max = 50;
}
else if (Fmax>405 && Fmax<=1205) /* tolerate more range for looser type6 */
{
DBGPRINT(RT_DEBUG_TRACE, ("type6 confirmed\n"));
freq_diff_min = 80;
freq_diff_max = 400;
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("StagerRadarCheck failed, T1=%d, T2=%d, T3=%d\n", T1, T2, T3));
return FALSE;
}
/*3. According to decision of stagger and type do period check */
if (dfs_stg2 == 1)
{
UINT freq_diff = (F1 - F2);
DBGPRINT(RT_DEBUG_TRACE, ("StagerRadarCheck freq_diff_min=%d freq_diff_max=%d \n", freq_diff_min, freq_diff_max));
DBGPRINT(RT_DEBUG_TRACE, ("StagerRadarCheck dfs_stg2, dff=%d \n", freq_diff));
if ((freq_diff >= freq_diff_min) && (freq_diff <= freq_diff_max))
return TRUE; /* S/W check success */
else
{
DBGPRINT(RT_DEBUG_TRACE, ("StagerRadarCheck failed, F1=%d, F2=%d\n", F1, F2));
DBGPRINT(RT_DEBUG_TRACE, ("stg2 fail on S/W Freq confirmed\n"));
return FALSE; /* S/W check fail */
}
}
else /* dfs_stg3 */
{
UINT freq_diff_1 = (F1 - F2);
UINT freq_diff_2 = (F2 - F3);
DBGPRINT(RT_DEBUG_TRACE, ("StagerRadarCheck freq_diff_min=%d freq_diff_max=%d \n", freq_diff_min, freq_diff_max));
DBGPRINT(RT_DEBUG_TRACE, ("StagerRadarCheck dfs_stg3, dff_1=%d, dff_2=%d \n", freq_diff_1, freq_diff_2));
if( (freq_diff_1 >= freq_diff_min) && (freq_diff_1 <= freq_diff_max) && (freq_diff_2 >= freq_diff_min) && (freq_diff_2 <= freq_diff_max) )
return TRUE; /* S/W check success */
else
{
DBGPRINT(RT_DEBUG_TRACE, ("StagerRadarCheck failed, F1=%d, F2=%d, F3=%d\n", F1, F2, F3));
DBGPRINT(RT_DEBUG_TRACE, ("stg3 fail on S/W Freq confirmed\n"));
return FALSE; /* S/W check fail */
}
}
DBGPRINT(RT_DEBUG_TRACE, ("<---StagerRadarCheck()\n"));
}
/*
==========================================================================
Description:
Recheck DFS radar of chrp type.
Arguments:
pAdapter Pointer to our adapter
dfs_channel DFS detect channel
Return Value:
"TRUE" if check pass, "FALSE" otherwise.
Note:
==========================================================================
*/
static BOOLEAN ChirpRadarCheck(IN PRTMP_ADAPTER pAd)
{
UINT32 CurrentTime, delta;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
RTMP_IO_READ32(pAd, PBF_LIFE_TIMER, &CurrentTime);
delta = CurrentTime - pRadarDetect->TimeStamp;
pRadarDetect->TimeStamp = CurrentTime;
/* ChirpCheck = 0 means the very first detection since start up*/
if (pRadarDetect->ChirpCheck++ == 0)
return FALSE;
if (delta <= (12*(1<<20))) /* 12 sec */
{
if (pRadarDetect->ChirpCheck >= 2)
{
/* Anouce the radar on any mutiple detection within 12 sec*/
DBGPRINT(RT_DEBUG_TRACE, ("ChirpRadarCheck OK.\n"));
return TRUE;
}
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("ChirpRadarCheck failed, discard previous detection.\n"));
pRadarDetect->ChirpCheck = 1;
return FALSE;
}
/* default */
return FALSE;
}
static VOID DfsCheckBusyIdle(
IN PRTMP_ADAPTER pAd)
{
int busy_delta, idle_delta;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
RTMP_IO_READ32(pAd, CH_IDLE_STA, &pRadarDetect->idle_time);
RTMP_IO_READ32(pAd, CH_BUSY_STA, &pRadarDetect->busy_time);
/*ch_busy_sta_index begining at 0.*/
busy_delta = pRadarDetect->busy_time - pRadarDetect->ch_busy_sta[pRadarDetect->ch_busy_sta_index];
idle_delta = pRadarDetect->idle_time - pRadarDetect->ch_idle_sta[pRadarDetect->ch_busy_sta_index];
if (busy_delta < 0)
{
busy_delta = ~busy_delta;
busy_delta = (busy_delta >> CH_BUSY_SAMPLE_POWER);
busy_delta = ~busy_delta;
}
else
busy_delta = busy_delta >> CH_BUSY_SAMPLE_POWER;
if (idle_delta < 0)
{
idle_delta = ~idle_delta;
idle_delta = idle_delta >> CH_BUSY_SAMPLE_POWER;
idle_delta = ~idle_delta;
}
else
idle_delta = idle_delta >> CH_BUSY_SAMPLE_POWER;
pRadarDetect->ch_busy_sum += busy_delta;
pRadarDetect->ch_idle_sum += idle_delta;
/* not sure if this is necessary??*/
if (pRadarDetect->ch_busy_sum < 0)
pRadarDetect->ch_busy_sum = 0;
if (pRadarDetect->ch_idle_sum < 0)
pRadarDetect->ch_idle_sum = 0;
pRadarDetect->ch_busy_sta[pRadarDetect->ch_busy_sta_index] = pRadarDetect->busy_time;
pRadarDetect->ch_idle_sta[pRadarDetect->ch_busy_sta_index] = pRadarDetect->idle_time;
pRadarDetect->ch_busy_sta_index++;
pRadarDetect->ch_busy_sta_index &= CH_BUSY_MASK;
if ((pRadarDetect->ch_idle_sum >> pRadarDetect->ch_busy_idle_ratio) < pRadarDetect->ch_busy_sum )
{
if (!(pRadarDetect->McuRadarDebug & RADAR_DEBUG_DONT_CHECK_BUSY))
pRadarDetect->ch_busy = 1;
}
else
{
if (!(pRadarDetect->McuRadarDebug & RADAR_DEBUG_DONT_CHECK_RSSI))
{
if ((pAd->ApCfg.RssiSample.AvgRssi0) && (pAd->ApCfg.RssiSample.AvgRssi0 > pRadarDetect->DfsRssiHigh))
pRadarDetect->ch_busy = 2;
else if ((pAd->ApCfg.RssiSample.AvgRssi0) && (pAd->ApCfg.RssiSample.AvgRssi0 < pRadarDetect->DfsRssiLow))
pRadarDetect->ch_busy = 3;
else
pRadarDetect->ch_busy = 0;
}
}
if (pRadarDetect->print_ch_busy_sta)
DBGPRINT(RT_DEBUG_TRACE,
("%d %d %d %d\n", pRadarDetect->ch_idle_sum, pRadarDetect->ch_busy_sum, pAd->ApCfg.RssiSample.AvgRssi0, pRadarDetect->ch_busy));
}
static BOOLEAN DfsChannelCheck(
IN PRTMP_ADAPTER pAd,
IN UINT8 DfsChannel)
{
pNewDFSTable pDFS2Table;
UINT8 i;
UINT32 W, T;
BOOLEAN radarDeclared = 0;
/*UCHAR BBP_1 = 0, BBP_2 = 0, BBP_3 = 0, BBP_4 = 0;*/
DBGPRINT(RT_DEBUG_TRACE, ("DFS HW check channel = 0x%x\n", DfsChannel));
/*Select the DFS table based on radar country region*/
if (pAd->CommonCfg.RDDurRegion == FCC)
pDFS2Table = &NewDFSTable1[0];
else if (pAd->CommonCfg.RDDurRegion == CE)
{
pDFS2Table = &NewDFSTable1[1];
}
else /* Japan*/
{
if ((pAd->CommonCfg.Channel >= 52) && (pAd->CommonCfg.Channel <= 64))
{
pDFS2Table = &NewDFSTable1[3];
}
else
{
pDFS2Table = &NewDFSTable1[2];
}
}
/*check which channe(0~3) is detecting radar signals*/
for (i = 0; i < pAd->chipCap.DfsEngineNum; i++)
{
if (DfsChannel & (0x1 << i))
{
UINT32 bbp_val = 0;
PDFS_PROGRAM_PARAM pDfsProgramParam = &pAd->CommonCfg.RadarDetect.DfsProgramParam;
/* select channel */
bbp_val = (pDfsProgramParam->ChEnable << 16) | i;
RTMP_BBP_IO_WRITE32(pAd, DFS_R0, bbp_val);
RTMP_BBP_IO_READ32(pAd, DFS_R19, &T);
RTMP_BBP_IO_READ32(pAd, DFS_R20, &W);
if (DfsSwCheckOnHwDetection(pAd, pDFS2Table, i, T, W) == FALSE)
continue;
printk("T = %u, W= %u detected by ch %d\n", T, W, i);
RTMP_BBP_IO_READ32(pAd, 0x2a70, &bbp_val);
printk("bbp 0x2a70 = 0x%08x\n", bbp_val);
/*set this variable to 1 for announcing that we find the radar signals.*/
radarDeclared = 1;
if ( ((i == 3) || (i == 2)) && (pDFS2Table->entry[i].mode != 0) )
{
ULONG B, W2;
RTMP_BBP_IO_READ32(pAd, DFS_R22, &B);
DBGPRINT(RT_DEBUG_TRACE, ("Burst = %lu(0x%lx)\n", B, B));
RTMP_BBP_IO_READ32(pAd, DFS_R23, &W2);
DBGPRINT(RT_DEBUG_TRACE, ("The second Width = %lu(0x%lx)\n", W2, W2));
}
}
}
return radarDeclared;
}
static BOOLEAN DfsEventDataFetch(
IN PRTMP_ADAPTER pAd,
IN PUCHAR pData,
OUT PDFS_EVENT pDfsEvent)
{
pDfsEvent->EngineId = pData[0];
if (pDfsEvent->EngineId == 0xff) /* end of event */
return FALSE;
pDfsEvent->TimeStamp = pData[1];
pDfsEvent->TimeStamp |= (pData[2] << 8);
pDfsEvent->TimeStamp |= (pData[3] << 16);
pDfsEvent->Width = pData[4];
pDfsEvent->Width |= (pData[5] << 8);
/* Check if event is valid */
if (!DFS_EVENT_SANITY_CHECK(pAd, *pDfsEvent))
return FALSE;
return TRUE;
}
VOID NewRadarDetectionProgram(PRTMP_ADAPTER pAd, pNewDFSTable pDFS2Table)
{
UINT8 idx, TalbeIdx, DFSR3;
UINT8 DfsEngineNum = pAd->chipCap.DfsEngineNum;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
PDFS_PROGRAM_PARAM pDfsProgramParam = &pRadarDetect->DfsProgramParam;
pRadarDetect->bDfsInit = FALSE;
/* Get Table index*/
for (TalbeIdx = 0; !((1<<TalbeIdx) & pDFS2Table->type); TalbeIdx++)
{
if (TalbeIdx > MAX_RD_REGION)
{
DBGPRINT(RT_DEBUG_ERROR, ("Table index out of range.\n"));
return;
}
}
for(idx = 0; idx<DfsEngineNum; idx++)
{
if ((pRadarDetect->DFSParamFromConfig & (0x1<<idx)) && pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].valid)
{
pDFS2Table->entry[idx].mode = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].mode;
pDFS2Table->entry[idx].avgLen = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].avgLen;
pDFS2Table->entry[idx].ELow = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].ELow;
pDFS2Table->entry[idx].EHigh = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].EHigh;
pDFS2Table->entry[idx].WLow = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].WLow;
pDFS2Table->entry[idx].WHigh = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].WHigh;
pDFS2Table->entry[idx].EpsilonW = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].EpsilonW;
pDFS2Table->entry[idx].TLow = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].TLow;
pDFS2Table->entry[idx].THigh = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].THigh;
pDFS2Table->entry[idx].EpsilonT = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].EpsilonT;
pDFS2Table->entry[idx].BLow = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].BLow;
pDFS2Table->entry[idx].BHigh = pDfsProgramParam->NewDFSTableEntry[(TalbeIdx*DfsEngineNum)+idx].BHigh;
DBGPRINT(RT_DEBUG_TRACE, ("TalbeIdx = %d; idx = %d; DFSParam = %2d; %3d; %3d; %3d; %3d; %4d; %3d; %6lu; %7lu; %4d; %2lu; %2lu\n", TalbeIdx, idx,
pDFS2Table->entry[idx].mode, pDFS2Table->entry[idx].avgLen, pDFS2Table->entry[idx].ELow,
pDFS2Table->entry[idx].EHigh, pDFS2Table->entry[idx].WLow, pDFS2Table->entry[idx].WHigh,
pDFS2Table->entry[idx].EpsilonW, pDFS2Table->entry[idx].TLow, pDFS2Table->entry[idx].THigh,
pDFS2Table->entry[idx].EpsilonT, pDFS2Table->entry[idx].BLow, pDFS2Table->entry[idx].BHigh));
}
}
/* Symmetric round*/
if(pRadarDetect->SymRoundFromCfg != 0)
{
pDfsProgramParam->Symmetric_Round = pRadarDetect->SymRoundFromCfg;
DBGPRINT(RT_DEBUG_TRACE, ("Symmetric_Round = %d\n", pDfsProgramParam->Symmetric_Round));
}
/* BusyIdleRatio*/
if(pRadarDetect->BusyIdleFromCfg != 0)
{
pRadarDetect->ch_busy_idle_ratio = pRadarDetect->BusyIdleFromCfg;
DBGPRINT(RT_DEBUG_TRACE, ("ch_busy_idle_ratio = %d\n", pRadarDetect->ch_busy_idle_ratio));
}
/* DfsRssiHigh*/
if(pRadarDetect->DfsRssiHighFromCfg != 0)
{
pRadarDetect->DfsRssiHigh = pRadarDetect->DfsRssiHighFromCfg;
DBGPRINT(RT_DEBUG_TRACE, ("DfsRssiHigh = %d\n", pRadarDetect->DfsRssiHigh));
}
/* DfsRssiLow*/
if(pRadarDetect->DfsRssiLowFromCfg != 0)
{
pRadarDetect->DfsRssiLow = pRadarDetect->DfsRssiLowFromCfg;
DBGPRINT(RT_DEBUG_TRACE, ("DfsRssiLow = %d\n", pRadarDetect->DfsRssiLow));
}
/*pRadarDetect->MCURadarRegion = pAd->CommonCfg.RDDurRegion;*/
pRadarDetect->MCURadarRegion = pDFS2Table->type;
{
UINT32 bbp_val = 0;
DFSR3 = pDfsProgramParam->Symmetric_Round << 4;
/* Full 40Mhz*/
if (pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40)
DFSR3 |= 0x80; /* BW 40*/
/* Delta Delay*/
DFSR3 |= (pDfsProgramParam->DeltaDelay & 0xf);
DBGPRINT(RT_DEBUG_TRACE,("R3 = 0x%x\n", DFSR3));
/* VGA Mask*/
DBGPRINT(RT_DEBUG_TRACE,("VGA_Mask = 0x%x\n", pDfsProgramParam->VGA_Mask));
/* Input Control 0 */
bbp_val = (pDfsProgramParam->VGA_Mask << 16) | (DFSR3);
RTMP_BBP_IO_WRITE32(pAd, DFS_R2, bbp_val);
/* packet end Mask*/
DBGPRINT(RT_DEBUG_TRACE,("Packet_End_Mask = 0x%x\n", pDfsProgramParam->Packet_End_Mask));
/* Rx PE Mask*/
DBGPRINT(RT_DEBUG_TRACE,("Rx_PE_Mask = 0x%x\n", pDfsProgramParam->Rx_PE_Mask));
/* Input Control 1 */
bbp_val = (pDfsProgramParam->Rx_PE_Mask << 16) | (pDfsProgramParam->Packet_End_Mask);
RTMP_BBP_IO_WRITE32(pAd, DFS_R3, bbp_val);
/* program each channel*/
for (idx = 0; idx < DfsEngineNum; idx++)
{
/* select channel*/
RTMP_BBP_IO_WRITE32(pAd, DFS_R0, idx);
DBGPRINT(RT_DEBUG_TRACE, ("write DFS Channle[%d] configuration \n", idx));
/* Detection Mode */
bbp_val = (pDFS2Table->entry[idx].mode & 0xf);
if (pAd->chipCap.DfsEngineNum > 4 && (idx==4 || idx==5))
bbp_val |= ((pDFS2Table->entry[idx].avgLen & 0x3) << 28);
else
bbp_val |= ((pDFS2Table->entry[idx].avgLen & 0x1ff) << 16);
/* DFS Mode */
RTMP_BBP_IO_WRITE32(pAd, DFS_R4, bbp_val);
/* DFS Energy */
bbp_val = ((pDFS2Table->entry[idx].EHigh & 0x0fff) << 16) | (pDFS2Table->entry[idx].ELow & 0x0fff);
RTMP_BBP_IO_WRITE32(pAd, DFS_R5, bbp_val);
/* DFS Period Low */
RTMP_BBP_IO_WRITE32(pAd, DFS_R7, pDFS2Table->entry[idx].TLow);
/* DFS Period High */
RTMP_BBP_IO_WRITE32(pAd, DFS_R9, pDFS2Table->entry[idx].THigh);
/* DFS Burst Low */
/* DFS Burst High */
/* DFS Width */
bbp_val = ((pDFS2Table->entry[idx].WHigh & 0x0fff) << 16) | (pDFS2Table->entry[idx].WLow & 0x0fff);
RTMP_BBP_IO_WRITE32(pAd, DFS_R14, bbp_val);
/* DFS Measurement Uncertainty */
bbp_val = (pDFS2Table->entry[idx].EpsilonW << 16) | (pDFS2Table->entry[idx].EpsilonT);
RTMP_BBP_IO_WRITE32(pAd, DFS_R15, bbp_val);
/* DFS Event Expiration */
if (pDfsProgramParam->RadarEventExpire[idx] != 0)
RTMP_BBP_IO_WRITE32(pAd, DFS_R17, pDfsProgramParam->RadarEventExpire[idx]);
}
/* Reset status */
RTMP_BBP_IO_WRITE32(pAd, DFS_R1, pRadarDetect->EnabledChMask);
/* Enable detection*/
bbp_val = (pDfsProgramParam->ChEnable << 16);
RTMP_BBP_IO_WRITE32(pAd, DFS_R0, bbp_val);
}
pRadarDetect->bDfsInit = TRUE;
}
BOOLEAN DfsSwCheckOnHwDetection(
IN PRTMP_ADAPTER pAd,
IN pNewDFSTable pDFS2Table,
IN UINT8 DfsChannel,
IN ULONG RadarPeriod,
IN ULONG RadarWidth)
{
BOOLEAN bRadarCheck = TRUE;
if (!RadarPeriod || !RadarWidth)
{
DBGPRINT(RT_DEBUG_TRACE, ("Block eception on zero RadarPeriod or RadarWidth\n"));
return FALSE;
}
if (pDFS2Table->type == NEW_DFS_JAP)
{
/* Double check on pusle Width and Period*/
if (DfsChannel < 3)
{
/*check short pulse*/
if (RadarWidth < 375)
{
/* block the illegal period */
if ((RadarPeriod < 2800) ||
(RadarPeriod > 5000 && RadarPeriod < 6400) ||
(RadarPeriod > 6800 && RadarPeriod < 27560)||
(RadarPeriod > 27960 && RadarPeriod < 28360) ||
(RadarPeriod > 28700 && RadarPeriod < 79900) ||
(RadarPeriod > 80100))
{
/*(0~140), (250~320us), (340~1378us), (1398~1418), (1435~3995us) and (4005us~) according to the spec*/
DBGPRINT(RT_DEBUG_TRACE,
("Radar check: ch=%u, T=%lu, W=%lu, blocked\n", DfsChannel, RadarPeriod, RadarWidth));
bRadarCheck = FALSE;
}
}
else if (RadarWidth > 375)
{
if ((RadarPeriod<3500) || (RadarPeriod>10400))
{
/* block the illegal period */
/*(0~175) and (520us~) according to the spec*/
DBGPRINT(RT_DEBUG_TRACE,
("Radar check: ch=%u, T=%lu, W=%lu, blocked\n", DfsChannel, RadarPeriod, RadarWidth));
bRadarCheck = FALSE;
}
}
}
else if (DfsChannel == 3)
{
bRadarCheck = ChirpRadarCheck(pAd);
}
}
else if (pDFS2Table->type == NEW_DFS_EU)
{
if (DfsChannel == 4) /* to do: check dfs mode 8or9*/
{
if (StagerRadarCheck(pAd, DfsChannel) == FALSE)
bRadarCheck = FALSE;
}
}
return bRadarCheck;
}
static VOID ChannelSelectOnRadarDetection(
IN PRTMP_ADAPTER pAd)
{
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
UINT i;
if (pAd->Dot11_H.RDMode == RD_SWITCHING_MODE)
return;
for (i=0; i<pAd->ChannelListNum; i++)
{
if (pAd->CommonCfg.Channel == pAd->ChannelList[i].Channel)
{
if (pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40)
{
if ((pAd->ChannelList[i].Channel >> 2) & 1)
{
if ((pAd->ChannelList[i+1].Channel - pAd->ChannelList[i].Channel) == 4 )
{
DBGPRINT(RT_DEBUG_TRACE, ("Find extend channel = %u\n", pAd->ChannelList[i+1].Channel));
pAd->ChannelList[i+1].RemainingTimeForUse = 1800;
}
}
else
{
if ((pAd->ChannelList[i].Channel - pAd->ChannelList[i-1].Channel) == 4 )
{
DBGPRINT(RT_DEBUG_TRACE, ("Find extend channel = %u\n", pAd->ChannelList[i-1].Channel));
pAd->ChannelList[i-1].RemainingTimeForUse = 1800;
}
}
}
else
DBGPRINT(RT_DEBUG_TRACE, ("BW is not 40.\n"));
pAd->ChannelList[i].RemainingTimeForUse = 1800;/*30 min = 1800 sec*/
break;
}
}
/*when find an radar, the ChMovingTime will be set to announce how many seconds to sending software radar detection time.*/
if ((pAd->CommonCfg.RDDurRegion == CE) && RESTRICTION_BAND_1(pAd))
pAd->Dot11_H.ChMovingTime = 605;
else
pAd->Dot11_H.ChMovingTime = 65;
/*if the Radar country region is JAP, we need find a new clear channel */
if (pAd->CommonCfg.RDDurRegion == JAP_W56)
{
for (i = 0; i < pAd->ChannelListNum ; i++)
{
pAd->CommonCfg.Channel = APAutoSelectChannel(pAd, FALSE);
if ((pAd->CommonCfg.Channel >= 100) && (pAd->CommonCfg.Channel <= 140))
break;
}
}
else if (pAd->CommonCfg.RDDurRegion == JAP_W53)
{
for (i = 0; i < pAd->ChannelListNum ; i++)
{
pAd->CommonCfg.Channel = APAutoSelectChannel(pAd, FALSE);
if ((pAd->CommonCfg.Channel >= 36) && (pAd->CommonCfg.Channel <= 60))
break;
}
}
else
pAd->CommonCfg.Channel = APAutoSelectChannel(pAd, FALSE);
#ifdef DOT11_N_SUPPORT
N_ChannelCheck(pAd);
#endif /* DOT11_N_SUPPORT */
/*ApSelectChannelCheck(pAd);*/
if (pAd->Dot11_H.RDMode == RD_NORMAL_MODE)
{
pAd->Dot11_H.RDMode = RD_SWITCHING_MODE;
/* Prepare a count-down for channel switching */
pAd->Dot11_H.CSCount = 0;
}
else if (pAd->Dot11_H.RDMode == RD_SILENCE_MODE)
{
pAd->Dot11_H.RDMode = RD_SWITCHING_MODE;
/*set this flag to 1 and the AP will restart to switch into new channel */
pRadarDetect->DFSAPRestart = 1;
schedule_dfs_task(pAd);
}
else
{
DBGPRINT(RT_DEBUG_ERROR, ("%s(): Error! Unexpected radar state.\n", __FUNCTION__));
}
pRadarDetect->radarDeclared = 0;
}
static BOOLEAN DfsEventDrop(
IN PRTMP_ADAPTER pAd,
IN PDFS_EVENT pDfsEvent)
{
UINT32 TimeDiff = 0; /* unit: 50ns */
UINT16 PreEnvtWidth = 0;
BOOLEAN RetVal = FALSE;
PDFS_SW_DETECT_PARAM pDfsSwParam = &pAd->CommonCfg.RadarDetect.DfsSwParam;
PDFS_EVENT pPreDfsEvent = &pDfsSwParam->PreDfsEvent;
if (pDfsEvent->EngineId != pPreDfsEvent->EngineId)
{
/* update prevoius event record then leave */
NdisCopyMemory(pPreDfsEvent, pDfsEvent, DFS_EVENT_SIZE);
return FALSE;
}
if (pDfsEvent->EngineId == 0x01 || pDfsEvent->EngineId == 0x02)
{
if (pAd->CommonCfg.HtCapability.HtCapInfo.ChannelWidth == BW_40)
{
TimeDiff = ((pDfsEvent->TimeStamp - pPreDfsEvent->TimeStamp) >> 1); /* 25ns to 50ns*/
PreEnvtWidth = pPreDfsEvent->Width >> 1;
}
else
{
TimeDiff = (pDfsEvent->TimeStamp - pPreDfsEvent->TimeStamp);
PreEnvtWidth = pPreDfsEvent->Width;
}
if (TimeDiff < pDfsSwParam->EvtDropAdjTime &&
PreEnvtWidth >= 200)
{
DBGPRINT(RT_DEBUG_TRACE,
("%s(): EngineId = %x, Width = %u, TimeStamp = %u\n",
__FUNCTION__,
pDfsEvent->EngineId,
pDfsEvent->Width,
pDfsEvent->TimeStamp));
RetVal = TRUE;
}
}
/* update prevoius event record */
NdisCopyMemory(pPreDfsEvent, pDfsEvent, DFS_EVENT_SIZE);
return RetVal;
}
static void dfs_sw_init(PRTMP_ADAPTER pAd)
{
int j, k;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
PDFS_SW_DETECT_PARAM pDfsSwParam = &pRadarDetect->DfsSwParam;
pDfsSwParam->fcc_5_threshold = 1000;
pDfsSwParam->fcc_5_idx = 0;
pDfsSwParam->fcc_5_last_idx = 0;
pDfsSwParam->dfs_check_loop = DFS_SW_RADAR_CHECK_LOOP;
pDfsSwParam->dfs_width_diff_ch1_Shift = DFS_SW_RADAR_CH1_SHIFT;
pDfsSwParam->dfs_width_diff_ch2_Shift = DFS_SW_RADAR_CH2_SHIFT;
pDfsSwParam->PreDfsEvent.EngineId = 0xff;
pDfsSwParam->EvtDropAdjTime = 2000;
/* clear long pulse table */
pDfsSwParam->FCC_5[pDfsSwParam->fcc_5_idx].counter = 0;
pDfsSwParam->fcc_5_idx = 0;
pDfsSwParam->fcc_5_last_idx = 0;
/*pDfsSwParam->dfs_width_diff_Shift = DFS_SW_RADAR_SHIFT;*/
pDfsSwParam->dfs_width_ch0_err_L = DFS_SW_RADAR_CH0_ERR;
if (pAd->CommonCfg.RDDurRegion == CE)
pDfsSwParam->dfs_period_err = (DFS_SW_RADAR_PERIOD_ERR << 2);
else
pDfsSwParam->dfs_period_err = DFS_SW_RADAR_PERIOD_ERR;
if (pAd->CommonCfg.RDDurRegion == CE)
{
pDfsSwParam->dfs_width_ch0_err_H = CE_STAGGERED_RADAR_CH0_H_ERR;
pDfsSwParam->dfs_declare_thres = CE_STAGGERED_RADAR_DECLARE_THRES;
pDfsSwParam->dfs_max_period = CE_STAGGERED_RADAR_PERIOD_MAX;
}
else
{
/*pDfsSwParam->dfs_declare_thres = DFS_SW_RADAR_DECLARE_THRES;*/
if (pAd->CommonCfg.RDDurRegion == FCC)
pDfsSwParam->dfs_max_period = FCC_RADAR_PERIOD_MAX;
else if (pAd->CommonCfg.RDDurRegion == JAP)
pDfsSwParam->dfs_max_period = JAP_RADAR_PERIOD_MAX;
}
pDfsSwParam->dfs_check_loop = DFS_SW_RADAR_CHECK_LOOP;
pDfsSwParam->dfs_width_diff_ch1_Shift = DFS_SW_RADAR_CH1_SHIFT;
pDfsSwParam->dfs_width_diff_ch2_Shift = DFS_SW_RADAR_CH2_SHIFT;
pDfsSwParam->dfs_width_ch0_err_L = DFS_SW_RADAR_CH0_ERR;
if (pAd->CommonCfg.RDDurRegion == CE)
pDfsSwParam->dfs_period_err = (DFS_SW_RADAR_PERIOD_ERR << 2);
else
pDfsSwParam->dfs_period_err = DFS_SW_RADAR_PERIOD_ERR;
if (pAd->CommonCfg.RDDurRegion == CE)
{
pDfsSwParam->dfs_width_ch0_err_H = CE_STAGGERED_RADAR_CH0_H_ERR;
pDfsSwParam->dfs_declare_thres = CE_STAGGERED_RADAR_DECLARE_THRES;
pDfsSwParam->dfs_max_period = CE_STAGGERED_RADAR_PERIOD_MAX;
}
else
{
/*pDfsSwParam->dfs_declare_thres = DFS_SW_RADAR_DECLARE_THRES;*/
if (pAd->CommonCfg.RDDurRegion == FCC)
pDfsSwParam->dfs_max_period = FCC_RADAR_PERIOD_MAX;
else if (pAd->CommonCfg.RDDurRegion == JAP)
pDfsSwParam->dfs_max_period = JAP_RADAR_PERIOD_MAX;
}
if (pRadarDetect->use_tasklet)
pRadarDetect->PollTime = NEW_DFS_CHECK_TIME_TASKLET;
else
pRadarDetect->PollTime = NEW_DFS_CHECK_TIME;
for (k = 0; k < pAd->chipCap.DfsEngineNum; k++)
{
for (j = 0; j < NEW_DFS_DBG_PORT_ENT_NUM; j++)
{
pDfsSwParam->DFS_W[k][j].start_idx = 0xffff;
}
}
for (k = 0; k < pAd->chipCap.DfsEngineNum; k++)
{
pDfsSwParam->sw_idx[k] = NEW_DFS_DBG_PORT_ENT_NUM - 1;
pDfsSwParam->hw_idx[k] = 0;
}
NdisZeroMemory(pDfsSwParam->DFS_T, sizeof(pDfsSwParam->DFS_T));
NdisZeroMemory(pDfsSwParam->DFS_W, sizeof(pDfsSwParam->DFS_W));
}
void modify_table1(PRTMP_ADAPTER pAd, ULONG idx, ULONG value)
{
pNewDFSTable pDFS2Table;
ULONG x, y;
UINT8 DfsEngineNum = pAd->chipCap.DfsEngineNum;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
PDFS_PROGRAM_PARAM pDfsProgramParam = &pRadarDetect->DfsProgramParam;
if (pAd->CommonCfg.RDDurRegion == FCC)
pDFS2Table = &NewDFSTable1[0];
else if (pAd->CommonCfg.RDDurRegion == CE)
{
pDFS2Table = &NewDFSTable1[1];
}
else /* Japan*/
{
if ((pAd->CommonCfg.Channel >= 52) && (pAd->CommonCfg.Channel <= 64))
{
pDFS2Table = &NewDFSTable1[3];
}
else
{
pDFS2Table = &NewDFSTable1[2];
}
}
if (idx == 0)
{
pDfsProgramParam->DeltaDelay = value;
}
else if (idx <= (DfsEngineNum*16))
{
x = idx / 16;
y = idx % 16;
pRadarDetect->DFSParamFromConfig = 0; /* to prevent table be loaded from config file again */
switch (y)
{
case 1:
pDFS2Table->entry[x].mode = (USHORT)value;
break;
case 2:
pDFS2Table->entry[x].avgLen = (USHORT)value;
break;
case 3:
pDFS2Table->entry[x].ELow = (USHORT)value;
break;
case 4:
pDFS2Table->entry[x].EHigh = (USHORT)value;
break;
case 5:
pDFS2Table->entry[x].WLow = (USHORT)value;
break;
case 6:
pDFS2Table->entry[x].WHigh = (USHORT)value;
break;
case 7:
pDFS2Table->entry[x].EpsilonW = (USHORT)value;
break;
case 8:
pDFS2Table->entry[x].TLow = (ULONG)value;
break;
case 9:
pDFS2Table->entry[x].THigh = (ULONG)value;
break;
case 0xa:
pDFS2Table->entry[x].EpsilonT = (USHORT)value;
break;
case 0xb:
pDFS2Table->entry[x].BLow= (USHORT)value;
break;
case 0xc:
pDFS2Table->entry[x].BHigh = (USHORT)value;
break;
default:
break;
}
}
else if (idx == (DfsEngineNum*16 +1))
{
pDfsProgramParam->Symmetric_Round = (ULONG)value;
}
else if (idx == (DfsEngineNum*16 +2))
{
pDfsProgramParam->VGA_Mask = (ULONG)value;
}
else if (idx == (DfsEngineNum*16 +3))
{
pDfsProgramParam->Packet_End_Mask = (ULONG)value;
}
else if (idx == (DfsEngineNum*16 +4))
{
pDfsProgramParam->Rx_PE_Mask = (ULONG)value;
}
printk("Delta_Delay(0) = %d\n", pDfsProgramParam->DeltaDelay);
for (x = 0; x < DfsEngineNum; x++)
{
printk("Channel %lu\n", x);
printk("\t\tmode(%02lu)=%d, M(%02lu)=%03d, EL(%02lu)=%03d EH(%02lu)=%03d, WL(%02lu)=%03d WH(%02lu)=%04d, eW(%02lu)=%02d\n\t\tTL(%02lu)=%05u TH(%02lu)=%06u, eT(%02lu)=%03d, BL(%02lu)=%u, BH(%02lu)=%u\n",
(x*16+1), (unsigned int)pDFS2Table->entry[x].mode,
(x*16+2), (unsigned int)pDFS2Table->entry[x].avgLen,
(x*16+3), (unsigned int)pDFS2Table->entry[x].ELow,
(x*16+4), (unsigned int)pDFS2Table->entry[x].EHigh,
(x*16+5), (unsigned int)pDFS2Table->entry[x].WLow,
(x*16+6), (unsigned int)pDFS2Table->entry[x].WHigh,
(x*16+7), (unsigned int)pDFS2Table->entry[x].EpsilonW,
(x*16+8), (unsigned int)pDFS2Table->entry[x].TLow,
(x*16+9), (unsigned int)pDFS2Table->entry[x].THigh,
(x*16+0xa), (unsigned int)pDFS2Table->entry[x].EpsilonT,
(x*16+0xb), (unsigned int)pDFS2Table->entry[x].BLow,
(x*16+0xc), (unsigned int)pDFS2Table->entry[x].BHigh);
}
printk("Symmetric_Round(%02d) = %d\n", (DfsEngineNum*16 +1), pDfsProgramParam->Symmetric_Round);
printk("VGA_Mask(%02d) = %d\n", (DfsEngineNum*16 +2), pDfsProgramParam->VGA_Mask);
printk("Packet_End_Mask(%02d) = %d\n", (DfsEngineNum*16 +3), pDfsProgramParam->Packet_End_Mask);
printk("Rx_PE_Mask(%02d) = %d\n", (DfsEngineNum*16 +4), pDfsProgramParam->Rx_PE_Mask);
}
void modify_table2(PRTMP_ADAPTER pAd, ULONG idx, ULONG value)
{
pNewDFSValidRadar pDFSValidRadar;
ULONG x, y;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
idx--;
x = idx / 17;
y = idx % 17;
pDFSValidRadar = &NewDFSValidTable[0];
while (pDFSValidRadar->type != NEW_DFS_END)
{
if (pDFSValidRadar->type & pRadarDetect->MCURadarRegion)
{
if (x == 0)
break;
else
{
x--;
pDFSValidRadar++;
}
}
else
pDFSValidRadar++;
}
if (pDFSValidRadar->type == NEW_DFS_END)
{
printk("idx=%d exceed max number\n", (unsigned int)idx);
return;
}
switch(y)
{
case 0:
pDFSValidRadar->channel = value;
break;
case 1:
pDFSValidRadar->WLow = value;
break;
case 2:
pDFSValidRadar->WHigh = value;
break;
case 3:
pDFSValidRadar->W = value;
break;
case 8:
pDFSValidRadar->WMargin = value;
break;
case 9:
pDFSValidRadar->TLow = value;
break;
case 10:
pDFSValidRadar->THigh = value;
break;
case 11:
pDFSValidRadar->T = value;
break;
case 16:
pDFSValidRadar->TMargin = value;
break;
}
pDFSValidRadar = &NewDFSValidTable[0];
while (pDFSValidRadar->type != NEW_DFS_END)
{
if (pDFSValidRadar->type & pRadarDetect->MCURadarRegion)
{
printk("ch = %x --- ", pDFSValidRadar->channel);
printk("wl:wh = %d:%d ", pDFSValidRadar->WLow, pDFSValidRadar->WHigh);
printk("W = %u --- ", pDFSValidRadar->W);
printk("W Margin = %d\n", pDFSValidRadar->WMargin);
printk("Tl:Th = %d:%d ", (unsigned int)pDFSValidRadar->TLow, (unsigned int)pDFSValidRadar->THigh);
printk("T = %lu --- ", pDFSValidRadar->T);
printk("T Margin = %d\n", pDFSValidRadar->TMargin);
}
pDFSValidRadar++;
}
}
#ifdef RTMP_MAC_USB
VOID NewUsbTimerCB_Radar(
IN PRTMP_ADAPTER pAd)
{
UCHAR channel=0;
UCHAR radarDeclared = 0;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
#ifdef RALINK_ATE
/* Nothing to do in ATE mode */
if (ATE_ON(pAd))
return;
#endif /* RALINK_ATE */
if (!DFS_CHECK_FLAGS(pAd, pRadarDetect) ||
(pRadarDetect->PollTime == 0))
return;
if (pRadarDetect->RadarTimeStampLow++ > 5)
pRadarDetect->RadarTimeStampLow = 0;
/*500ms*/
if ((pRadarDetect->RadarTimeStampLow % 5) == 0)
DfsCheckBusyIdle(pAd);
if (!pRadarDetect->bDfsSwDisable &&
(pRadarDetect->RadarTimeStampLow & 0x1) && /* 200ms */
!pRadarDetect->ch_busy)
SwCheckDfsEventWithFw(pAd);
/*
The following codes is used to check if the hardware find the Radar Signal
Read the 0~3 channel which had detected radar signals
Poll Status register
Set BBP_R140=0x02 and Read BBP_R141 to store at channel
*/
//RTMP_DFS_IO_READ8(pAd, 0x2, &channel);
RTMP_BBP_IO_READ32(pAd, DFS_R1, &channel);
if (channel & pRadarDetect->EnabledChMask)
{
radarDeclared = DfsChannelCheck(pAd, channel & pRadarDetect->EnabledChMask);
}
/* reset the radar channel for new counting */
//RTMP_DFS_IO_WRITE8(pAd, 0x2, channel);
RTMP_BBP_IO_WRITE32(pAd, DFS_R1, channel);
if (pRadarDetect->McuRadarDebug & RADAR_SIMULATE)
{
radarDeclared = 1;
pRadarDetect->McuRadarDebug &= ~RADAR_SIMULATE;
}
/* Now, find an Radar signal */
if (radarDeclared || pRadarDetect->radarDeclared)
{
/*
Radar found!!!
Announce that this channel could not use in 30 minutes if we need find a clear channel
*/
if (!(pRadarDetect->McuRadarDebug & RADAR_DONT_SWITCH))
{
ChannelSelectOnRadarDetection(pAd);
}
else
pRadarDetect->radarDeclared = 0;
}
}
static VOID SwCheckDfsEventWithFw(
IN PRTMP_ADAPTER pAd)
{
int k, NumEvent = 64; /* event number per event buffer */
UCHAR id = 0;
UCHAR BBPR127_Table[DFS_EVENT_BUFFER_SIZE];
UCHAR BBPR127_OWERID;
UCHAR OwenerIDValue = 0;
UCHAR BBP127TableIdx = 0;
DFS_EVENT DfsEvent;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
PDFS_SW_DETECT_PARAM pDfsSwParam = &pRadarDetect->DfsSwParam;
/*pRadarDetect->McuRadarTick = 0;*/
for (BBP127TableIdx = 0; BBP127TableIdx < 6; BBP127TableIdx++)
{
RTUSBMultiRead(pAd, BBPR127TABLE_OWNERID + BBP127TableIdx, &BBPR127_OWERID, 1);
if (BBPR127_OWERID == 1)
continue;
NdisZeroMemory(BBPR127_Table, DFS_EVENT_BUFFER_SIZE);
RTUSBMultiRead(pAd, BBPR127TABLE_OFFSET + (BBP127TableIdx * 512), BBPR127_Table, DFS_EVENT_BUFFER_SIZE);
OwenerIDValue = 0x01;
RTUSBMultiWrite_OneByte(pAd, BBPR127TABLE_OWNERID + BBP127TableIdx, &OwenerIDValue);
pDfsSwParam->dfs_w_counter++;
if (pRadarDetect->McuRadarDebug & RADAR_DEBUG_SHOW_RAW_EVENT)
{
DBGPRINT(RT_DEBUG_TRACE,
("\n=============0x%02x==============\n", BBP127TableIdx));
if (IS_RT3572(pAd))
{
DFS_EVENT_BUFF_PRINT(1, BBPR127_Table, DFS_EVENT_BUFFER_SIZE);
}
else
{
DFS_EVENT_BUFF_PRINT(0, BBPR127_Table, DFS_EVENT_BUFFER_SIZE);
}
}
for (k = 0; k < NumEvent; k++)
{
PUCHAR pTableOffset = NULL;
if (IS_RT3572(pAd))
{
pTableOffset = (BBPR127_Table+1) + (DFS_EVENT_SIZE*k);
}
else
{
pTableOffset = BBPR127_Table + (DFS_EVENT_SIZE*k);
}
if (DfsEventDataFetch(pAd, pTableOffset, &DfsEvent) == FALSE)
break;
if (DfsEventDrop(pAd, &DfsEvent) == TRUE)
continue;
if (pRadarDetect->use_tasklet)
{
id = DfsEvent.EngineId;
if (id < pAd->chipCap.DfsEngineNum)
{
/*if (DfsEvent.TimeStamp != pDfsSwParam->DFS_W[id][((pDfsSwParam->dfs_w_idx[id] == 0)? (NEW_DFS_DBG_PORT_ENT_NUM-1):(pDfsSwParam->dfs_w_idx[id] - 1))].timestamp)*/
{
pDfsSwParam->DFS_W[id][pDfsSwParam->dfs_w_idx[id]].counter = pDfsSwParam->dfs_w_counter;
pDfsSwParam->DFS_W[id][pDfsSwParam->dfs_w_idx[id]].timestamp = DfsEvent.TimeStamp;
pDfsSwParam->DFS_W[id][pDfsSwParam->dfs_w_idx[id]].width = DfsEvent.Width;
if (pRadarDetect->McuRadarDebug & RADAR_DEBUG_EVENT)
{
printk("counter = %lu ", pDfsSwParam->dfs_w_counter);
DFS_EVENT_PRINT(DfsEvent);
}
pDfsSwParam->dfs_w_last_idx[id] = pDfsSwParam->dfs_w_idx[id];
pDfsSwParam->dfs_w_idx[id]++;
if (pDfsSwParam->dfs_w_idx[id] >= NEW_DFS_DBG_PORT_ENT_NUM)
pDfsSwParam->dfs_w_idx[id] = 0;
}
}
}
}
if (pRadarDetect->use_tasklet)
{
/* set hw_idx*/
pDfsSwParam->hw_idx[0] = pDfsSwParam->dfs_w_idx[0];
pDfsSwParam->hw_idx[1] = pDfsSwParam->dfs_w_idx[1];
pDfsSwParam->hw_idx[2] = pDfsSwParam->dfs_w_idx[2];
pDfsSwParam->hw_idx[3] = pDfsSwParam->dfs_w_idx[3];
/*dfs tasklet will call SWRadarCheck*/
schedule_dfs_task(pAd);
}
}
}
void schedule_dfs_task(PRTMP_ADAPTER pAd)
{
POS_COOKIE pObj;
PRADAR_DETECT_STRUCT pRadarDetect = &pAd->CommonCfg.RadarDetect;
PDFS_SW_DETECT_PARAM pDfsSwParam = &pRadarDetect->DfsSwParam;
pObj = (POS_COOKIE) pAd->OS_Cookie;
if (pRadarDetect->DFSAPRestart == 1)
{
int i, j;
pDfsSwParam->dfs_w_counter += 10;
/* reset period table */
for (i = 0; i < pAd->chipCap.DfsEngineNum; i++)
{
for (j = 0; j < NEW_DFS_MPERIOD_ENT_NUM; j++)
{
pDfsSwParam->DFS_T[i][j].period = 0;
pDfsSwParam->DFS_T[i][j].idx = 0;
pDfsSwParam->DFS_T[i][j].idx2 = 0;
}
}
APStop(pAd);
APStartUp(pAd);
RTMP_BBP_IO_WRITE32(pAd, DFS_R0, (pRadarDetect->EnabledChMask << 16)); /* re-enable DFS engine */
//RTMP_DFS_IO_WRITE8(pAd, pRadarDetect->EnabledChMask, 1); /* re-enable DFS engine */
pRadarDetect->DFSAPRestart = 0;
}
else
{
/*s/w check radar event buffer*/
int idx;
if (pRadarDetect->radarDeclared == 0)
{
for (idx = 0; idx < 4; idx++)
{
if (SWRadarCheck(pAd, idx) == 1)
{
//radar signals found
pRadarDetect->radarDeclared = 1;
break;
}
}
}
}
}
#endif /* RTMP_MAC_USB */
#endif /*CONFIG_AP_SUPPORT*/
#endif /* DFS_SUPPORT */
Reference in New Issue View Git Blame Copy Permalink