diff options
Diffstat (limited to 'sys/netgraph/bluetooth/l2cap/ng_l2cap_cmds.h')
| -rw-r--r-- | sys/netgraph/bluetooth/l2cap/ng_l2cap_cmds.h | 403 |
1 files changed, 403 insertions, 0 deletions
diff --git a/sys/netgraph/bluetooth/l2cap/ng_l2cap_cmds.h b/sys/netgraph/bluetooth/l2cap/ng_l2cap_cmds.h new file mode 100644 index 0000000..d107ad6 --- /dev/null +++ b/sys/netgraph/bluetooth/l2cap/ng_l2cap_cmds.h @@ -0,0 +1,403 @@ +/* + * ng_l2cap_cmds.h + * + * Copyright (c) Maksim Yevmenkin <m_evmenkin@yahoo.com> + * All rights reserved. + * + * 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. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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. + * + * $Id: ng_l2cap_cmds.h,v 1.9 2002/04/16 00:43:56 max Exp $ + * $FreeBSD$ + */ + +#ifndef _NETGRAPH_L2CAP_CMDS_H_ +#define _NETGRAPH_L2CAP_CMDS_H_ + +/****************************************************************************** + ****************************************************************************** + ** L2CAP to L2CAP signaling command macros + ****************************************************************************** + ******************************************************************************/ + +/* + * Note: All L2CAP implementations are required to support minimal signaling + * MTU of 48 bytes. In order to simplify things we will send one command + * per one L2CAP packet. Given evrything above we can assume that one + * signaling packet will fit into single mbuf. + */ + +/* L2CAP_CommandRej */ +#define _ng_l2cap_cmd_rej(_m, _ident, _reason, _mtu, _scid, _dcid) \ +do { \ + struct _cmd_rej { \ + ng_l2cap_cmd_hdr_t hdr; \ + ng_l2cap_cmd_rej_cp param; \ + ng_l2cap_cmd_rej_data_t data; \ + } __attribute__ ((packed)) *c = NULL; \ + \ + MGETHDR((_m), M_DONTWAIT, MT_DATA); \ + if ((_m) == NULL) \ + break; \ + \ + c = mtod((_m), struct _cmd_rej *); \ + c->hdr.code = NG_L2CAP_CMD_REJ; \ + c->hdr.ident = (_ident); \ + c->hdr.length = sizeof(c->param); \ + \ + c->param.reason = htole16((_reason)); \ + \ + if ((_reason) == NG_L2CAP_REJ_MTU_EXCEEDED) { \ + c->data.mtu.mtu = htole16((_mtu)); \ + c->hdr.length += sizeof(c->data.mtu); \ + } else if ((_reason) == NG_L2CAP_REJ_INVALID_CID) { \ + c->data.cid.scid = htole16((_scid)); \ + c->data.cid.dcid = htole16((_dcid)); \ + c->hdr.length += sizeof(c->data.cid); \ + } \ + \ + (_m)->m_pkthdr.len = (_m)->m_len = sizeof(c->hdr) + \ + c->hdr.length; \ + \ + c->hdr.length = htole16(c->hdr.length); \ +} while (0) + +/* L2CAP_ConnectReq */ +#define _ng_l2cap_con_req(_m, _ident, _psm, _scid) \ +do { \ + struct _con_req { \ + ng_l2cap_cmd_hdr_t hdr; \ + ng_l2cap_con_req_cp param; \ + } __attribute__ ((packed)) *c = NULL; \ + \ + MGETHDR((_m), M_DONTWAIT, MT_DATA); \ + if ((_m) == NULL) \ + break; \ + \ + (_m)->m_pkthdr.len = (_m)->m_len = sizeof(*c); \ + \ + c = mtod((_m), struct _con_req *); \ + c->hdr.code = NG_L2CAP_CON_REQ; \ + c->hdr.ident = (_ident); \ + c->hdr.length = htole16(sizeof(c->param)); \ + \ + c->param.psm = htole16((_psm)); \ + c->param.scid = htole16((_scid)); \ +} while (0) + +/* L2CAP_ConnectRsp */ +#define _ng_l2cap_con_rsp(_m, _ident, _dcid, _scid, _result, _status) \ +do { \ + struct _con_rsp { \ + ng_l2cap_cmd_hdr_t hdr; \ + ng_l2cap_con_rsp_cp param; \ + } __attribute__ ((packed)) *c = NULL; \ + \ + MGETHDR((_m), M_DONTWAIT, MT_DATA); \ + if ((_m) == NULL) \ + break; \ + \ + (_m)->m_pkthdr.len = (_m)->m_len = sizeof(*c); \ + \ + c = mtod((_m), struct _con_rsp *); \ + c->hdr.code = NG_L2CAP_CON_RSP; \ + c->hdr.ident = (_ident); \ + c->hdr.length = htole16(sizeof(c->param)); \ + \ + c->param.dcid = htole16((_dcid)); \ + c->param.scid = htole16((_scid)); \ + c->param.result = htole16((_result)); \ + c->param.status = htole16((_status)); \ +} while (0) + +/* L2CAP_ConfigReq */ +#define _ng_l2cap_cfg_req(_m, _ident, _dcid, _flags, _data) \ +do { \ + struct _cfg_req { \ + ng_l2cap_cmd_hdr_t hdr; \ + ng_l2cap_cfg_req_cp param; \ + } __attribute__ ((packed)) *c = NULL; \ + \ + MGETHDR((_m), M_DONTWAIT, MT_DATA); \ + if ((_m) == NULL) { \ + NG_FREE_M((_data)); \ + break; \ + } \ + \ + (_m)->m_pkthdr.len = (_m)->m_len = sizeof(*c); \ + \ + c = mtod((_m), struct _cfg_req *); \ + c->hdr.code = NG_L2CAP_CFG_REQ; \ + c->hdr.ident = (_ident); \ + c->hdr.length = sizeof(c->param); \ + \ + c->param.dcid = htole16((_dcid)); \ + c->param.flags = htole16((_flags)); \ + if ((_data) != NULL) { \ + m_cat((_m), (_data)); \ + c->hdr.length += (_data)->m_pkthdr.len; \ + (_m)->m_pkthdr.len += (_data)->m_pkthdr.len; \ + } \ + \ + c->hdr.length = htole16(c->hdr.length); \ +} while (0) + +/* L2CAP_ConfigRsp */ +#define _ng_l2cap_cfg_rsp(_m, _ident, _scid, _flags, _result, _data) \ +do { \ + struct _cfg_rsp { \ + ng_l2cap_cmd_hdr_t hdr; \ + ng_l2cap_cfg_rsp_cp param; \ + } __attribute__ ((packed)) *c = NULL; \ + \ + MGETHDR((_m), M_DONTWAIT, MT_DATA); \ + if ((_m) == NULL) { \ + NG_FREE_M((_data)); \ + break; \ + } \ + \ + (_m)->m_pkthdr.len = (_m)->m_len = sizeof(*c); \ + \ + c = mtod((_m), struct _cfg_rsp *); \ + c->hdr.code = NG_L2CAP_CFG_RSP; \ + c->hdr.ident = (_ident); \ + c->hdr.length = sizeof(c->param); \ + \ + c->param.scid = htole16((_scid)); \ + c->param.flags = htole16((_flags)); \ + c->param.result = htole16((_result)); \ + if ((_data) != NULL) { \ + m_cat((_m), (_data)); \ + c->hdr.length += (_data)->m_pkthdr.len; \ + (_m)->m_pkthdr.len += (_data)->m_pkthdr.len; \ + } \ + \ + c->hdr.length = htole16(c->hdr.length); \ +} while (0) + +/* Build configuration options */ +#define _ng_l2cap_build_cfg_options(_m, _mtu, _flush_timo, _flow) \ +do { \ + u_int8_t *p = NULL; \ + \ + MGETHDR((_m), M_DONTWAIT, MT_DATA); \ + if ((_m) == NULL) \ + break; \ + \ + (_m)->m_pkthdr.len = (_m)->m_len = 0; \ + p = mtod((_m), u_int8_t *); \ + \ + if ((_mtu) != NULL) { \ + struct _cfg_opt_mtu { \ + ng_l2cap_cfg_opt_t hdr; \ + u_int16_t val; \ + } __attribute__ ((packed)) *o = NULL; \ + \ + o = (struct _cfg_opt_mtu *) p; \ + o->hdr.type = NG_L2CAP_OPT_MTU; \ + o->hdr.length = sizeof(o->val); \ + o->val = htole16(*(u_int16_t *)(_mtu)); \ + \ + (_m)->m_pkthdr.len += sizeof(*o); \ + p += sizeof(*o); \ + } \ + \ + if ((_flush_timo) != NULL) { \ + struct _cfg_opt_flush { \ + ng_l2cap_cfg_opt_t hdr; \ + u_int16_t val; \ + } __attribute__ ((packed)) *o = NULL; \ + \ + o = (struct _cfg_opt_flush *) p; \ + o->hdr.type = NG_L2CAP_OPT_FLUSH_TIMO; \ + o->hdr.length = sizeof(o->val); \ + o->val = htole16(*(u_int16_t *)(_flush_timo)); \ + \ + (_m)->m_pkthdr.len += sizeof(*o); \ + p += sizeof(*o); \ + } \ + \ + if ((_flow) != NULL) { \ + struct _cfg_opt_flow { \ + ng_l2cap_cfg_opt_t hdr; \ + ng_l2cap_flow_t val; \ + } __attribute__ ((packed)) *o = NULL; \ + \ + o = (struct _cfg_opt_flow *) p; \ + o->hdr.type = NG_L2CAP_OPT_QOS; \ + o->hdr.length = sizeof(o->val); \ + o->val.flags = ((ng_l2cap_flow_p)(_flow))->flags; \ + o->val.service_type = ((ng_l2cap_flow_p) \ + (_flow))->service_type; \ + o->val.token_rate = \ + htole32(((ng_l2cap_flow_p)(_flow))->token_rate);\ + o->val.token_bucket_size = \ + htole32(((ng_l2cap_flow_p) \ + (_flow))->token_bucket_size); \ + o->val.peak_bandwidth = \ + htole32(((ng_l2cap_flow_p) \ + (_flow))->peak_bandwidth); \ + o->val.latency = htole32(((ng_l2cap_flow_p) \ + (_flow))->latency); \ + o->val.delay_variation = \ + htole32(((ng_l2cap_flow_p) \ + (_flow))->delay_variation); \ + \ + (_m)->m_pkthdr.len += sizeof(*o); \ + } \ + \ + (_m)->m_len = (_m)->m_pkthdr.len; \ +} while (0) + +/* L2CAP_DisconnectReq */ +#define _ng_l2cap_discon_req(_m, _ident, _dcid, _scid) \ +do { \ + struct _discon_req { \ + ng_l2cap_cmd_hdr_t hdr; \ + ng_l2cap_discon_req_cp param; \ + } __attribute__ ((packed)) *c = NULL; \ + \ + MGETHDR((_m), M_DONTWAIT, MT_DATA); \ + if ((_m) == NULL) \ + break; \ + \ + (_m)->m_pkthdr.len = (_m)->m_len = sizeof(*c); \ + \ + c = mtod((_m), struct _discon_req *); \ + c->hdr.code = NG_L2CAP_DISCON_REQ; \ + c->hdr.ident = (_ident); \ + c->hdr.length = htole16(sizeof(c->param)); \ + \ + c->param.dcid = htole16((_dcid)); \ + c->param.scid = htole16((_scid)); \ +} while (0) + +/* L2CA_DisconnectRsp */ +#define _ng_l2cap_discon_rsp(_m, _ident, _dcid, _scid) \ +do { \ + struct _discon_rsp { \ + ng_l2cap_cmd_hdr_t hdr; \ + ng_l2cap_discon_rsp_cp param; \ + } __attribute__ ((packed)) *c = NULL; \ + \ + MGETHDR((_m), M_DONTWAIT, MT_DATA); \ + if ((_m) == NULL) \ + break; \ + \ + (_m)->m_pkthdr.len = (_m)->m_len = sizeof(*c); \ + \ + c = mtod((_m), struct _discon_rsp *); \ + c->hdr.code = NG_L2CAP_DISCON_RSP; \ + c->hdr.ident = (_ident); \ + c->hdr.length = htole16(sizeof(c->param)); \ + \ + c->param.dcid = htole16((_dcid)); \ + c->param.scid = htole16((_scid)); \ +} while (0) + +/* L2CAP_EchoReq */ +#define _ng_l2cap_echo_req(_m, _ident, _data, _size) \ +do { \ + ng_l2cap_cmd_hdr_t *c = NULL; \ + \ + MGETHDR((_m), M_DONTWAIT, MT_DATA); \ + if ((_m) == NULL) \ + break; \ + \ + (_m)->m_pkthdr.len = (_m)->m_len = sizeof(*c); \ + \ + c = mtod((_m), ng_l2cap_cmd_hdr_t *); \ + c->code = NG_L2CAP_ECHO_REQ; \ + c->ident = (_ident); \ + c->length = 0; \ + \ + if ((_data) != NULL) { \ + m_copyback((_m), sizeof(*c), (_size), (_data)); \ + c->length += (_size); \ + } \ + \ + c->length = htole16(c->length); \ +} while (0) + +/* L2CAP_InfoReq */ +#define _ng_l2cap_info_req(_m, _ident, _type) \ +do { \ + struct _info_req { \ + ng_l2cap_cmd_hdr_t hdr; \ + ng_l2cap_info_req_cp param; \ + } __attribute__ ((packed)) *c = NULL; \ + \ + MGETHDR((_m), M_DONTWAIT, MT_DATA); \ + if ((_m) == NULL) \ + break; \ + \ + (_m)->m_pkthdr.len = (_m)->m_len = sizeof(*c); \ + \ + c = mtod((_m), struct _info_req *); \ + c->hdr.code = NG_L2CAP_INFO_REQ; \ + c->hdr.ident = (_ident); \ + c->hdr.length = htole16(sizeof(c->param)); \ + \ + c->param.type = htole16((_type)); \ +} while (0) + +/* L2CAP_InfoRsp */ +#define _ng_l2cap_info_rsp(_m, _ident, _type, _result, _mtu) \ +do { \ + struct _info_rsp { \ + ng_l2cap_cmd_hdr_t hdr; \ + ng_l2cap_info_rsp_cp param; \ + ng_l2cap_info_rsp_data_t data; \ + } __attribute__ ((packed)) *c = NULL; \ + \ + MGETHDR((_m), M_DONTWAIT, MT_DATA); \ + if ((_m) == NULL) \ + break; \ + \ + c = mtod((_m), struct _info_rsp *); \ + c->hdr.code = NG_L2CAP_INFO_REQ; \ + c->hdr.ident = (_ident); \ + c->hdr.length = sizeof(c->param); \ + \ + c->param.type = htole16((_type)); \ + c->param.result = htole16((_result)); \ + \ + if ((_result) == NG_L2CAP_SUCCESS) { \ + switch ((_type)) { \ + case NG_L2CAP_CONNLESS_MTU: \ + c->data.mtu.mtu = htole16((_mtu)); \ + c->hdr.length += sizeof((c->data.mtu.mtu)); \ + break; \ + } \ + } \ + \ + (_m)->m_pkthdr.len = (_m)->m_len = sizeof(c->hdr) + \ + c->hdr.length; \ + \ + c->hdr.length = htole16(c->hdr.length); \ +} while (0) + +void ng_l2cap_con_wakeup (ng_l2cap_con_p); +void ng_l2cap_con_fail (ng_l2cap_con_p, u_int16_t); +void ng_l2cap_process_command_timeout (node_p, hook_p, void *, int); + +#endif /* ndef _NETGRAPH_L2CAP_CMDS_H_ */ + |
