Linux-2.6.33.2/drivers/staging/otus/80211core/freqctrl.c

/*
 * 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);
}