xref: /freebsd/lib/libsdp/session.c (revision 0986ab12e44caea472245845f9a89ced4f137d73)
10986ab12SMaksim Yevmenkin /*
20986ab12SMaksim Yevmenkin  * session.c
30986ab12SMaksim Yevmenkin  *
40986ab12SMaksim Yevmenkin  * Copyright (c) 2001-2003 Maksim Yevmenkin <m_evmenkin@yahoo.com>
50986ab12SMaksim Yevmenkin  * All rights reserved.
60986ab12SMaksim Yevmenkin  *
70986ab12SMaksim Yevmenkin  * Redistribution and use in source and binary forms, with or without
80986ab12SMaksim Yevmenkin  * modification, are permitted provided that the following conditions
90986ab12SMaksim Yevmenkin  * are met:
100986ab12SMaksim Yevmenkin  * 1. Redistributions of source code must retain the above copyright
110986ab12SMaksim Yevmenkin  *    notice, this list of conditions and the following disclaimer.
120986ab12SMaksim Yevmenkin  * 2. Redistributions in binary form must reproduce the above copyright
130986ab12SMaksim Yevmenkin  *    notice, this list of conditions and the following disclaimer in the
140986ab12SMaksim Yevmenkin  *    documentation and/or other materials provided with the distribution.
150986ab12SMaksim Yevmenkin  *
160986ab12SMaksim Yevmenkin  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
170986ab12SMaksim Yevmenkin  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
180986ab12SMaksim Yevmenkin  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
190986ab12SMaksim Yevmenkin  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
200986ab12SMaksim Yevmenkin  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
210986ab12SMaksim Yevmenkin  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
220986ab12SMaksim Yevmenkin  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
230986ab12SMaksim Yevmenkin  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
240986ab12SMaksim Yevmenkin  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
250986ab12SMaksim Yevmenkin  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
260986ab12SMaksim Yevmenkin  * SUCH DAMAGE.
270986ab12SMaksim Yevmenkin  *
280986ab12SMaksim Yevmenkin  * $Id: session.c,v 1.2 2003/09/04 22:12:13 max Exp $
290986ab12SMaksim Yevmenkin  * $FreeBSD$
300986ab12SMaksim Yevmenkin  */
310986ab12SMaksim Yevmenkin 
320986ab12SMaksim Yevmenkin #include <bluetooth.h>
330986ab12SMaksim Yevmenkin #include <errno.h>
340986ab12SMaksim Yevmenkin #include <stdlib.h>
350986ab12SMaksim Yevmenkin #include <string.h>
360986ab12SMaksim Yevmenkin #include <unistd.h>
370986ab12SMaksim Yevmenkin 
380986ab12SMaksim Yevmenkin #include <sdp-int.h>
390986ab12SMaksim Yevmenkin #include <sdp.h>
400986ab12SMaksim Yevmenkin 
410986ab12SMaksim Yevmenkin void *
420986ab12SMaksim Yevmenkin sdp_open(bdaddr_t const *l, bdaddr_t const *r)
430986ab12SMaksim Yevmenkin {
440986ab12SMaksim Yevmenkin 	sdp_session_p		ss = NULL;
450986ab12SMaksim Yevmenkin 	struct sockaddr_l2cap	sa;
460986ab12SMaksim Yevmenkin 	socklen_t		size;
470986ab12SMaksim Yevmenkin 
480986ab12SMaksim Yevmenkin 	if ((ss = calloc(1, sizeof(*ss))) == NULL)
490986ab12SMaksim Yevmenkin 		goto fail;
500986ab12SMaksim Yevmenkin 
510986ab12SMaksim Yevmenkin 	if (l == NULL || r == NULL) {
520986ab12SMaksim Yevmenkin 		ss->error = EINVAL;
530986ab12SMaksim Yevmenkin 		goto fail;
540986ab12SMaksim Yevmenkin 	}
550986ab12SMaksim Yevmenkin 
560986ab12SMaksim Yevmenkin 	ss->s = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BLUETOOTH_PROTO_L2CAP);
570986ab12SMaksim Yevmenkin 	if (ss->s < 0) {
580986ab12SMaksim Yevmenkin 		ss->error = errno;
590986ab12SMaksim Yevmenkin 		goto fail;
600986ab12SMaksim Yevmenkin 	}
610986ab12SMaksim Yevmenkin 
620986ab12SMaksim Yevmenkin 	sa.l2cap_len = sizeof(sa);
630986ab12SMaksim Yevmenkin 	sa.l2cap_family = AF_BLUETOOTH;
640986ab12SMaksim Yevmenkin 	sa.l2cap_psm = 0;
650986ab12SMaksim Yevmenkin 	memcpy(&sa.l2cap_bdaddr, l, sizeof(sa.l2cap_bdaddr));
660986ab12SMaksim Yevmenkin 	if (bind(ss->s, (struct sockaddr *) &sa, sizeof(sa)) < 0) {
670986ab12SMaksim Yevmenkin 		ss->error = errno;
680986ab12SMaksim Yevmenkin 		goto fail;
690986ab12SMaksim Yevmenkin 	}
700986ab12SMaksim Yevmenkin 
710986ab12SMaksim Yevmenkin 	sa.l2cap_psm = htole16(NG_L2CAP_PSM_SDP);
720986ab12SMaksim Yevmenkin 	memcpy(&sa.l2cap_bdaddr, r, sizeof(sa.l2cap_bdaddr));
730986ab12SMaksim Yevmenkin 	if (connect(ss->s, (struct sockaddr *) &sa, sizeof(sa)) < 0) {
740986ab12SMaksim Yevmenkin 		ss->error = errno;
750986ab12SMaksim Yevmenkin 		goto fail;
760986ab12SMaksim Yevmenkin 	}
770986ab12SMaksim Yevmenkin 
780986ab12SMaksim Yevmenkin 	size = sizeof(ss->omtu);
790986ab12SMaksim Yevmenkin 	if (getsockopt(ss->s, SOL_L2CAP, SO_L2CAP_OMTU, &ss->omtu, &size) < 0) {
800986ab12SMaksim Yevmenkin 		ss->error = errno;
810986ab12SMaksim Yevmenkin 		goto fail;
820986ab12SMaksim Yevmenkin 	}
830986ab12SMaksim Yevmenkin 	if ((ss->req = malloc(ss->omtu)) == NULL) {
840986ab12SMaksim Yevmenkin 		ss->error = ENOMEM;
850986ab12SMaksim Yevmenkin 		goto fail;
860986ab12SMaksim Yevmenkin 	}
870986ab12SMaksim Yevmenkin 	ss->req_e = ss->req + ss->omtu;
880986ab12SMaksim Yevmenkin 
890986ab12SMaksim Yevmenkin 	size = sizeof(ss->imtu);
900986ab12SMaksim Yevmenkin 	if (getsockopt(ss->s, SOL_L2CAP, SO_L2CAP_IMTU, &ss->imtu, &size) < 0) {
910986ab12SMaksim Yevmenkin 		ss->error = errno;
920986ab12SMaksim Yevmenkin 		goto fail;
930986ab12SMaksim Yevmenkin 	}
940986ab12SMaksim Yevmenkin 	if ((ss->rsp = malloc(ss->imtu)) == NULL) {
950986ab12SMaksim Yevmenkin 		ss->error = ENOMEM;
960986ab12SMaksim Yevmenkin 		goto fail;
970986ab12SMaksim Yevmenkin 	}
980986ab12SMaksim Yevmenkin 	ss->rsp_e = ss->rsp + ss->imtu;
990986ab12SMaksim Yevmenkin 	ss->error = 0;
1000986ab12SMaksim Yevmenkin fail:
1010986ab12SMaksim Yevmenkin 	return ((void *) ss);
1020986ab12SMaksim Yevmenkin }
1030986ab12SMaksim Yevmenkin 
1040986ab12SMaksim Yevmenkin void *
1050986ab12SMaksim Yevmenkin sdp_open_local(void)
1060986ab12SMaksim Yevmenkin {
1070986ab12SMaksim Yevmenkin 	sdp_session_p		ss = NULL;
1080986ab12SMaksim Yevmenkin 	struct sockaddr_un	sa;
1090986ab12SMaksim Yevmenkin 
1100986ab12SMaksim Yevmenkin 	if ((ss = calloc(1, sizeof(*ss))) == NULL)
1110986ab12SMaksim Yevmenkin 		goto fail;
1120986ab12SMaksim Yevmenkin 
1130986ab12SMaksim Yevmenkin 	ss->s = socket(PF_UNIX, SOCK_STREAM, 0);
1140986ab12SMaksim Yevmenkin 	if (ss->s < 0) {
1150986ab12SMaksim Yevmenkin 		ss->error = errno;
1160986ab12SMaksim Yevmenkin 		goto fail;
1170986ab12SMaksim Yevmenkin 	}
1180986ab12SMaksim Yevmenkin 
1190986ab12SMaksim Yevmenkin 	sa.sun_len = sizeof(sa);
1200986ab12SMaksim Yevmenkin 	sa.sun_family = AF_UNIX;
1210986ab12SMaksim Yevmenkin 	strlcpy(sa.sun_path, SDP_UNSOCK_PATH, sizeof(sa.sun_path));
1220986ab12SMaksim Yevmenkin 
1230986ab12SMaksim Yevmenkin 	if (connect(ss->s, (struct sockaddr *) &sa, sizeof(sa)) < 0) {
1240986ab12SMaksim Yevmenkin 		ss->error = errno;
1250986ab12SMaksim Yevmenkin 		goto fail;
1260986ab12SMaksim Yevmenkin 	}
1270986ab12SMaksim Yevmenkin 
1280986ab12SMaksim Yevmenkin 	ss->flags |= SDP_SESSION_LOCAL;
1290986ab12SMaksim Yevmenkin 	ss->imtu = ss->omtu = SDP_UNSOCK_MTU;
1300986ab12SMaksim Yevmenkin 
1310986ab12SMaksim Yevmenkin 	if ((ss->req = malloc(ss->omtu)) == NULL) {
1320986ab12SMaksim Yevmenkin 		ss->error = ENOMEM;
1330986ab12SMaksim Yevmenkin 		goto fail;
1340986ab12SMaksim Yevmenkin 	}
1350986ab12SMaksim Yevmenkin 	ss->req_e = ss->req + ss->omtu;
1360986ab12SMaksim Yevmenkin 
1370986ab12SMaksim Yevmenkin 	if ((ss->rsp = malloc(ss->imtu)) == NULL) {
1380986ab12SMaksim Yevmenkin 		ss->error = ENOMEM;
1390986ab12SMaksim Yevmenkin 		goto fail;
1400986ab12SMaksim Yevmenkin 	}
1410986ab12SMaksim Yevmenkin 	ss->rsp_e = ss->rsp + ss->imtu;
1420986ab12SMaksim Yevmenkin 	ss->error = 0;
1430986ab12SMaksim Yevmenkin fail:
1440986ab12SMaksim Yevmenkin 	return ((void *) ss);
1450986ab12SMaksim Yevmenkin }
1460986ab12SMaksim Yevmenkin 
1470986ab12SMaksim Yevmenkin int32_t
1480986ab12SMaksim Yevmenkin sdp_close(void *xss)
1490986ab12SMaksim Yevmenkin {
1500986ab12SMaksim Yevmenkin 	sdp_session_p	ss = (sdp_session_p) xss;
1510986ab12SMaksim Yevmenkin 
1520986ab12SMaksim Yevmenkin 	if (ss != NULL) {
1530986ab12SMaksim Yevmenkin 		if (ss->s >= 0)
1540986ab12SMaksim Yevmenkin 			close(ss->s);
1550986ab12SMaksim Yevmenkin 
1560986ab12SMaksim Yevmenkin 		if (ss->req != NULL)
1570986ab12SMaksim Yevmenkin 			free(ss->req);
1580986ab12SMaksim Yevmenkin 		if (ss->rsp != NULL)
1590986ab12SMaksim Yevmenkin 			free(ss->rsp);
1600986ab12SMaksim Yevmenkin 
1610986ab12SMaksim Yevmenkin 		memset(ss, 0, sizeof(*ss));
1620986ab12SMaksim Yevmenkin 		free(ss);
1630986ab12SMaksim Yevmenkin 	}
1640986ab12SMaksim Yevmenkin 
1650986ab12SMaksim Yevmenkin 	return (0);
1660986ab12SMaksim Yevmenkin }
1670986ab12SMaksim Yevmenkin 
1680986ab12SMaksim Yevmenkin int32_t
1690986ab12SMaksim Yevmenkin sdp_error(void *xss)
1700986ab12SMaksim Yevmenkin {
1710986ab12SMaksim Yevmenkin 	sdp_session_p	ss = (sdp_session_p) xss;
1720986ab12SMaksim Yevmenkin 
1730986ab12SMaksim Yevmenkin 	return ((ss != NULL)? ss->error : EINVAL);
1740986ab12SMaksim Yevmenkin }
175