bluetooth/sdpd/server.c

54 static void	server_accept_client		(server_p srv, int32_t fd);
55 static int32_t	server_process_request		(server_p srv, int32_t fd);
56 static int32_t	server_send_error_response	(server_p srv, int32_t fd,
58 static void	server_close_fd			(server_p srv, int32_t fd);
65 server_init(server_p srv, char const *control)
73 	assert(srv != NULL);
76 	memset(srv, 0, sizeof(*srv));
159 	srv->imtu = (imtu > SDP_LOCAL_MTU)? imtu : SDP_LOCAL_MTU;
160 	srv->req = (uint8_t *) calloc(srv->imtu, sizeof(srv->req[0]));
161 	if (srv->req == NULL) {
169 	srv->fdidx = (fd_idx_p) calloc(FD_SETSIZE, sizeof(srv->fdidx[0]));
170 	if (srv->fdidx == NULL) {
172 		free(srv->req);
181 		free(srv->fdidx);
182 		free(srv->req);
193 	FD_ZERO(&srv->fdset);
194 	srv->maxfd = (unsock > l2sock)? unsock : l2sock;
196 	FD_SET(unsock, &srv->fdset);
197 	srv->fdidx[unsock].valid = 1;
198 	srv->fdidx[unsock].server = 1;
199 	srv->fdidx[unsock].control = 1;
200 	srv->fdidx[unsock].priv = 0;
201 	srv->fdidx[unsock].rsp_cs = 0;
202 	srv->fdidx[unsock].rsp_size = 0;
203 	srv->fdidx[unsock].rsp_limit = 0;
204 	srv->fdidx[unsock].omtu = SDP_LOCAL_MTU;
205 	srv->fdidx[unsock].rsp = NULL;
207 	FD_SET(l2sock, &srv->fdset);
208 	srv->fdidx[l2sock].valid = 1;
209 	srv->fdidx[l2sock].server = 1;
210 	srv->fdidx[l2sock].control = 0;
211 	srv->fdidx[l2sock].priv = 0;
212 	srv->fdidx[l2sock].rsp_cs = 0;
213 	srv->fdidx[l2sock].rsp_size = 0;
214 	srv->fdidx[l2sock].rsp_limit = 0;
215 	srv->fdidx[l2sock].omtu = 0; /* unknown */
216 	srv->fdidx[l2sock].rsp = NULL;
226 server_shutdown(server_p srv)
230 	assert(srv != NULL);
232 	for (fd = 0; fd < srv->maxfd + 1; fd ++)
233 		if (srv->fdidx[fd].valid)
234 			server_close_fd(srv, fd);
236 	free(srv->req);
237 	free(srv->fdidx);
239 	memset(srv, 0, sizeof(*srv));
247 server_do(server_p srv)
252 	assert(srv != NULL);
255 	memcpy(&fdset, &srv->fdset, sizeof(fdset));
256 	n = select(srv->maxfd + 1, &fdset, NULL, NULL, NULL);
262 			srv->maxfd + 1, &fdset, strerror(errno), errno);
268 	for (fd = 0; fd < srv->maxfd + 1 && n > 0; fd ++) {
272 		assert(srv->fdidx[fd].valid);
275 		if (srv->fdidx[fd].server)
276 			server_accept_client(srv, fd);
277 		else if (server_process_request(srv, fd) != 0)
278 			server_close_fd(srv, fd);
290 server_accept_client(server_p srv, int32_t fd)
303 			srv->fdidx[fd].control? "control" : "L2CAP",
308 	assert(!FD_ISSET(cfd, &srv->fdset));
309 	assert(!srv->fdidx[cfd].valid);
313 	if (!srv->fdidx[fd].control) {
315 		size = sizeof(srv->req_sa);
316 		if (getsockname(cfd,(struct sockaddr*)&srv->req_sa,&size) < 0) {
368 		memcpy(&srv->req_sa.l2cap_bdaddr, NG_HCI_BDADDR_ANY,
369 			sizeof(srv->req_sa.l2cap_bdaddr));
371 		omtu = srv->fdidx[fd].omtu;
387 	FD_SET(cfd, &srv->fdset);
388 	if (srv->maxfd < cfd)
389 		srv->maxfd = cfd;
390 	srv->fdidx[cfd].valid = 1;
391 	srv->fdidx[cfd].server = 0;
392 	srv->fdidx[cfd].control = srv->fdidx[fd].control;
393 	srv->fdidx[cfd].priv = priv;
394 	srv->fdidx[cfd].rsp_cs = 0;
395 	srv->fdidx[cfd].rsp_size = 0;
396 	srv->fdidx[cfd].rsp_limit = 0;
397 	srv->fdidx[cfd].omtu = omtu;
398 	srv->fdidx[cfd].rsp = rsp;
406 server_process_request(server_p srv, int32_t fd)
408 	sdp_pdu_p	pdu = (sdp_pdu_p) srv->req;
411 	assert(srv->imtu > 0);
412 	assert(srv->req != NULL);
413 	assert(FD_ISSET(fd, &srv->fdset));
414 	assert(srv->fdidx[fd].valid);
415 	assert(!srv->fdidx[fd].server);
416 	assert(srv->fdidx[fd].rsp != NULL);
417 	assert(srv->fdidx[fd].omtu >= NG_L2CAP_MTU_MINIMUM);
420 		len = read(fd, srv->req, srv->imtu);
425 			srv->fdidx[fd].control? "control" : "L2CAP",
431 			srv->fdidx[fd].control? "control" : "L2CAP");
439 			error = server_prepare_service_search_response(srv, fd);
443 			error = server_prepare_service_attribute_response(srv, fd);
447 			error = server_prepare_service_search_attribute_response(srv, fd);
451 			error = server_prepare_service_register_response(srv, fd);
455 			error = server_prepare_service_unregister_response(srv, fd);
459 			error = server_prepare_service_change_response(srv, fd);
472 			error = server_send_service_search_response(srv, fd);
476 			error = server_send_service_attribute_response(srv, fd);
480 			error = server_send_service_search_attribute_response(srv, fd);
484 			error = server_send_service_register_response(srv, fd);
488 			error = server_send_service_unregister_response(srv, fd);
492 			error = server_send_service_change_response(srv, fd);
503 				srv->fdidx[fd].control? "control" : "L2CAP",
509 			srv->fdidx[fd].control? "control" : "L2CAP",
512 		error = server_send_error_response(srv, fd, error);
516 				srv->fdidx[fd].control? "control" : "L2CAP",
522 		srv->fdidx[fd].rsp_cs = 0;
523 		srv->fdidx[fd].rsp_size = 0;
524 		srv->fdidx[fd].rsp_limit = 0;
535 server_send_error_response(server_p srv, int32_t fd, uint16_t error)
546 	rsp.pdu.tid = ((sdp_pdu_p)(srv->req))->tid;
562 server_close_fd(server_p srv, int32_t fd)
566 	assert(FD_ISSET(fd, &srv->fdset));
567 	assert(srv->fdidx[fd].valid);
571 	FD_CLR(fd, &srv->fdset);
572 	if (fd == srv->maxfd)
573 		srv->maxfd --;
575 	if (srv->fdidx[fd].rsp != NULL)
576 		free(srv->fdidx[fd].rsp);
578 	memset(&srv->fdidx[fd], 0, sizeof(srv->fdidx[fd]));