123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330 |
- /****************************************************************************
- * drivers/wireless/ieee80211/bcmf_cdc.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 <debug.h>
- #include <errno.h>
- #include <nuttx/arch.h>
- #include <stddef.h>
- #include <string.h>
- #include <semaphore.h>
- #include "bcmf_driver.h"
- #include "bcmf_ioctl.h"
- #include "bcmf_utils.h"
- /****************************************************************************
- * Pre-processor Definitions
- ****************************************************************************/
- /* Control header flags */
- #define BCMF_CONTROL_ERROR 0x01 /* Command failure flag */
- #define BCMF_CONTROL_SET 0x02 /* Command type: SET = 1, GET = 0 */
- #define BCMF_CONTROL_INTERFACE_SHIFT 12
- #define BCMF_CONTROL_REQID_SHIFT 16
- #define BCMF_CONTROL_TIMEOUT_MS 1000
- /****************************************************************************
- * Private Types
- ****************************************************************************/
- struct __attribute__((packed)) bcmf_cdc_header {
- uint32_t cmd; /* Command to be sent */
- uint32_t len; /* Size of command data */
- uint32_t flags; /* cdc request flags, see above */
- uint32_t status; /* Returned status code from chip */
- };
- /****************************************************************************
- * Private Function Prototypes
- ****************************************************************************/
- static struct bcmf_frame_s *bcmf_cdc_allocate_frame(
- FAR struct bcmf_dev_s *priv, char *name,
- uint8_t *data, uint32_t len);
- static int bcmf_cdc_sendframe(FAR struct bcmf_dev_s *priv, uint32_t cmd,
- int ifidx, bool set, struct bcmf_frame_s *frame);
- static int bcmf_cdc_control_request(FAR struct bcmf_dev_s *priv,
- uint32_t ifidx, bool set, uint32_t cmd,
- char *name, uint8_t *data, uint32_t *len);
- static int bcmf_cdc_control_request_unsafe(FAR struct bcmf_dev_s *priv,
- uint32_t ifidx, bool set, uint32_t cmd,
- char *name, uint8_t *data, uint32_t *len);
- /****************************************************************************
- * Private Functions
- ****************************************************************************/
- struct bcmf_frame_s *bcmf_cdc_allocate_frame(FAR struct bcmf_dev_s *priv,
- char *name, uint8_t *data,
- uint32_t len)
- {
- uint32_t data_len;
- uint16_t name_len;
- struct bcmf_frame_s *frame;
- if (name)
- {
- name_len = strlen(name) + 1;
- }
- else
- {
- name_len = 0;
- }
- if (data)
- {
- data_len = len;
- }
- else
- {
- data_len = 0;
- }
- /* Allocate control frame */
- frame = priv->bus->allocate_frame(priv,
- sizeof(struct bcmf_cdc_header) + data_len + name_len,
- true, true);
- if (!frame)
- {
- return NULL;
- }
- /* Copy name string and data */
- memcpy(frame->data + sizeof(struct bcmf_cdc_header), name, name_len);
- memcpy(frame->data + sizeof(struct bcmf_cdc_header)
- + name_len, data, data_len);
- return frame;
- }
- int bcmf_cdc_sendframe(FAR struct bcmf_dev_s *priv, uint32_t cmd,
- int ifidx, bool set, struct bcmf_frame_s *frame)
- {
- struct bcmf_cdc_header *header =
- (struct bcmf_cdc_header *)frame->data;
- /* Setup control frame header */
- uint32_t cdc_data_len = frame->len - (uint32_t)(frame->data-frame->base);
- header->cmd = cmd;
- header->len = cdc_data_len-sizeof(struct bcmf_cdc_header);
- header->status = 0;
- header->flags = ++priv->control_reqid << BCMF_CONTROL_REQID_SHIFT;
- header->flags |= ifidx << BCMF_CONTROL_INTERFACE_SHIFT;
- if (set)
- {
- header->flags |= BCMF_CONTROL_SET;
- }
- /* Send frame */
- return priv->bus->txframe(priv, frame, true);
- }
- int bcmf_cdc_control_request(FAR struct bcmf_dev_s *priv,
- uint32_t ifidx, bool set, uint32_t cmd,
- char *name, uint8_t *data, uint32_t *len)
- {
- int ret;
- /* Take device control mutex */
- if ((ret = sem_wait(&priv->control_mutex)) != OK)
- {
- return ret;
- }
- ret = bcmf_cdc_control_request_unsafe(priv, ifidx, set, cmd,
- name, data, len);
- sem_post(&priv->control_mutex);
- return ret;
- }
- int bcmf_cdc_control_request_unsafe(FAR struct bcmf_dev_s *priv,
- uint32_t ifidx, bool set, uint32_t cmd,
- char *name, uint8_t *data, uint32_t *len)
- {
- int ret;
- struct bcmf_frame_s *frame;
- uint32_t out_len = *len;
- *len = 0;
- /* Prepare control frame */
- frame = bcmf_cdc_allocate_frame(priv, name, data, out_len);
- if (!frame)
- {
- wlerr("Cannot allocate cdc frame\n");
- return -ENOMEM;
- }
- /* Setup buffer to store response */
- priv->control_rxdata = set ? NULL : data;
- priv->control_rxdata_len = out_len;
- /* Send control frame. iovar buffer is freed when sent */
- ret = bcmf_cdc_sendframe(priv, cmd, ifidx, set, frame);
- if (ret != OK)
- {
- /* Free allocated iovar buffer */
- priv->bus->free_frame(priv, frame);
- return ret;
- }
- ret = bcmf_sem_wait(&priv->control_timeout, BCMF_CONTROL_TIMEOUT_MS);
- if (ret != OK)
- {
- wlerr("Error while waiting for control response %d\n", ret);
- return ret;
- }
- *len = priv->control_rxdata_len;
- /* Check frame status */
- if (priv->control_status != 0)
- {
- wlerr("Invalid cdc status 0x%x\n", priv->control_status);
- return -EINVAL;
- }
- return OK;
- }
- /****************************************************************************
- * Public Functions
- ****************************************************************************/
- int bcmf_cdc_iovar_request(FAR struct bcmf_dev_s *priv,
- uint32_t ifidx, bool set, char *name,
- uint8_t *data, uint32_t *len)
- {
- return bcmf_cdc_control_request(priv, ifidx, set,
- set ? WLC_SET_VAR : WLC_GET_VAR, name,
- data, len);
- }
- int bcmf_cdc_iovar_request_unsafe(FAR struct bcmf_dev_s *priv,
- uint32_t ifidx, bool set, char *name,
- uint8_t *data, uint32_t *len)
- {
- return bcmf_cdc_control_request_unsafe(priv, ifidx, set,
- set ? WLC_SET_VAR : WLC_GET_VAR, name,
- data, len);
- }
- int bcmf_cdc_ioctl(FAR struct bcmf_dev_s *priv,
- uint32_t ifidx, bool set, uint32_t cmd,
- uint8_t *data, uint32_t *len)
- {
- return bcmf_cdc_control_request(priv, ifidx, set, cmd, NULL, data, len);
- }
- int bcmf_cdc_process_control_frame(FAR struct bcmf_dev_s *priv,
- struct bcmf_frame_s *frame)
- {
- unsigned int data_size;
- struct bcmf_cdc_header *cdc_header;
- /* Check frame */
- data_size = frame->len - (unsigned int)(frame->data - frame->base);
- if (data_size < sizeof(struct bcmf_cdc_header))
- {
- wlerr("Control frame too small\n");
- return -EINVAL;
- }
- cdc_header = (struct bcmf_cdc_header *)frame->data;
- if (data_size < cdc_header->len ||
- data_size < sizeof(struct bcmf_cdc_header) + cdc_header->len)
- {
- wlerr("Invalid control frame size\n");
- return -EINVAL;
- }
- // TODO check interface ?
- if (cdc_header->flags >> BCMF_CONTROL_REQID_SHIFT == priv->control_reqid)
- {
- /* Expected frame received, send it back to user */
- priv->control_status = cdc_header->status;
- if (priv->control_rxdata)
- {
- if (priv->control_rxdata_len > cdc_header->len)
- {
- wlerr("Not enough data %d %d\n",
- priv->control_rxdata_len, cdc_header->len);
- priv->control_rxdata_len = cdc_header->len;
- }
- memcpy(priv->control_rxdata, (uint8_t *)&cdc_header[1],
- priv->control_rxdata_len);
- }
- sem_post(&priv->control_timeout);
- return OK;
- }
- wlinfo("Got unexpected control frame\n");
- return -EINVAL;
- }
|