123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904 |
- /****************************************************************************
- * drivers/wireless/ieee80211/bcmf_sdio.c
- *
- * Copyright (C) 2017 Gregory Nutt. All rights reserved.
- * Author: Simon Piriou <spiriou31@gmail.com>
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- *
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in
- * the documentation and/or other materials provided with the
- * distribution.
- * 3. Neither the name NuttX nor the names of its contributors may be
- * used to endorse or promote products derived from this software
- * without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
- * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
- * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
- * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
- * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
- * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
- * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
- * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
- * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
- * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
- * POSSIBILITY OF SUCH DAMAGE.
- *
- ****************************************************************************/
- /****************************************************************************
- * Included Files
- ****************************************************************************/
- #include <nuttx/config.h>
- #include <nuttx/compiler.h>
- #include <stdint.h>
- #include <stdbool.h>
- #include <string.h>
- #include <debug.h>
- #include <errno.h>
- #include <queue.h>
- #include <semaphore.h>
- #include <assert.h>
- #include <nuttx/kmalloc.h>
- #include <nuttx/arch.h>
- #include <nuttx/kthread.h>
- #include <nuttx/wdog.h>
- #include <nuttx/wireless/ieee80211/mmc_sdio.h>
- #include <nuttx/wireless/ieee80211/bcmf_sdio.h>
- #include <nuttx/wireless/ieee80211/bcmf_board.h>
- #include "bcmf_sdio.h"
- #include "bcmf_core.h"
- #include "bcmf_sdpcm.h"
- #include "bcmf_utils.h"
- #include "bcmf_sdio_core.h"
- #include "bcmf_sdio_regs.h"
- /* Supported chip configurations */
- #ifdef CONFIG_IEEE80211_BROADCOM_BCM43362
- extern const struct bcmf_sdio_chip bcmf_43362_config_sdio;
- #endif
- /****************************************************************************
- * Pre-processor Definitions
- ****************************************************************************/
- #define BCMF_DEVICE_RESET_DELAY_MS 10
- #define BCMF_DEVICE_START_DELAY_MS 10
- #define BCMF_CLOCK_SETUP_DELAY_MS 500
- #define BCMF_THREAD_NAME "bcmf"
- #define BCMF_THREAD_STACK_SIZE 2048
- #define BCMF_WAITDOG_TIMEOUT_TICK (5*CLOCKS_PER_SEC)
- /****************************************************************************
- * Private Types
- ****************************************************************************/
- /****************************************************************************
- * Private Function Prototypes
- ****************************************************************************/
- static int bcmf_probe(FAR struct bcmf_sdio_dev_s *sbus);
- static int bcmf_hwinitialize(FAR struct bcmf_sdio_dev_s *sbus);
- static void bcmf_hwuninitialize(FAR struct bcmf_sdio_dev_s *sbus);
- static int bcmf_chipinitialize(FAR struct bcmf_sdio_dev_s *sbus);
- static int bcmf_oob_irq(int irq, FAR void *context, FAR void *arg);
- static int bcmf_sdio_bus_sleep(FAR struct bcmf_sdio_dev_s *sbus, bool sleep);
- static void bcmf_sdio_waitdog_timeout(int argc, wdparm_t arg1, ...);
- static int bcmf_sdio_thread(int argc, char **argv);
- static int bcmf_sdio_find_block_size(unsigned int size);
- /****************************************************************************
- * Private Data
- ****************************************************************************/
- /* FIXME remove */
- FAR struct bcmf_dev_s *g_sdio_priv;
- /* Buffer pool for SDIO bus interface
- * This pool is shared between all driver devices
- */
- static struct bcmf_sdio_frame g_pktframes[BCMF_PKT_POOL_SIZE];
- // TODO free_queue should be static
- /****************************************************************************
- * Private Functions
- ****************************************************************************/
- int bcmf_oob_irq(int irq, FAR void *context, FAR void *arg)
- {
- FAR struct bcmf_sdio_dev_s *sbus = (struct bcmf_sdio_dev_s *)arg;
- if (sbus->ready)
- {
- /* Signal bmcf thread */
- sbus->irq_pending = true;
- sem_post(&sbus->thread_signal);
- }
- return OK;
- }
- int bcmf_sdio_bus_sleep(FAR struct bcmf_sdio_dev_s *sbus, bool sleep)
- {
- int ret;
- int loops;
- uint8_t value;
- if (sbus->sleeping == sleep)
- {
- return OK;
- }
- if (sleep)
- {
- sbus->sleeping = true;
- return bcmf_write_reg(sbus, 1, SBSDIO_FUNC1_CHIPCLKCSR, 0);
- }
- else
- {
- /* Request HT Avail */
- ret = bcmf_write_reg(sbus, 1, SBSDIO_FUNC1_CHIPCLKCSR,
- SBSDIO_HT_AVAIL_REQ | SBSDIO_FORCE_HT);
- if (ret != OK)
- {
- wlerr("HT Avail request failed %d\n", ret);
- return ret;
- }
- /* Wait for High Troughput clock */
- loops = 20;
- while (--loops > 0)
- {
- up_mdelay(1);
- ret = bcmf_read_reg(sbus, 1, SBSDIO_FUNC1_CHIPCLKCSR, &value);
- if (ret != OK)
- {
- return ret;
- }
- if (value & SBSDIO_HT_AVAIL)
- {
- /* High Throughput clock is ready */
- break;
- }
- }
- if (loops <= 0)
- {
- wlerr("HT clock not ready\n");
- return -ETIMEDOUT;
- }
- sbus->sleeping = false;
- }
- return OK;
- }
- /****************************************************************************
- * Name: bcmf_probe
- ****************************************************************************/
- int bcmf_probe(FAR struct bcmf_sdio_dev_s *sbus)
- {
- int ret;
- /* Probe sdio card compatible device */
- ret = sdio_probe(sbus->sdio_dev);
- if (ret != OK)
- {
- goto exit_error;
- }
- /* Set FN0 / FN1 / FN2 default block size */
- ret = sdio_set_blocksize(sbus->sdio_dev, 0, 64);
- if (ret != OK)
- {
- goto exit_error;
- }
- ret = sdio_set_blocksize(sbus->sdio_dev, 1, 64);
- if (ret != OK)
- {
- goto exit_error;
- }
- ret = sdio_set_blocksize(sbus->sdio_dev, 2, 64);
- if (ret != OK)
- {
- goto exit_error;
- }
- /* Enable device interrupts for FN0, FN1 and FN2 */
- ret = bcmf_write_reg(sbus, 0, SDIO_CCCR_INTEN,
- (1 << 0) | (1 << 1) | (1 << 2));
- if (ret != OK)
- {
- goto exit_error;
- }
- /* Default device clock speed is up to 25 Mhz
- * We could set EHS bit to operate at a clock rate up to 50 Mhz */
- SDIO_CLOCK(sbus->sdio_dev, CLOCK_SD_TRANSFER_4BIT);
- up_mdelay(BCMF_CLOCK_SETUP_DELAY_MS);
- /* Enable bus FN1 */
- ret = sdio_enable_function(sbus->sdio_dev, 1);
- if (ret != OK)
- {
- goto exit_error;
- }
- return OK;
- exit_error:
- wlerr("ERROR: failed to probe device %d\n", sbus->minor);
- return ret;
- }
- /****************************************************************************
- * Name: bcmf_businitialize
- ****************************************************************************/
- int bcmf_businitialize(FAR struct bcmf_sdio_dev_s *sbus)
- {
- int ret;
- int loops;
- uint8_t value;
- /* Send Active Low-Power clock request */
- ret = bcmf_write_reg(sbus, 1, SBSDIO_FUNC1_CHIPCLKCSR,
- SBSDIO_FORCE_HW_CLKREQ_OFF |
- SBSDIO_ALP_AVAIL_REQ |
- SBSDIO_FORCE_ALP);
- if (ret != OK)
- {
- return ret;
- }
- loops = 10;
- while (--loops > 0)
- {
- up_mdelay(10);
- ret = bcmf_read_reg(sbus, 1, SBSDIO_FUNC1_CHIPCLKCSR, &value);
- if (ret != OK)
- {
- return ret;
- }
- if (value & SBSDIO_ALP_AVAIL)
- {
- /* Active Low-Power clock is ready */
- break;
- }
- }
- if (loops <= 0)
- {
- wlerr("failed to enable ALP\n");
- return -ETIMEDOUT;
- }
- /* Clear Active Low-Power clock request */
- ret = bcmf_write_reg(sbus, 1, SBSDIO_FUNC1_CHIPCLKCSR, 0);
- if (ret != OK)
- {
- return ret;
- }
- /* Disable pull-ups on SDIO cmd, d0-2 lines */
- ret = bcmf_write_reg(sbus, 1, SBSDIO_FUNC1_SDIOPULLUP, 0);
- if (ret != OK)
- {
- return ret;
- }
- /* Do chip specific initialization */
- ret = bcmf_chipinitialize(sbus);
- if (ret != OK)
- {
- return ret;
- }
- /* Upload firmware */
- ret = bcmf_core_upload_firmware(sbus);
- if (ret != OK)
- {
- return ret;
- }
- /* Enable FN2 (frame transfers) */
- ret = sdio_enable_function(sbus->sdio_dev, 2);
- if (ret != OK)
- {
- return ret;
- }
- return OK;
- }
- int bcmf_bus_setup_interrupts(FAR struct bcmf_sdio_dev_s *sbus)
- {
- int ret;
- /* Configure gpio interrupt pin */
- bcmf_board_setup_oob_irq(sbus->minor, bcmf_oob_irq, (void *)sbus);
- /* Enable function 2 interrupt */
- ret = sdio_enable_interrupt(sbus->sdio_dev, 0);
- if (ret != OK)
- {
- return ret;
- }
- ret = sdio_enable_interrupt(sbus->sdio_dev, 2);
- if (ret != OK)
- {
- return ret;
- }
- /* Redirect, configure and enable io for out-of-band interrupt signal */
- ret = bcmf_write_reg(sbus, 0, SDIO_CCCR_BRCM_SEPINT,
- SDIO_SEPINT_MASK | SDIO_SEPINT_OE | SDIO_SEPINT_ACT_HI);
- if (ret != OK)
- {
- return ret;
- }
- /* Wake up chip to be sure function 2 is running */
- ret = bcmf_sdio_bus_sleep(sbus, false);
- if (ret != OK)
- {
- return ret;
- }
- /* FN2 successfully enabled, set core and enable interrupts */
- bcmf_write_sbregw(sbus,
- CORE_BUS_REG(sbus->chip->core_base[SDIOD_CORE_ID],
- hostintmask), I_HMB_SW_MASK);
- bcmf_write_sbregb(sbus,
- CORE_BUS_REG(sbus->chip->core_base[SDIOD_CORE_ID],
- funcintmask), 2);
- bcmf_write_reg(sbus, 1, SBSDIO_WATERMARK, 8);
- return OK;
- }
- /****************************************************************************
- * Name: bcmf_hwinitialize
- ****************************************************************************/
- int bcmf_hwinitialize(FAR struct bcmf_sdio_dev_s *sbus)
- {
- /* Attach and prepare SDIO interrupts */
- SDIO_ATTACH(sbus->sdio_dev);
- /* Set ID mode clocking (<400KHz) */
- SDIO_CLOCK(sbus->sdio_dev, CLOCK_IDMODE);
- /* Configure hardware */
- bcmf_board_initialize(sbus->minor);
- /* Reset and power device */
- bcmf_board_reset(sbus->minor, true);
- bcmf_board_power(sbus->minor, true);
- up_mdelay(BCMF_DEVICE_RESET_DELAY_MS);
- bcmf_board_reset(sbus->minor, false);
- /* Wait for device to start */
- up_mdelay(BCMF_DEVICE_START_DELAY_MS);
- return OK;
- }
- /****************************************************************************
- * Name: bcmf_hwuninitialize
- ****************************************************************************/
- void bcmf_hwuninitialize(FAR struct bcmf_sdio_dev_s *sbus)
- {
- /* Shutdown device */
- bcmf_board_power(sbus->minor, false);
- bcmf_board_reset(sbus->minor, true);
- }
- int bcmf_sdio_find_block_size(unsigned int size)
- {
- int ret = 0;
- int size_copy = size;
- while (size_copy)
- {
- size_copy >>= 1;
- ret++;
- }
- if (size & (size-1))
- {
- return 1 << ret;
- }
- return 1 << (ret - 1);
- }
- /****************************************************************************
- * Public Functions
- ****************************************************************************/
- /****************************************************************************
- * Name: bcmf_transfer_bytes
- ****************************************************************************/
- int bcmf_transfer_bytes(FAR struct bcmf_sdio_dev_s *sbus, bool write,
- uint8_t function, uint32_t address,
- uint8_t *buf, unsigned int len)
- {
- unsigned int blocklen;
- unsigned int nblocks;
- /* Use rw_io_direct method if len is 1 */
- if (len == 0)
- {
- return -EINVAL;
- }
- if (len == 1)
- {
- if (write)
- {
- return sdio_io_rw_direct(sbus->sdio_dev, write,
- function, address, *buf, NULL);
- }
- return sdio_io_rw_direct(sbus->sdio_dev, write,
- function, address, 0, buf);
- }
- /* Find best block settings for transfer */
- if (len >= 64)
- {
- /* Use block mode */
- blocklen = 64;
- nblocks = (len+63) / 64;
- }
- else
- {
- /* Use byte mode */
- blocklen = bcmf_sdio_find_block_size(len);
- nblocks = 0;
- }
- return sdio_io_rw_extended(sbus->sdio_dev, write,
- function, address, true, buf, blocklen, nblocks);
- }
- /****************************************************************************
- * Name: bcmf_read_reg
- ****************************************************************************/
- int bcmf_read_reg(FAR struct bcmf_sdio_dev_s *sbus, uint8_t function,
- uint32_t address, uint8_t *reg)
- {
- *reg = 0;
- return bcmf_transfer_bytes(sbus, false, function, address, reg, 1);
- }
- /****************************************************************************
- * Name: bcmf_write_reg
- ****************************************************************************/
- int bcmf_write_reg(FAR struct bcmf_sdio_dev_s *sbus, uint8_t function,
- uint32_t address, uint8_t reg)
- {
- return bcmf_transfer_bytes(sbus, true, function, address, ®, 1);
- }
- /****************************************************************************
- * Name: bcmf_bus_sdio_initialize
- ****************************************************************************/
- int bcmf_bus_sdio_initialize(FAR struct bcmf_dev_s *priv,
- int minor, FAR struct sdio_dev_s *dev)
- {
- int ret;
- FAR struct bcmf_sdio_dev_s *sbus;
- /* Allocate sdio bus structure */
- sbus = (FAR struct bcmf_sdio_dev_s *)kmm_malloc(sizeof(*sbus));
- if (!sbus)
- {
- return -ENOMEM;
- }
- /* Initialize sdio bus device structure */
- memset(sbus, 0, sizeof(*sbus));
- sbus->sdio_dev = dev;
- sbus->minor = minor;
- sbus->ready = false;
- sbus->sleeping = true;
- sbus->bus.txframe = bcmf_sdpcm_queue_frame;
- sbus->bus.rxframe = bcmf_sdpcm_get_rx_frame;
- sbus->bus.allocate_frame = bcmf_sdpcm_alloc_frame;
- sbus->bus.free_frame = bcmf_sdpcm_free_frame;
- sbus->bus.stop = NULL; // TODO
- /* Init transmit frames queue */
- if ((ret = sem_init(&sbus->queue_mutex, 0, 1)) != OK)
- {
- goto exit_free_bus;
- }
- sq_init(&sbus->tx_queue);
- sq_init(&sbus->rx_queue);
- sq_init(&sbus->free_queue);
- /* Setup free buffer list */
- // FIXME this should be static to driver
- for (ret = 0; ret < BCMF_PKT_POOL_SIZE; ret++)
- {
- bcmf_dqueue_push(&sbus->free_queue, &g_pktframes[ret].list_entry);
- }
- /* Init thread semaphore */
- if ((ret = sem_init(&sbus->thread_signal, 0, 0)) != OK)
- {
- goto exit_free_bus;
- }
- if ((ret = sem_setprotocol(&sbus->thread_signal, SEM_PRIO_NONE)) != OK)
- {
- goto exit_free_bus;
- }
- /* Init thread waitdog */
- sbus->waitdog = wd_create();
- if (!sbus->waitdog)
- {
- ret = -ENOMEM;
- goto exit_free_bus;
- }
- /* Initialize device hardware */
- ret = bcmf_hwinitialize(sbus);
- if (ret != OK)
- {
- goto exit_free_waitdog;
- }
- /* Probe device */
- ret = bcmf_probe(sbus);
- if (ret != OK)
- {
- goto exit_uninit_hw;
- }
- /* Initialize device bus */
- ret = bcmf_businitialize(sbus);
- if (ret != OK)
- {
- goto exit_uninit_hw;
- }
- up_mdelay(100);
- sbus->ready = true;
- ret = bcmf_bus_setup_interrupts(sbus);
- if (ret != OK)
- {
- goto exit_uninit_hw;
- }
- /* FIXME global variable for now */
- g_sdio_priv = priv;
- /* Register sdio bus */
- priv->bus = &sbus->bus;
- /* Start the waitdog timer */
- wd_start(sbus->waitdog, BCMF_WAITDOG_TIMEOUT_TICK, bcmf_sdio_waitdog_timeout,
- (wdparm_t)priv);
- /* Spawn bcmf daemon thread */
- ret = kernel_thread(BCMF_THREAD_NAME, SCHED_PRIORITY_MAX,
- BCMF_THREAD_STACK_SIZE, bcmf_sdio_thread,
- (FAR char * const *)NULL);
- if (ret <= 0)
- {
- wlerr("Cannot spawn bcmf thread\n");
- ret = -EBADE;
- goto exit_uninit_hw;
- }
- sbus->thread_id = ret;
- /* sdio bus is up and running */
- return OK;
- exit_uninit_hw:
- bcmf_hwuninitialize(sbus);
- exit_free_waitdog:
- wd_delete(sbus->waitdog);
- exit_free_bus:
- kmm_free(sbus);
- priv->bus = NULL;
- return ret;
- }
- int bcmf_chipinitialize(FAR struct bcmf_sdio_dev_s *sbus)
- {
- int ret;
- uint32_t value = 0;
- ret = bcmf_read_sbregw(sbus, SI_ENUM_BASE, &value);
- if (ret != OK)
- {
- return ret;
- }
- int chipid = value & 0xffff;
- switch (chipid)
- {
- #ifdef CONFIG_IEEE80211_BROADCOM_BCM43362
- case SDIO_DEVICE_ID_BROADCOM_43362:
- wlinfo("bcm43362 chip detected\n");
- sbus->chip = (struct bcmf_sdio_chip *)&bcmf_43362_config_sdio;
- break;
- #endif
- default:
- wlerr("chip 0x%x is not supported\n", chipid);
- return -ENODEV;
- }
- return OK;
- }
- void bcmf_sdio_waitdog_timeout(int argc, wdparm_t arg1, ...)
- {
- FAR struct bcmf_dev_s *priv = (FAR struct bcmf_dev_s *)arg1;
- FAR struct bcmf_sdio_dev_s *sbus = (FAR struct bcmf_sdio_dev_s *)priv->bus;
- /* Notify bcmf thread */
- wlinfo("Notify bcmf thread\n");
- sem_post(&sbus->thread_signal);
- }
- int bcmf_sdio_thread(int argc, char **argv)
- {
- int ret;
- FAR struct bcmf_dev_s *priv = g_sdio_priv;
- FAR struct bcmf_sdio_dev_s *sbus = (FAR struct bcmf_sdio_dev_s *)priv->bus;
- wlinfo("Enter\n");
- /* FIXME wait for the chip to be ready to receive commands */
- up_mdelay(50);
- while (sbus->ready)
- {
- /* Wait for event (device interrupt, user request or waitdog timer) */
- ret = sem_wait(&sbus->thread_signal);
- if (ret != OK)
- {
- wlerr("Error while waiting for semaphore\n");
- break;
- }
- /* Restart the waitdog timer */
- wd_start(sbus->waitdog, BCMF_WAITDOG_TIMEOUT_TICK,
- bcmf_sdio_waitdog_timeout, (wdparm_t)priv);
- /* Wake up device */
- bcmf_sdio_bus_sleep(sbus, false);
- if (sbus->irq_pending)
- {
- /* Woken up by interrupt, read device status */
- sbus->irq_pending = false;
- bcmf_read_sbregw(sbus,
- CORE_BUS_REG(sbus->chip->core_base[SDIOD_CORE_ID],
- intstatus), &sbus->intstatus);
- /* Clear interrupts */
- bcmf_write_sbregw(sbus,
- CORE_BUS_REG(sbus->chip->core_base[SDIOD_CORE_ID],
- intstatus), sbus->intstatus);
- // wlinfo("intstatus %x\n", sbus->intstatus);
- }
- /* On frame indication, read available frames */
- if (sbus->intstatus & I_HMB_FRAME_IND)
- {
- // wlinfo("Frames available\n");
- do
- {
- ret = bcmf_sdpcm_readframe(priv);
- }
- while (ret == OK);
- if (ret == -ENODATA)
- {
- /* All frames processed */
- sbus->intstatus &= ~I_HMB_FRAME_IND;
- }
- }
- /* Send all queued frames */
- do
- {
- ret = bcmf_sdpcm_sendframe(priv);
- }
- while (ret == OK);
- /* Check if RX frames are available */
- if (sbus->intstatus & I_HMB_FRAME_IND)
- {
- /* Try again */
- wlinfo("Try read again\n");
- continue;
- }
- /* If we're done for now, turn off clock request. */
- // TODO add wakelock
- // bcmf_sdio_bus_sleep(sbus, true);
- }
- wlinfo("Exit\n");
- return 0;
- }
- struct bcmf_sdio_frame *bcmf_sdio_allocate_frame(FAR struct bcmf_dev_s *priv,
- bool block, bool tx)
- {
- FAR struct bcmf_sdio_dev_s *sbus = (FAR struct bcmf_sdio_dev_s *)priv->bus;
- struct bcmf_sdio_frame *sframe;
- dq_entry_t *entry = NULL;
- while (1)
- {
- if (sem_wait(&sbus->queue_mutex))
- {
- PANIC();
- }
- // if (!tx || sbus->tx_queue_count < BCMF_PKT_POOL_SIZE-1)
- {
- if ((entry = bcmf_dqueue_pop_tail(&sbus->free_queue)) != NULL)
- {
- if (tx)
- {
- sbus->tx_queue_count += 1;
- }
- sem_post(&sbus->queue_mutex);
- break;
- }
- }
- sem_post(&sbus->queue_mutex);
- if (block)
- {
- // TODO use signaling semaphore
- wlinfo("alloc failed %d\n", tx);
- up_mdelay(100);
- continue;
- }
- wlinfo("No avail buffer\n");
- return NULL;
- }
- sframe = container_of(entry, struct bcmf_sdio_frame, list_entry);
- sframe->header.len = HEADER_SIZE + MAX_NET_DEV_MTU;
- sframe->header.base = sframe->data;
- sframe->header.data = sframe->data;
- sframe->tx = tx;
- return sframe;
- }
- void bcmf_sdio_free_frame(FAR struct bcmf_dev_s *priv,
- struct bcmf_sdio_frame *sframe)
- {
- // wlinfo("free %p\n", sframe);
- FAR struct bcmf_sdio_dev_s *sbus = (FAR struct bcmf_sdio_dev_s *)priv->bus;
- if (sem_wait(&sbus->queue_mutex))
- {
- PANIC();
- }
- bcmf_dqueue_push(&sbus->free_queue, &sframe->list_entry);
- if (sframe->tx)
- {
- sbus->tx_queue_count -= 1;
- }
- sem_post(&sbus->queue_mutex);
- }
|