1/*-
2 * provider.c
3 *
4 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
5 *
6 * Copyright (c) 2004 Maksim Yevmenkin <m_evmenkin@yahoo.com>
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: stable/11/usr.sbin/bluetooth/sdpd/provider.c 330449 2018-03-05 07:26:05Z eadler $
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
42static TAILQ_HEAD(, provider)	providers = TAILQ_HEAD_INITIALIZER(providers);
43static uint32_t			change_state = 0;
44static uint32_t			handle = 0;
45
46/*
47 * Register Service Discovery provider.
48 * Should not be called more the once.
49 */
50
51int32_t
52provider_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
89provider_p
90provider_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
130void
131provider_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
144int32_t
145provider_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
162provider_p
163provider_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
178provider_p
179provider_get_first(void)
180{
181	return (TAILQ_FIRST(&providers));
182}
183
184provider_p
185provider_get_next(provider_p provider)
186{
187	return (TAILQ_NEXT(provider, provider_next));
188}
189
190/*
191 * Return change state
192 */
193
194uint32_t
195provider_get_change_state(void)
196{
197	return (change_state);
198}
199
200