Merge branch 'vendor/FILE'
[dragonfly.git] / usr.sbin / sdpd / sur.c
1 /* $NetBSD: sur.c,v 1.1 2006/06/19 15:44:56 gdamore Exp $ */
2 /* $DragonFly: src/usr.sbin/sdpd/sur.c,v 1.2 2008/05/19 10:19:49 corecode Exp $ */
3
4 /*
5  * sur.c
6  *
7  * Copyright (c) 2004 Maksim Yevmenkin <m_evmenkin@yahoo.com>
8  * All rights reserved.
9  *
10  * Redistribution and use in source and binary forms, with or without
11  * modification, are permitted provided that the following conditions
12  * are met:
13  * 1. Redistributions of source code must retain the above copyright
14  *    notice, this list of conditions and the following disclaimer.
15  * 2. Redistributions in binary form must reproduce the above copyright
16  *    notice, this list of conditions and the following disclaimer in the
17  *    documentation and/or other materials provided with the distribution.
18  *
19  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
20  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
23  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29  * SUCH DAMAGE.
30  *
31  * $Id: sur.c,v 1.2 2007/11/30 07:39:37 griffin Exp $
32  * $FreeBSD: src/usr.sbin/bluetooth/sdpd/sur.c,v 1.2 2005/12/06 17:56:36 emax Exp $
33  */
34
35 #include <sys/queue.h>
36 #include <sys/select.h>
37 #include <bluetooth.h>
38 #include <errno.h>
39 #include <sdp.h>
40 #include <string.h>
41 #include "profile.h"
42 #include "provider.h"
43 #include "server.h"
44
45 /*
46  * Prepare Service Unregister response
47  */
48
49 int32_t
50 server_prepare_service_unregister_response(server_p srv, int32_t fd)
51 {
52         uint8_t const   *req = srv->req + sizeof(sdp_pdu_t);
53         uint8_t const   *req_end = req + ((sdp_pdu_p)(srv->req))->len;
54         uint8_t         *rsp = srv->fdidx[fd].rsp;
55
56         provider_t      *provider = NULL;
57         uint32_t         handle;
58
59         /*
60          * Minimal Service Unregister Request
61          *
62          * value32      - uuid 4 bytes
63          */
64
65         if (!srv->fdidx[fd].control ||
66             !srv->fdidx[fd].priv || req_end - req < 4)
67                 return (SDP_ERROR_CODE_INVALID_REQUEST_SYNTAX);
68
69         /* Get handle */
70         SDP_GET32(handle, req);
71
72         /* Lookup provider */
73         provider = provider_by_handle(handle);
74         if (provider == NULL || provider->fd != fd)
75                 return (SDP_ERROR_CODE_INVALID_SERVICE_RECORD_HANDLE);
76
77         provider_unregister(provider);
78         SDP_PUT16(0, rsp);
79
80         /* Set reply size */
81         srv->fdidx[fd].rsp_limit = srv->fdidx[fd].omtu - sizeof(sdp_pdu_t);
82         srv->fdidx[fd].rsp_size = rsp - srv->fdidx[fd].rsp;
83         srv->fdidx[fd].rsp_cs = 0;
84
85         return (0);
86 }