+++ /dev/null
-/*
- * Copyright (c) 2007-2008 Atheros Communications Inc.
- *
- * Permission to use, copy, modify, and/or distribute this software for any
- * purpose with or without fee is hereby granted, provided that the above
- * copyright notice and this permission notice appear in all copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
- * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
- * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
- * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
- * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
- * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
- */
-
-#include "cprecomp.h"
-
-/* zfAddFreqChangeReq should be called inside the critical section */
-static void zfAddFreqChangeReq(zdev_t* dev, u16_t frequency, u8_t bw40,
- u8_t extOffset, zfpFreqChangeCompleteCb cb)
-{
- zmw_get_wlan_dev(dev);
-
-//printk("zfAddFreqChangeReq freqReqQueueTail%d\n", wd->freqCtrl.freqReqQueueTail);
- wd->freqCtrl.freqReqQueue[wd->freqCtrl.freqReqQueueTail] = frequency;
- wd->freqCtrl.freqReqBw40[wd->freqCtrl.freqReqQueueTail] = bw40;
- wd->freqCtrl.freqReqExtOffset[wd->freqCtrl.freqReqQueueTail] = extOffset;
- wd->freqCtrl.freqChangeCompCb[wd->freqCtrl.freqReqQueueTail] = cb;
- wd->freqCtrl.freqReqQueueTail++;
- if ( wd->freqCtrl.freqReqQueueTail >= ZM_MAX_FREQ_REQ_QUEUE )
- {
- wd->freqCtrl.freqReqQueueTail = 0;
- }
-}
-
-void zfCoreSetFrequencyV2(zdev_t* dev, u16_t frequency, zfpFreqChangeCompleteCb cb)
-{
- zfCoreSetFrequencyEx(dev, frequency, 0, 0, cb);
-}
-
-void zfCoreSetFrequencyExV2(zdev_t* dev, u16_t frequency, u8_t bw40,
- u8_t extOffset, zfpFreqChangeCompleteCb cb, u8_t forceSetFreq)
-{
- u8_t setFreqImmed = 0;
- u8_t initRF = 0;
- zmw_get_wlan_dev(dev);
- zmw_declare_for_critical_section();
-
- zm_msg1_scan(ZM_LV_1, "Freq=", frequency);
-
- zmw_enter_critical_section(dev);
- if ((wd->sta.currentFrequency == frequency)
- && (wd->sta.currentBw40 == bw40)
- && (wd->sta.currentExtOffset == extOffset))
- {
- if ( forceSetFreq == 0 && wd->sta.flagFreqChanging == 0 )
- {
- goto done;
- }
- }
-#ifdef ZM_FB50
- /*if(frequency!=2437) {
- zmw_leave_critical_section(dev);
- return;
- }*/
-#endif
-
- zfAddFreqChangeReq(dev, frequency, bw40, extOffset, cb);
-
-// zm_assert( wd->sta.flagFreqChanging == 0 );
- //wd->sta.flagFreqChanging = 1;
- if ( wd->sta.flagFreqChanging == 0 )
- {
- if ((wd->sta.currentBw40 != bw40) || (wd->sta.currentExtOffset != extOffset))
- {
- initRF = 1;
- }
- wd->sta.currentFrequency = frequency;
- wd->sta.currentBw40 = bw40;
- wd->sta.currentExtOffset = extOffset;
- setFreqImmed = 1;
- }
- wd->sta.flagFreqChanging++;
-
- zmw_leave_critical_section(dev);
-
- if ( setFreqImmed )
- {
- //zfHpSetFrequency(dev, frequency, 0);
- if ( forceSetFreq )
- { // Cold reset to reset the frequency after scanning !
- zm_debug_msg0("#6_1 20070917");
- zm_debug_msg0("It is happen!!! No error message");
- zfHpSetFrequencyEx(dev, frequency, bw40, extOffset, 2);
- }
- else
- {
- zfHpSetFrequencyEx(dev, frequency, bw40, extOffset, initRF);
- }
-
- if ( zfStaIsConnected(dev)
- && (frequency == wd->frequency)) {
- wd->sta.connPowerInHalfDbm = zfHpGetTransmitPower(dev);
- }
- }
- return;
-
-done:
- zmw_leave_critical_section(dev);
-
- if ( cb != NULL )
- {
- cb(dev);
- }
- zfPushVtxq(dev);
- return;
-}
-
-void zfCoreSetFrequencyEx(zdev_t* dev, u16_t frequency, u8_t bw40,
- u8_t extOffset, zfpFreqChangeCompleteCb cb)
-{
- zfCoreSetFrequencyExV2(dev, frequency, bw40, extOffset, cb, 0);
-}
-
-void zfCoreSetFrequency(zdev_t* dev, u16_t frequency)
-{
- zfCoreSetFrequencyV2(dev, frequency, NULL);
-}
-
-/* zfRemoveFreqChangeReq SHOULD NOT be called inside the critical section */
-static void zfRemoveFreqChangeReq(zdev_t* dev)
-{
- zfpFreqChangeCompleteCb cb = NULL;
- u16_t frequency;
- u8_t bw40;
- u8_t extOffset;
- u16_t compFreq = 0;
- u8_t compBw40 = 0;
- u8_t compExtOffset = 0;
-
- zmw_get_wlan_dev(dev);
- zmw_declare_for_critical_section();
-
- zmw_enter_critical_section(dev);
-
- if (wd->freqCtrl.freqReqQueueHead != wd->freqCtrl.freqReqQueueTail)
- {
- zm_msg1_scan(ZM_LV_1, "Freq=",
- wd->freqCtrl.freqReqQueue[wd->freqCtrl.freqReqQueueHead]);
- compFreq = wd->freqCtrl.freqReqQueue[wd->freqCtrl.freqReqQueueHead];
- compBw40 = wd->freqCtrl.freqReqBw40[wd->freqCtrl.freqReqQueueHead];
- compExtOffset = wd->freqCtrl.freqReqExtOffset[wd->freqCtrl.freqReqQueueHead];
-
- wd->freqCtrl.freqReqQueue[wd->freqCtrl.freqReqQueueHead] = 0;
- cb = wd->freqCtrl.freqChangeCompCb[wd->freqCtrl.freqReqQueueHead];
- wd->freqCtrl.freqReqQueueHead++;
- if ( wd->freqCtrl.freqReqQueueHead >= ZM_MAX_FREQ_REQ_QUEUE )
- {
- wd->freqCtrl.freqReqQueueHead = 0;
- }
- }
- zmw_leave_critical_section(dev);
-
- if ( cb != NULL )
- {
- cb(dev);
- }
-
- zmw_enter_critical_section(dev);
- while (wd->freqCtrl.freqReqQueue[wd->freqCtrl.freqReqQueueHead] != 0)
- {
- frequency = wd->freqCtrl.freqReqQueue[wd->freqCtrl.freqReqQueueHead];
- bw40 = wd->freqCtrl.freqReqBw40[wd->freqCtrl.freqReqQueueHead];
- extOffset=wd->freqCtrl.freqReqExtOffset[wd->freqCtrl.freqReqQueueHead];
- if ((compFreq == frequency)
- && (compBw40 == bw40)
- && (compExtOffset == extOffset))
- {
- /* Duplicated frequency command */
- zm_msg1_scan(ZM_LV_1, "Duplicated Freq=", frequency);
-
- cb = wd->freqCtrl.freqChangeCompCb[wd->freqCtrl.freqReqQueueHead];
- wd->freqCtrl.freqReqQueue[wd->freqCtrl.freqReqQueueHead] = 0;
- wd->freqCtrl.freqReqQueueHead++;
-
- if ( wd->freqCtrl.freqReqQueueHead >= ZM_MAX_FREQ_REQ_QUEUE )
- {
- wd->freqCtrl.freqReqQueueHead = 0;
- }
-
- if ( wd->sta.flagFreqChanging != 0 )
- {
- wd->sta.flagFreqChanging--;
- }
-
- zmw_leave_critical_section(dev);
- if ( cb != NULL )
- {
- cb(dev);
- }
- zmw_enter_critical_section(dev);
- }
- else
- {
- u8_t initRF = 0;
- if ((wd->sta.currentBw40 != bw40) || (wd->sta.currentExtOffset != extOffset))
- {
- initRF = 1;
- }
- wd->sta.currentFrequency = frequency;
- wd->sta.currentBw40 = bw40;
- wd->sta.currentExtOffset = extOffset;
- zmw_leave_critical_section(dev);
-
- zfHpSetFrequencyEx(dev, frequency, bw40, extOffset, initRF);
- if ( zfStaIsConnected(dev)
- && (frequency == wd->frequency)) {
- wd->sta.connPowerInHalfDbm = zfHpGetTransmitPower(dev);
- }
-
- return;
- }
- }
- zmw_leave_critical_section(dev);
-
- return;
-}
-
-void zfCoreSetFrequencyComplete(zdev_t* dev)
-{
- zmw_get_wlan_dev(dev);
- zmw_declare_for_critical_section();
-
- zm_msg1_scan(ZM_LV_1, "flagFreqChanging=", wd->sta.flagFreqChanging);
-
- zmw_enter_critical_section(dev);
- //wd->sta.flagFreqChanging = 0;
- if ( wd->sta.flagFreqChanging != 0 )
- {
- wd->sta.flagFreqChanging--;
- }
-
- zmw_leave_critical_section(dev);
-
- zfRemoveFreqChangeReq(dev);
-
- zfPushVtxq(dev);
- return;
-}
-
-void zfReSetCurrentFrequency(zdev_t* dev)
-{
- zmw_get_wlan_dev(dev);
-
- zm_debug_msg0("It is happen!!! No error message");
-
- zfCoreSetFrequencyExV2(dev, wd->frequency, 0, 0, NULL, 1);
-}
projects / mv-sheeva.git / blobdiff