1 /*-
2 * provider.c
3 *
4 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
5 *
6 * Copyright (c) 2004 Maksim Yevmenkin <[email protected]>
7 * All rights reserved.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28 * SUCH DAMAGE.
29 *
30 * $Id: provider.c,v 1.5 2004/01/13 01:54:39 max Exp $
31 * $FreeBSD$
32 */
33
34 #include <sys/queue.h>
35 #define L2CAP_SOCKET_CHECKED
36 #include <bluetooth.h>
37 #include <string.h>
38 #include <stdlib.h>
39 #include "profile.h"
40 #include "provider.h"
41
42 static TAILQ_HEAD(, provider) providers = TAILQ_HEAD_INITIALIZER(providers);
43 static uint32_t change_state = 0;
44 static uint32_t handle = 0;
45
46 /*
47 * Register Service Discovery provider.
48 * Should not be called more the once.
49 */
50
51 int32_t
provider_register_sd(int32_t fd)52 provider_register_sd(int32_t fd)
53 {
54 extern profile_t sd_profile_descriptor;
55 extern profile_t bgd_profile_descriptor;
56
57 provider_p sd = calloc(1, sizeof(*sd));
58 provider_p bgd = calloc(1, sizeof(*bgd));
59
60 if (sd == NULL || bgd == NULL) {
61 if (sd != NULL)
62 free(sd);
63
64 if (bgd != NULL)
65 free(bgd);
66
67 return (-1);
68 }
69
70 sd->profile = &sd_profile_descriptor;
71 bgd->handle = 0;
72 sd->fd = fd;
73 TAILQ_INSERT_HEAD(&providers, sd, provider_next);
74
75 bgd->profile = &bgd_profile_descriptor;
76 bgd->handle = 1;
77 sd->fd = fd;
78 TAILQ_INSERT_AFTER(&providers, sd, bgd, provider_next);
79
80 change_state ++;
81
82 return (0);
83 }
84
85 /*
86 * Register new provider for a given profile, bdaddr and session.
87 */
88
89 provider_p
provider_register(profile_p const profile,bdaddr_p const bdaddr,int32_t fd,uint8_t const * data,uint32_t datalen)90 provider_register(profile_p const profile, bdaddr_p const bdaddr, int32_t fd,
91 uint8_t const *data, uint32_t datalen)
92 {
93 provider_p provider = calloc(1, sizeof(*provider));
94
95 if (provider != NULL) {
96 provider->data = malloc(datalen);
97 if (provider->data != NULL) {
98 provider->profile = profile;
99 memcpy(provider->data, data, datalen);
100
101 /*
102 * Record handles 0x0 and 0x1 are reserved
103 * for SDP itself
104 */
105
106 if (++ handle <= 1)
107 handle = 2;
108
109 provider->handle = handle;
110
111 memcpy(&provider->bdaddr, bdaddr,
112 sizeof(provider->bdaddr));
113 provider->fd = fd;
114
115 TAILQ_INSERT_TAIL(&providers, provider, provider_next);
116 change_state ++;
117 } else {
118 free(provider);
119 provider = NULL;
120 }
121 }
122
123 return (provider);
124 }
125
126 /*
127 * Unregister provider
128 */
129
130 void
provider_unregister(provider_p provider)131 provider_unregister(provider_p provider)
132 {
133 TAILQ_REMOVE(&providers, provider, provider_next);
134 if (provider->data != NULL)
135 free(provider->data);
136 free(provider);
137 change_state ++;
138 }
139
140 /*
141 * Update provider data
142 */
143
144 int32_t
provider_update(provider_p provider,uint8_t const * data,uint32_t datalen)145 provider_update(provider_p provider, uint8_t const *data, uint32_t datalen)
146 {
147 uint8_t *new_data = (uint8_t *) realloc(provider->data, datalen);
148
149 if (new_data == NULL)
150 return (-1);
151
152 memcpy(new_data, data, datalen);
153 provider->data = new_data;
154
155 return (0);
156 }
157
158 /*
159 * Get a provider for given record handle
160 */
161
162 provider_p
provider_by_handle(uint32_t handle)163 provider_by_handle(uint32_t handle)
164 {
165 provider_p provider = NULL;
166
167 TAILQ_FOREACH(provider, &providers, provider_next)
168 if (provider->handle == handle)
169 break;
170
171 return (provider);
172 }
173
174 /*
175 * Cursor access
176 */
177
178 provider_p
provider_get_first(void)179 provider_get_first(void)
180 {
181 return (TAILQ_FIRST(&providers));
182 }
183
184 provider_p
provider_get_next(provider_p provider)185 provider_get_next(provider_p provider)
186 {
187 return (TAILQ_NEXT(provider, provider_next));
188 }
189
190 /*
191 * Return change state
192 */
193
194 uint32_t
provider_get_change_state(void)195 provider_get_change_state(void)
196 {
197 return (change_state);
198 }
199
200