123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921 |
- /****************************************************************************
- * wireless/ieee802154/mac802154_device.c
- *
- * Copyright (C) 2017 Verge Inc. All rights reserved.
- * Author: Anthony Merlino <anthony@vergeaero.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 <stdint.h>
- #include <stdbool.h>
- #include <stdio.h>
- #include <string.h>
- #include <errno.h>
- #include <time.h>
- #include <fcntl.h>
- #include <nuttx/arch.h>
- #include <nuttx/kmalloc.h>
- #include <nuttx/signal.h>
- #include <nuttx/mm/iob.h>
- #include <nuttx/wireless/ieee802154/ieee802154_device.h>
- #include <nuttx/wireless/ieee802154/ieee802154_mac.h>
- #include "mac802154.h"
- /****************************************************************************
- * Pre-processor Definitions
- ****************************************************************************/
- /* Device naming ************************************************************/
- #define DEVNAME_FMT "/dev/ieee%d"
- #define DEVNAME_FMTLEN (9 + 3 + 1)
- /****************************************************************************
- * Private Types
- ****************************************************************************/
- /* This structure describes the state of one open mac driver instance */
- struct mac802154dev_open_s
- {
- /* Supports a singly linked list */
- FAR struct mac802154dev_open_s *md_flink;
- /* The following will be true if we are closing */
- volatile bool md_closing;
- };
- struct mac802154dev_callback_s
- {
- /* This holds the information visible to the MAC layer */
- struct mac802154_maccb_s mc_cb; /* Interface understood by the MAC layer */
- FAR struct mac802154_chardevice_s *mc_priv; /* Our priv data */
- };
- struct mac802154_chardevice_s
- {
- MACHANDLE md_mac; /* Saved binding to the mac layer */
- struct mac802154dev_callback_s md_cb; /* Callback information */
- sem_t md_exclsem; /* Exclusive device access */
- /* Hold a list of events */
- bool enableevents : 1; /* Are events enabled? */
- bool geteventpending : 1; /* Is there a get event using the semaphore? */
- sem_t geteventsem; /* Signaling semaphore for waiting get event */
- sq_queue_t primitive_queue; /* For holding primitives to pass along */
- /* The following is a singly linked list of open references to the
- * MAC device.
- */
- FAR struct mac802154dev_open_s *md_open;
- /* Hold a list of transactions as a "readahead" buffer */
- bool readpending; /* Is there a read using the semaphore? */
- sem_t readsem; /* Signaling semaphore for waiting read */
- sq_queue_t dataind_queue;
- /* MAC Service notification information */
- bool md_notify_registered;
- pid_t md_notify_pid;
- struct sigevent md_notify_event;
- struct sigwork_s md_notify_work;
- };
- /****************************************************************************
- * Private Function Prototypes
- ****************************************************************************/
- /* Semaphore helpers */
- static inline int mac802154dev_takesem(sem_t *sem);
- #define mac802154dev_givesem(s) nxsem_post(s);
- static int mac802154dev_notify(FAR struct mac802154_maccb_s *maccb,
- FAR struct ieee802154_primitive_s *primitive);
- static int mac802154dev_rxframe(FAR struct mac802154_chardevice_s *dev,
- FAR struct ieee802154_data_ind_s *ind);
- static int mac802154dev_open(FAR struct file *filep);
- static int mac802154dev_close(FAR struct file *filep);
- static ssize_t mac802154dev_read(FAR struct file *filep, FAR char *buffer,
- size_t len);
- static ssize_t mac802154dev_write(FAR struct file *filep,
- FAR const char *buffer, size_t len);
- static int mac802154dev_ioctl(FAR struct file *filep, int cmd,
- unsigned long arg);
- /****************************************************************************
- * Private Data
- ****************************************************************************/
- static const struct file_operations mac802154dev_fops =
- {
- mac802154dev_open , /* open */
- mac802154dev_close, /* close */
- mac802154dev_read , /* read */
- mac802154dev_write, /* write */
- NULL, /* seek */
- mac802154dev_ioctl, /* ioctl */
- NULL /* poll */
- #ifndef CONFIG_DISABLE_PSEUDOFS_OPERATIONS
- , NULL /* unlink */
- #endif
- };
- /****************************************************************************
- * Private Functions
- ****************************************************************************/
- /****************************************************************************
- * Name: mac802154dev_semtake
- *
- * Description:
- * Acquire the semaphore used for access serialization.
- *
- ****************************************************************************/
- static inline int mac802154dev_takesem(sem_t *sem)
- {
- int ret;
- /* Take the semaphore (perhaps waiting) */
- ret = nxsem_wait(sem);
- /* The only case that an error should occur here is if the wait were
- * awakened by a signal.
- */
- DEBUGASSERT(ret == OK || ret == -EINTR);
- return ret;
- }
- /****************************************************************************
- * Name: mac802154dev_open
- *
- * Description:
- * Open the 802.15.4 MAC character device.
- *
- ****************************************************************************/
- static int mac802154dev_open(FAR struct file *filep)
- {
- FAR struct inode *inode;
- FAR struct mac802154_chardevice_s *dev;
- FAR struct mac802154dev_open_s *opriv;
- int ret;
- DEBUGASSERT(filep != NULL && filep->f_inode != NULL);
- inode = filep->f_inode;
- dev = inode->i_private;
- DEBUGASSERT(dev != NULL);
- /* Get exclusive access to the MAC driver data structure */
- ret = mac802154dev_takesem(&dev->md_exclsem);
- if (ret < 0)
- {
- wlerr("ERROR: mac802154dev_takesem failed: %d\n", ret);
- return ret;
- }
- /* Allocate a new open struct */
- opriv = (FAR struct mac802154dev_open_s *)
- kmm_zalloc(sizeof(struct mac802154dev_open_s));
- if (!opriv)
- {
- wlerr("ERROR: Failed to allocate new open struct\n");
- ret = -ENOMEM;
- goto errout_with_sem;
- }
- /* Attach the open struct to the device */
- opriv->md_flink = dev->md_open;
- dev->md_open = opriv;
- /* Attach the open struct to the file structure */
- filep->f_priv = (FAR void *)opriv;
- ret = OK;
- errout_with_sem:
- mac802154dev_givesem(&dev->md_exclsem);
- return ret;
- }
- /****************************************************************************
- * Name: mac802154dev_close
- *
- * Description:
- * Close the 802.15.4 MAC character device.
- *
- ****************************************************************************/
- static int mac802154dev_close(FAR struct file *filep)
- {
- FAR struct inode *inode;
- FAR struct mac802154_chardevice_s *dev;
- FAR struct mac802154dev_open_s *opriv;
- FAR struct mac802154dev_open_s *curr;
- FAR struct mac802154dev_open_s *prev;
- irqstate_t flags;
- bool closing;
- int ret;
- DEBUGASSERT(filep && filep->f_priv && filep->f_inode);
- opriv = filep->f_priv;
- inode = filep->f_inode;
- DEBUGASSERT(inode->i_private);
- dev = (FAR struct mac802154_chardevice_s *)inode->i_private;
- /* Handle an improbable race conditions with the following atomic test
- * and set.
- *
- * This is actually a pretty feeble attempt to handle this. The
- * improbable race condition occurs if two different threads try to
- * close the driver at the same time. The rule: don't do
- * that! It is feeble because we do not really enforce stale pointer
- * detection anyway.
- */
- flags = enter_critical_section();
- closing = opriv->md_closing;
- opriv->md_closing = true;
- leave_critical_section(flags);
- if (closing)
- {
- /* Another thread is doing the close */
- return OK;
- }
- /* Get exclusive access to the driver structure */
- ret = mac802154dev_takesem(&dev->md_exclsem);
- if (ret < 0)
- {
- wlerr("ERROR: mac802154_takesem failed: %d\n", ret);
- return ret;
- }
- /* Find the open structure in the list of open structures for the device */
- for (prev = NULL, curr = dev->md_open;
- curr && curr != opriv;
- prev = curr, curr = curr->md_flink);
- DEBUGASSERT(curr);
- if (!curr)
- {
- wlerr("ERROR: Failed to find open entry\n");
- ret = -ENOENT;
- goto errout_with_exclsem;
- }
- /* Remove the structure from the device */
- if (prev)
- {
- prev->md_flink = opriv->md_flink;
- }
- else
- {
- dev->md_open = opriv->md_flink;
- }
- /* And free the open structure */
- kmm_free(opriv);
- /* If there are now no open instances of the driver and a signal handler is
- * not registered, purge the list of events.
- */
- if (dev->md_open)
- {
- FAR struct ieee802154_primitive_s *primitive;
- primitive =
- (FAR struct ieee802154_primitive_s *)sq_remfirst(&dev->primitive_queue);
- while (primitive)
- {
- ieee802154_primitive_free(primitive);
- primitive =
- (FAR struct ieee802154_primitive_s *)sq_remfirst(&dev->primitive_queue);
- }
- }
- ret = OK;
- errout_with_exclsem:
- mac802154dev_givesem(&dev->md_exclsem);
- return ret;
- }
- /****************************************************************************
- * Name: mac802154dev_read
- *
- * Description:
- * Return the last received packet.
- *
- ****************************************************************************/
- static ssize_t mac802154dev_read(FAR struct file *filep, FAR char *buffer,
- size_t len)
- {
- FAR struct inode *inode;
- FAR struct mac802154_chardevice_s *dev;
- FAR struct mac802154dev_rxframe_s *rx;
- FAR struct ieee802154_data_ind_s *ind;
- struct ieee802154_get_req_s req;
- int ret;
- DEBUGASSERT(filep && filep->f_inode);
- inode = filep->f_inode;
- DEBUGASSERT(inode->i_private);
- dev = (FAR struct mac802154_chardevice_s *)inode->i_private;
- /* Check to make sure the buffer is the right size for the struct */
- if (len != sizeof(struct mac802154dev_rxframe_s))
- {
- wlerr("ERROR: buffer isn't a mac802154dev_rxframe_s: %lu\n",
- (unsigned long)len);
- return -EINVAL;
- }
- DEBUGASSERT(buffer != NULL);
- rx = (FAR struct mac802154dev_rxframe_s *)buffer;
- while (1)
- {
- /* Get exclusive access to the driver structure */
- ret = mac802154dev_takesem(&dev->md_exclsem);
- if (ret < 0)
- {
- wlerr("ERROR: mac802154dev_takesem failed: %d\n", ret);
- return ret;
- }
- /* Try popping a data indication off the list */
- ind = (FAR struct ieee802154_data_ind_s *)sq_remfirst(&dev->dataind_queue);
- /* If the indication is not null, we can exit the loop and copy the data */
- if (ind != NULL)
- {
- mac802154dev_givesem(&dev->md_exclsem);
- break;
- }
- /* If this is a non-blocking call, or if there is another read operation
- * already pending, don't block. This driver returns EAGAIN even when
- * configured as non-blocking if another read operation is already pending
- * This situation should be rare. It will only occur when there are 2 calls
- * to read from separate threads and there was no data in the rx list.
- */
- if ((filep->f_oflags & O_NONBLOCK) || dev->readpending)
- {
- mac802154dev_givesem(&dev->md_exclsem);
- return -EAGAIN;
- }
- dev->readpending = true;
- mac802154dev_givesem(&dev->md_exclsem);
- /* Wait to be signaled when a frame is added to the list */
- ret = nxsem_wait(&dev->readsem);
- if (ret < 0)
- {
- DEBUGASSERT(ret == -EINTR || ret == -ECANCELED);
- dev->readpending = false;
- return ret;
- }
- /* Let the loop wrap back around, we will then pop a indication and this
- * time, it should have a data indication
- */
- }
- /* Check if the MAC layer is in promiscuous mode. */
- req.attr = IEEE802154_ATTR_MAC_PROMISCUOUS_MODE;
- ret = mac802154_ioctl(dev->md_mac, MAC802154IOC_MLME_GET_REQUEST,
- (unsigned long)&req);
- if (ret == 0 && req.attrval.mac.promisc_mode)
- {
- /* If it is, add the FCS back into the frame by increasing the length
- * by the PHY layer's FCS length.
- */
- req.attr = IEEE802154_ATTR_PHY_FCS_LEN;
- ret = mac802154_ioctl(dev->md_mac, MAC802154IOC_MLME_GET_REQUEST,
- (unsigned long)&req);
- if (ret == OK)
- {
- rx->length = ind->frame->io_len + req.attrval.phy.fcslen;
- rx->offset = ind->frame->io_offset;
- }
- /* Copy the entire frame from the IOB to the user supplied struct */
- memcpy(&rx->payload[0], &ind->frame->io_data[0], rx->length);
- }
- else
- {
- rx->length = (ind->frame->io_len - ind->frame->io_offset);
- rx->offset = 0;
- /* Copy just the payload from the IOB to the user supplied struct */
- memcpy(&rx->payload[0], &ind->frame->io_data[ind->frame->io_offset],
- rx->length);
- }
- memcpy(&rx->meta, ind, sizeof(struct ieee802154_data_ind_s));
- /* Zero out the forward link and IOB reference */
- rx->meta.flink = NULL;
- rx->meta.frame = NULL;
- /* Free the IOB */
- iob_free(ind->frame, IOBUSER_WIRELESS_MAC802154_CHARDEV);
- /* Deallocate the data indication */
- ieee802154_primitive_free((FAR struct ieee802154_primitive_s *)ind);
- return OK;
- }
- /****************************************************************************
- * Name: mac802154dev_write
- *
- * Description:
- * Send a packet over the IEEE802.15.4 network.
- *
- ****************************************************************************/
- static ssize_t mac802154dev_write(FAR struct file *filep,
- FAR const char *buffer, size_t len)
- {
- FAR struct inode *inode;
- FAR struct mac802154_chardevice_s *dev;
- FAR struct mac802154dev_txframe_s *tx;
- FAR struct iob_s *iob;
- int ret;
- DEBUGASSERT(filep && filep->f_inode);
- inode = filep->f_inode;
- DEBUGASSERT(inode->i_private);
- dev = (FAR struct mac802154_chardevice_s *)inode->i_private;
- /* Check if the struct is the correct size */
- if (len != sizeof(struct mac802154dev_txframe_s))
- {
- wlerr("ERROR: buffer isn't a mac802154dev_txframe_s: %lu\n",
- (unsigned long)len);
- return -EINVAL;
- }
- DEBUGASSERT(buffer != NULL);
- tx = (FAR struct mac802154dev_txframe_s *)buffer;
- /* Allocate an IOB to put the frame in */
- iob = iob_alloc(false, IOBUSER_WIRELESS_MAC802154_CHARDEV);
- DEBUGASSERT(iob != NULL);
- iob->io_flink = NULL;
- iob->io_len = 0;
- iob->io_offset = 0;
- iob->io_pktlen = 0;
- /* Get the MAC header length */
- ret = mac802154_get_mhrlen(dev->md_mac, &tx->meta);
- if (ret < 0)
- {
- wlerr("ERROR: TX meta-data is invalid");
- return ret;
- }
- iob->io_offset = ret;
- iob->io_len = iob->io_offset;
- memcpy(&iob->io_data[iob->io_offset], tx->payload, tx->length);
- iob->io_len += tx->length;
- /* Pass the request to the MAC layer */
- ret = mac802154_req_data(dev->md_mac, &tx->meta, iob);
- if (ret < 0)
- {
- iob_free(iob, IOBUSER_WIRELESS_MAC802154_CHARDEV);
- wlerr("ERROR: req_data failed %d\n", ret);
- return ret;
- }
- return OK;
- }
- /****************************************************************************
- * Name: mac802154dev_ioctl
- *
- * Description:
- * Control the MAC layer via IOCTL commands.
- *
- ****************************************************************************/
- static int mac802154dev_ioctl(FAR struct file *filep, int cmd,
- unsigned long arg)
- {
- FAR struct inode *inode;
- FAR struct mac802154_chardevice_s *dev;
- FAR union ieee802154_macarg_u *macarg =
- (FAR union ieee802154_macarg_u *)((uintptr_t)arg);
- int ret;
- DEBUGASSERT(filep != NULL && filep->f_priv != NULL &&
- filep->f_inode != NULL);
- inode = filep->f_inode;
- DEBUGASSERT(inode->i_private);
- dev = (FAR struct mac802154_chardevice_s *)inode->i_private;
- /* Get exclusive access to the driver structure */
- ret = mac802154dev_takesem(&dev->md_exclsem);
- if (ret < 0)
- {
- wlerr("ERROR: mac802154dev_takesem failed: %d\n", ret);
- return ret;
- }
- switch (cmd)
- {
- /* Command: MAC802154IOC_NOTIFY_REGISTER
- * Description: Register to receive a signal whenever there is a
- * event primitive sent from the MAC layer.
- * Argument: The signal number to use.
- * Return: Zero (OK) on success. Minus one will be returned on
- * failure with the errno value set appropriately.
- */
- case MAC802154IOC_NOTIFY_REGISTER:
- {
- /* Save the notification events */
- dev->md_notify_event = macarg->event;
- dev->md_notify_pid = getpid();
- dev->md_notify_registered = true;
- ret = OK;
- }
- break;
- case MAC802154IOC_GET_EVENT:
- {
- FAR struct ieee802154_primitive_s *primitive;
- while (1)
- {
- /* Try popping an event off the queue */
- primitive = (FAR struct ieee802154_primitive_s *)
- sq_remfirst(&dev->primitive_queue);
- /* If there was an event to pop off, copy it into the user data and
- * free it from the MAC layer's memory.
- */
- if (primitive != NULL)
- {
- memcpy(&macarg->primitive, primitive, sizeof(struct ieee802154_primitive_s));
- /* Free the notification */
- ieee802154_primitive_free(primitive);
- ret = OK;
- break;
- }
- /* If this is a non-blocking call, or if there is another getevent
- * operation already pending, don't block. This driver returns
- * EAGAIN even when configured as non-blocking if another getevent
- * operation is already pending This situation should be rare.
- * It will only occur when there are 2 calls from separate threads
- * and there was no events in the queue.
- */
- if ((filep->f_oflags & O_NONBLOCK) || dev->geteventpending)
- {
- ret = -EAGAIN;
- break;
- }
- dev->geteventpending = true;
- mac802154dev_givesem(&dev->md_exclsem);
- /* Wait to be signaled when an event is queued */
- ret = nxsem_wait(&dev->geteventsem);
- if (ret < 0)
- {
- DEBUGASSERT(ret == -EINTR || ret == -ECANCELED);
- dev->geteventpending = false;
- return ret;
- }
- /* Get exclusive access again, then loop back around and try and
- * pop an event off the queue
- */
- ret = mac802154dev_takesem(&dev->md_exclsem);
- if (ret < 0)
- {
- wlerr("ERROR: mac802154dev_takesem failed: %d\n", ret);
- return ret;
- }
- }
- }
- break;
- case MAC802154IOC_ENABLE_EVENTS:
- {
- dev->enableevents = macarg->enable;
- ret = OK;
- }
- break;
- default:
- {
- /* Forward any unrecognized commands to the MAC layer */
- ret = mac802154_ioctl(dev->md_mac, cmd, arg);
- }
- break;
- }
- mac802154dev_givesem(&dev->md_exclsem);
- return ret;
- }
- static int mac802154dev_notify(FAR struct mac802154_maccb_s *maccb,
- FAR struct ieee802154_primitive_s *primitive)
- {
- FAR struct mac802154dev_callback_s *cb =
- (FAR struct mac802154dev_callback_s *)maccb;
- FAR struct mac802154_chardevice_s *dev;
- DEBUGASSERT(cb != NULL && cb->mc_priv != NULL);
- dev = cb->mc_priv;
- /* Handle the special case for data indications or "incoming frames" */
- if (primitive->type == IEEE802154_PRIMITIVE_IND_DATA)
- {
- return mac802154dev_rxframe(dev, &primitive->u.dataind);
- }
- /* If there is a registered notification receiver, queue the event and signal
- * the receiver. Events should be popped from the queue from the application
- * at a reasonable rate in order for the MAC layer to be able to allocate new
- * notifications.
- */
- if (dev->enableevents && (dev->md_open != NULL || dev->md_notify_registered))
- {
- /* Get exclusive access to the driver structure. We don't care about any
- * signals so if we see one, just go back to trying to get access again */
- while (mac802154dev_takesem(&dev->md_exclsem) != 0);
- sq_addlast((FAR sq_entry_t *)primitive, &dev->primitive_queue);
- /* Check if there is a read waiting for data */
- if (dev->geteventpending)
- {
- /* Wake the thread waiting for the data transmission */
- dev->geteventpending = false;
- nxsem_post(&dev->geteventsem);
- }
- if (dev->md_notify_registered)
- {
- dev->md_notify_event.sigev_value.sival_int = primitive->type;
- nxsig_notification(dev->md_notify_pid, &dev->md_notify_event,
- SI_QUEUE, &dev->md_notify_work);
- }
- mac802154dev_givesem(&dev->md_exclsem);
- return OK;
- }
- /* By returning a negative value, we let the MAC know that we don't want the
- * primitive and it will free it for us
- */
- return -1;
- }
- /****************************************************************************
- * Name: mac802154dev_rxframe
- *
- * Description:
- * Handle received frames forward by the IEEE 802.15.4 MAC.
- *
- * Returned Value:
- * any failure. On success, the ind and its contained iob will be freed.
- * The ind will be intact if this function returns a failure.
- *
- ****************************************************************************/
- static int mac802154dev_rxframe(FAR struct mac802154_chardevice_s *dev,
- FAR struct ieee802154_data_ind_s *ind)
- {
- /* Get exclusive access to the driver structure. We don't care about any
- * signals so if we see one, just go back to trying to get access again */
- while (mac802154dev_takesem(&dev->md_exclsem) != 0);
- /* Push the indication onto the list */
- sq_addlast((FAR sq_entry_t *)ind, &dev->dataind_queue);
- /* Check if there is a read waiting for data */
- if (dev->readpending)
- {
- /* Wake the thread waiting for the data transmission */
- dev->readpending = false;
- nxsem_post(&dev->readsem);
- }
- /* Release the driver */
- mac802154dev_givesem(&dev->md_exclsem);
- return OK;
- }
- /****************************************************************************
- * Public Functions
- ****************************************************************************/
- /****************************************************************************
- * Name: mac802154dev_register
- *
- * Description:
- * Register a character driver to access the IEEE 802.15.4 MAC layer from
- * user-space
- *
- * Input Parameters:
- * mac - Pointer to the mac layer struct to be registerd.
- * minor - The device minor number. The IEEE802.15.4 MAC character device
- * will be registered as /dev/ieeeN where N is the minor number
- *
- * Returned Value:
- * Zero (OK) is returned on success. Otherwise a negated errno value is
- * returned to indicate the nature of the failure.
- *
- ****************************************************************************/
- int mac802154dev_register(MACHANDLE mac, int minor)
- {
- FAR struct mac802154_chardevice_s *dev;
- FAR struct mac802154_maccb_s *maccb;
- char devname[DEVNAME_FMTLEN];
- int ret;
- dev = kmm_zalloc(sizeof(struct mac802154_chardevice_s));
- if (!dev)
- {
- wlerr("ERROR: Failed to allocate device structure\n");
- return -ENOMEM;
- }
- /* Initialize the new mac driver instance */
- dev->md_mac = mac;
- nxsem_init(&dev->md_exclsem, 0, 1); /* Allow the device to be opened once
- * before blocking */
- nxsem_init(&dev->readsem, 0, 0);
- nxsem_setprotocol(&dev->readsem, SEM_PRIO_NONE);
- dev->readpending = false;
- sq_init(&dev->dataind_queue);
- dev->geteventpending = false;
- nxsem_init(&dev->geteventsem, 0, 0);
- nxsem_setprotocol(&dev->geteventsem, SEM_PRIO_NONE);
- sq_init(&dev->primitive_queue);
- dev->enableevents = true;
- dev->md_notify_registered = false;
- /* Initialize the MAC callbacks */
- dev->md_cb.mc_priv = dev;
- maccb = &dev->md_cb.mc_cb;
- maccb->flink = NULL;
- maccb->prio = CONFIG_IEEE802154_MACDEV_RECVRPRIO;
- maccb->notify = mac802154dev_notify;
- /* Bind the callback structure */
- ret = mac802154_bind(mac, maccb);
- if (ret < 0)
- {
- nerr("ERROR: Failed to bind the MAC callbacks: %d\n", ret);
- /* Free memory and return the error */
- kmm_free(dev);
- return ret;
- }
- /* Create the character device name */
- snprintf(devname, DEVNAME_FMTLEN, DEVNAME_FMT, minor);
- /* Register the mac character driver */
- ret = register_driver(devname, &mac802154dev_fops, 0666, dev);
- if (ret < 0)
- {
- wlerr("ERROR: register_driver failed: %d\n", ret);
- goto errout_with_priv;
- }
- return OK;
- errout_with_priv:
- nxsem_destroy(&dev->md_exclsem);
- kmm_free(dev);
- return ret;
- }
|