Home | History | Annotate | Line # | Download | only in netbt
hci_ioctl.c revision 1.1.2.2
      1 /*	$NetBSD: hci_ioctl.c,v 1.1.2.2 2006/06/21 15:10:51 yamt Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2005 Iain Hibbert.
      5  * Copyright (c) 2006 Itronix Inc.
      6  * All rights reserved.
      7  *
      8  * Redistribution and use in source and binary forms, with or without
      9  * modification, are permitted provided that the following conditions
     10  * are met:
     11  * 1. Redistributions of source code must retain the above copyright
     12  *    notice, this list of conditions and the following disclaimer.
     13  * 2. Redistributions in binary form must reproduce the above copyright
     14  *    notice, this list of conditions and the following disclaimer in the
     15  *    documentation and/or other materials provided with the distribution.
     16  * 3. The name of Itronix Inc. may not be used to endorse
     17  *    or promote products derived from this software without specific
     18  *    prior written permission.
     19  *
     20  * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
     21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     22  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     23  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
     24  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     25  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     26  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
     27  * ON ANY THEORY OF LIABILITY, WHETHER IN
     28  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     29  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     30  * POSSIBILITY OF SUCH DAMAGE.
     31  */
     32 
     33 #include <sys/cdefs.h>
     34 __KERNEL_RCSID(0, "$NetBSD: hci_ioctl.c,v 1.1.2.2 2006/06/21 15:10:51 yamt Exp $");
     35 
     36 #include <sys/param.h>
     37 #include <sys/domain.h>
     38 #include <sys/ioctl.h>
     39 #include <sys/kauth.h>
     40 #include <sys/kernel.h>
     41 #include <sys/mbuf.h>
     42 #include <sys/proc.h>
     43 #include <sys/systm.h>
     44 
     45 #include <netbt/bluetooth.h>
     46 #include <netbt/hci.h>
     47 #include <netbt/l2cap.h>
     48 #include <netbt/rfcomm.h>
     49 
     50 #ifdef BLUETOOTH_DEBUG
     51 #define BDADDR(bd)	(bd).b[5], (bd).b[4], (bd).b[3],	\
     52 			(bd).b[2], (bd).b[1], (bd).b[0]
     53 
     54 static void
     55 hci_dump(void)
     56 {
     57 	struct hci_unit *unit;
     58 	struct hci_link *link;
     59 	struct l2cap_channel *chan;
     60 	struct rfcomm_session *rs;
     61 	struct rfcomm_dlc *dlc;
     62 
     63 	printf("HCI:\n");
     64 	SIMPLEQ_FOREACH(unit, &hci_unit_list, hci_next) {
     65 		printf("UNIT %s: flags 0x%4.4x, "
     66 			"num_cmd=%d, num_acl=%d, num_sco=%d\n",
     67 			unit->hci_devname, unit->hci_flags,
     68 			unit->hci_num_cmd_pkts,
     69 			unit->hci_num_acl_pkts,
     70 			unit->hci_num_sco_pkts);
     71 		TAILQ_FOREACH(link, &unit->hci_links, hl_next) {
     72 			printf("+HANDLE #%d: %s "
     73 			    "raddr=%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x, "
     74 			    "state %d, refcnt %d\n",
     75 			    link->hl_handle,
     76 			    (link->hl_type == HCI_LINK_ACL ? "ACL":"SCO"),
     77 			    BDADDR(link->hl_bdaddr),
     78 			    link->hl_state, link->hl_refcnt);
     79 		}
     80 	}
     81 
     82 	printf("L2CAP:\n");
     83 	LIST_FOREACH(chan, &l2cap_active_list, lc_ncid) {
     84 		printf("CID #%d state %d, psm=0x%4.4x, "
     85 		    "laddr=%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x, "
     86 		    "raddr=%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x\n",
     87 		    chan->lc_lcid, chan->lc_state, chan->lc_raddr.bt_psm,
     88 		    BDADDR(chan->lc_laddr.bt_bdaddr),
     89 		    BDADDR(chan->lc_raddr.bt_bdaddr));
     90 	}
     91 
     92 	LIST_FOREACH(chan, &l2cap_listen_list, lc_ncid) {
     93 		printf("LISTEN psm=0x%4.4x, "
     94 		    "laddr=%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x\n",
     95 		    chan->lc_laddr.bt_psm,
     96 		    BDADDR(chan->lc_laddr.bt_bdaddr));
     97 	}
     98 
     99 	printf("RFCOMM:\n");
    100 	LIST_FOREACH(rs, &rfcomm_session_active, rs_next) {
    101 		chan = rs->rs_l2cap;
    102 		printf("SESSION: state=%d, flags=0x%4.4x, psm 0x%4.4x "
    103 		    "laddr=%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x, "
    104 		    "raddr=%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x\n",
    105 		    rs->rs_state, rs->rs_flags, chan->lc_raddr.bt_psm,
    106 		    BDADDR(chan->lc_laddr.bt_bdaddr),
    107 		    BDADDR(chan->lc_raddr.bt_bdaddr));
    108 		LIST_FOREACH(dlc, &rs->rs_dlcs, rd_next) {
    109 			printf("+DLC channel=%d, dlci=%d, "
    110 			    "state=%d, flags=0x%4.4x, rxcred=%d, rxsize=%d, "
    111 			    "txcred=%d, pending=%d, txqlen=%d\n",
    112 			    dlc->rd_raddr.bt_channel, dlc->rd_dlci,
    113 			    dlc->rd_state, dlc->rd_flags,
    114 			    dlc->rd_rxcred, dlc->rd_rxsize,
    115 			    dlc->rd_txcred, dlc->rd_pending,
    116 			    (dlc->rd_txbuf ? dlc->rd_txbuf->m_pkthdr.len : 0));
    117 		}
    118 	}
    119 
    120 	LIST_FOREACH(rs, &rfcomm_session_listen, rs_next) {
    121 		chan = rs->rs_l2cap;
    122 		printf("LISTEN: psm 0x%4.4x, "
    123 		    "laddr=%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x\n",
    124 		    chan->lc_laddr.bt_psm,
    125 		    BDADDR(chan->lc_laddr.bt_bdaddr));
    126 		LIST_FOREACH(dlc, &rs->rs_dlcs, rd_next)
    127 			printf("+DLC channel=%d\n", dlc->rd_laddr.bt_channel);
    128 	}
    129 }
    130 
    131 #undef BDADDR
    132 #endif
    133 
    134 int
    135 hci_ioctl(unsigned long cmd, void *data, struct proc *p)
    136 {
    137 	struct btreq *btr = data;
    138 	struct hci_unit *unit;
    139 	int s, err = 0;
    140 
    141 	DPRINTFN(1, "cmd %#lx\n", cmd);
    142 
    143 	switch(cmd) {
    144 #ifdef BLUETOOTH_DEBUG
    145 	case SIOCBTDUMP:
    146 		hci_dump();
    147 		return 0;
    148 #endif
    149 	/*
    150 	 * Get unit info based on address rather than name
    151 	 */
    152 	case SIOCGBTINFOA:
    153 		unit = hci_unit_lookup(&btr->btr_bdaddr);
    154 		if (unit == NULL)
    155 			return ENXIO;
    156 
    157 		break;
    158 
    159 	/*
    160 	 * The remaining ioctl's all use the same btreq structure and
    161 	 * index on the name of the device, so we look that up first.
    162 	 */
    163 	case SIOCNBTINFO:
    164 		/* empty name means give the first unit */
    165 		if (btr->btr_name[0] == '\0') {
    166 			unit = NULL;
    167 			break;
    168 		}
    169 
    170 		/* else fall through and look it up */
    171 	case SIOCGBTINFO:
    172 	case SIOCSBTFLAGS:
    173 	case SIOCSBTPOLICY:
    174 	case SIOCSBTPTYPE:
    175 	case SIOCGBTSTATS:
    176 	case SIOCZBTSTATS:
    177 		SIMPLEQ_FOREACH(unit, &hci_unit_list, hci_next) {
    178 			if (strncmp(unit->hci_devname, btr->btr_name,
    179 			    HCI_DEVNAME_SIZE) == 0)
    180 				break;
    181 		}
    182 
    183 		if (unit == NULL)
    184 			return ENXIO;
    185 
    186 		break;
    187 
    188 	default:	/* not one of mine */
    189 		return EPASSTHROUGH;
    190 	}
    191 
    192 	switch(cmd) {
    193 	case SIOCNBTINFO:	/* get next info */
    194 		if (unit)
    195 			unit = SIMPLEQ_NEXT(unit, hci_next);
    196 		else
    197 			unit = SIMPLEQ_FIRST(&hci_unit_list);
    198 
    199 		if (unit == NULL) {
    200 			err = ENXIO;
    201 			break;
    202 		}
    203 
    204 		/* and fall through to */
    205 	case SIOCGBTINFO:	/* get unit info */
    206 	case SIOCGBTINFOA:	/* get info by address */
    207 		memset(btr, 0, sizeof(struct btreq));
    208 		strlcpy(btr->btr_name, unit->hci_devname, HCI_DEVNAME_SIZE);
    209 		bdaddr_copy(&btr->btr_bdaddr, &unit->hci_bdaddr);
    210 
    211 		btr->btr_flags = unit->hci_flags;
    212 
    213 		btr->btr_num_cmd = unit->hci_num_cmd_pkts;
    214 		btr->btr_num_acl = unit->hci_num_acl_pkts;
    215 		btr->btr_num_sco = unit->hci_num_sco_pkts;
    216 		btr->btr_acl_mtu = unit->hci_max_acl_size;
    217 		btr->btr_sco_mtu = unit->hci_max_sco_size;
    218 
    219 		btr->btr_packet_type = unit->hci_packet_type;
    220 		btr->btr_link_policy = unit->hci_link_policy;
    221 		break;
    222 
    223 	case SIOCSBTFLAGS:	/* set unit flags (privileged) */
    224 		err = kauth_authorize_generic(p->p_cred, KAUTH_GENERIC_ISSUSER, &p->p_acflag);
    225 		if (err)
    226 			break;
    227 
    228 		if ((unit->hci_flags & BTF_UP)
    229 		    && (btr->btr_flags & BTF_UP) == 0) {
    230 			hci_disable(unit);
    231 			unit->hci_flags &= ~BTF_UP;
    232 		}
    233 
    234 		s = splraiseipl(unit->hci_ipl);
    235 		unit->hci_flags |= (btr->btr_flags & BTF_INIT);
    236 		splx(s);
    237 
    238 		if ((unit->hci_flags & BTF_UP) == 0
    239 		    && (btr->btr_flags & BTF_UP)) {
    240 			err = hci_enable(unit);
    241 			if (err)
    242 				break;
    243 
    244 			s = splraiseipl(unit->hci_ipl);
    245 			unit->hci_flags |= BTF_UP;
    246 			splx(s);
    247 		}
    248 
    249 		btr->btr_flags = unit->hci_flags;
    250 		break;
    251 
    252 	case SIOCSBTPOLICY:	/* set unit link policy (privileged) */
    253 		err = kauth_authorize_generic(p->p_cred, KAUTH_GENERIC_ISSUSER, &p->p_acflag);
    254 		if (err)
    255 			break;
    256 
    257 		unit->hci_link_policy = btr->btr_link_policy;
    258 		unit->hci_link_policy &= unit->hci_lmp_mask;
    259 		btr->btr_link_policy = unit->hci_link_policy;
    260 		break;
    261 
    262 	case SIOCSBTPTYPE:	/* set unit packet types (privileged) */
    263 		err = kauth_authorize_generic(p->p_cred, KAUTH_GENERIC_ISSUSER, &p->p_acflag);
    264 		if (err)
    265 			break;
    266 
    267 		unit->hci_packet_type = btr->btr_packet_type;
    268 		unit->hci_packet_type &= unit->hci_acl_mask;
    269 		btr->btr_packet_type = unit->hci_packet_type;
    270 		break;
    271 
    272 	case SIOCGBTSTATS:	/* get unit statistics */
    273 		s = splraiseipl(unit->hci_ipl);
    274 		memcpy(&btr->btr_stats, &unit->hci_stats,
    275 			sizeof(struct bt_stats));
    276 		splx(s);
    277 		break;
    278 
    279 	case SIOCZBTSTATS:	/* get & reset unit statistics */
    280 		err = kauth_authorize_generic(p->p_cred, KAUTH_GENERIC_ISSUSER, &p->p_acflag);
    281 		if (err)
    282 			break;
    283 
    284 		s = splraiseipl(unit->hci_ipl);
    285 		memcpy(&btr->btr_stats, &unit->hci_stats,
    286 			sizeof(struct bt_stats));
    287 		memset(&unit->hci_stats, 0, sizeof(struct bt_stats));
    288 		splx(s);
    289 
    290 		break;
    291 
    292 	default:
    293 		err = EFAULT;
    294 		break;
    295 	}
    296 
    297 	return err;
    298 }
    299