123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159 |
- /****************************************************************************
- * net/bluetooth/bluetooth_finddev.c
- *
- * Copyright (C) 2018 Gregory Nutt. All rights reserved.
- * Author: Gregory Nutt <gnutt@nuttx.org>
- *
- * 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 <assert.h>
- #include <nuttx/net/net.h>
- #include <nuttx/net/radiodev.h>
- #include <nuttx/net/bluetooth.h>
- #include <nuttx/wireless/bluetooth/bt_hci.h>
- #include "netdev/netdev.h"
- #include "bluetooth/bluetooth.h"
- #ifdef CONFIG_NET_BLUETOOTH
- /****************************************************************************
- * Private Types
- ****************************************************************************/
- struct bluetooth_finddev_s
- {
- FAR const bt_addr_t *bf_addr;
- FAR struct radio_driver_s *bf_radio;
- };
- /****************************************************************************
- * Private Functions
- ****************************************************************************/
- /****************************************************************************
- * Name: bluetooth_dev_callback
- *
- * Description:
- * Check if this device matches the connections local address.
- *
- * Input Parameters:
- * dev - The next network device in the enumeration
- *
- * Returned Value:
- * 0 if there is no match (meaning to continue looking); 1 if there is a
- * match (meaning to stop the search).
- *
- ****************************************************************************/
- static int bluetooth_dev_callback(FAR struct net_driver_s *dev, FAR void *arg)
- {
- FAR struct bluetooth_finddev_s *match =
- (FAR struct bluetooth_finddev_s *)arg;
- DEBUGASSERT(dev != NULL && match != NULL && match->bf_addr != NULL);
- /* First, check if this network device is an Bluetooth radio and that
- * it has an assigned Bluetooth address.
- */
- if (dev->d_lltype == NET_LL_BLUETOOTH && dev->d_mac.radio.nv_addrlen > 0)
- {
- DEBUGASSERT(dev->d_mac.radio.nv_addrlen == BLUETOOTH_ADDRSIZE);
- /* Does the device address match */
- if (BLUETOOTH_ADDRCMP(dev->d_mac.radio.nv_addr, match->bf_addr))
- {
- /* Yes.. save the match and return 1 to stop the search */
- match->bf_radio = (FAR struct radio_driver_s *)dev;
- return 1;
- }
- }
- /* Keep looking */
- return 0;
- }
- /****************************************************************************
- * Public Functions
- ****************************************************************************/
- /****************************************************************************
- * Name: bluetooth_find_device
- *
- * Description:
- * Select the network driver to use with the Bluetooth transaction.
- *
- * Input Parameters:
- * conn - Bluetooth connection structure (not currently used).
- * addr - The address to match the devices assigned address
- *
- * Returned Value:
- * A pointer to the network driver to use. NULL is returned on any
- * failure.
- *
- ****************************************************************************/
- FAR struct radio_driver_s *
- bluetooth_find_device(FAR struct bluetooth_conn_s *conn,
- FAR const bt_addr_t *addr)
- {
- struct bluetooth_finddev_s match;
- int ret;
- DEBUGASSERT(conn != NULL);
- match.bf_addr = addr;
- match.bf_radio = NULL;
- /* Search for the Bluetooth network device whose MAC is equal to the
- * sockets bound local address.
- */
- ret = netdev_foreach(bluetooth_dev_callback, (FAR void *)&match);
- if (ret == 1)
- {
- DEBUGASSERT(match.bf_radio != NULL);
- return match.bf_radio;
- }
- return NULL;
- }
- #endif /* CONFIG_NET_BLUETOOTH */
|