d/freebsd-skq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Add support for Audio Sink and Audio Source profiles to sdpd(8).

Browse Source 
This allows user-space programs like virtual_oss(8) to act
as a Bluetooth speaker device.

MFC after:		1 week
Sponsored by:		Mellanox Technologies
This commit is contained in:
Hans Petter Selasky 2019-01-30 09:44:54 +00:00
parent 3496224a96
commit 21be80ae80
5 changed files with 400 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

18
lib/libsdp/sdp.h
View File

@ -586,6 +586,24 @@ void sdp_print (uint32_t level, uint8_t const *start,
#define SDP_PDU_SERVICE_UNREGISTER_REQUEST 0x82
#define SDP_PDU_SERVICE_CHANGE_REQUEST 0x83
struct sdp_audio_sink_profile
{
uint16_t psm;
uint16_t protover;
uint16_t features;
};
typedef struct sdp_audio_sink_profile sdp_audio_sink_profile_t;
typedef struct sdp_audio_sink_profile *sdp_audio_sink_profile_p;
struct sdp_audio_source_profile
{
uint16_t psm;
uint16_t protover;
uint16_t features;
};
typedef struct sdp_audio_source_profile sdp_audio_source_profile_t;
typedef struct sdp_audio_source_profile *sdp_audio_source_profile_p;
struct sdp_dun_profile
{
uint8_t server_channel;

3
usr.sbin/bluetooth/sdpd/Makefile
View File

@ -3,7 +3,8 @@
PROG= sdpd
MAN= sdpd.8
SRCS= bgd.c dun.c ftrn.c gn.c irmc.c irmc_command.c lan.c log.c \
SRCS= audio_sink.c audio_source.c \
bgd.c dun.c ftrn.c gn.c irmc.c irmc_command.c lan.c log.c \
main.c nap.c opush.c panu.c profile.c provider.c sar.c scr.c \
sd.c server.c sp.c srr.c ssar.c ssr.c sur.c uuid.c

188
usr.sbin/bluetooth/sdpd/audio_sink.c Normal file
View File

@ -0,0 +1,188 @@
/*-
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
*
* Copyright (c) 2019 Hans Petter Selasky <hselasky@freebsd.org>
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* $FreeBSD$
*/
#include <sys/queue.h>
#define L2CAP_SOCKET_CHECKED
#include <bluetooth.h>
#include <sdp.h>
#include <string.h>
#include "profile.h"
#include "provider.h"
static int32_t
audio_sink_profile_create_service_class_id_list(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
static const uint16_t service_classes[] = {
SDP_SERVICE_CLASS_AUDIO_SINK,
};
return (common_profile_create_service_class_id_list(
buf, eob,
(uint8_t const *)service_classes,
sizeof(service_classes)));
}
static int32_t
audio_sink_profile_create_protocol_descriptor_list(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
provider_p provider = (provider_p) data;
sdp_audio_sink_profile_p audio_sink = (sdp_audio_sink_profile_p) provider->data;
if (buf + 18 > eob)
return (-1);
SDP_PUT8(SDP_DATA_SEQ8, buf);
SDP_PUT8(16, buf);
SDP_PUT8(SDP_DATA_SEQ8, buf);
SDP_PUT8(6, buf);
SDP_PUT8(SDP_DATA_UUID16, buf);
SDP_PUT16(SDP_UUID_PROTOCOL_L2CAP, buf);
SDP_PUT8(SDP_DATA_UINT16, buf);
SDP_PUT16(audio_sink->psm, buf);
SDP_PUT8(SDP_DATA_SEQ8, buf);
SDP_PUT8(6, buf);
SDP_PUT8(SDP_DATA_UUID16, buf);
SDP_PUT16(SDP_UUID_PROTOCOL_AVDTP, buf);
SDP_PUT8(SDP_DATA_UINT16, buf);
SDP_PUT16(audio_sink->protover, buf);
return (18);
}
static int32_t
audio_sink_profile_create_browse_group_list(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
if (buf + 5 > eob)
return (-1);
SDP_PUT8(SDP_DATA_SEQ8, buf);
SDP_PUT8(3, buf);
SDP_PUT8(SDP_DATA_UUID16, buf);
SDP_PUT16(SDP_SERVICE_CLASS_PUBLIC_BROWSE_GROUP, buf);
return (5);
}
static int32_t
audio_sink_profile_create_bluetooth_profile_descriptor_list(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
static const uint16_t profile_descriptor_list[] = {
SDP_SERVICE_CLASS_ADVANCED_AUDIO_DISTRIBUTION,
0x0100
};
return (common_profile_create_bluetooth_profile_descriptor_list(
buf, eob,
(uint8_t const *)profile_descriptor_list,
sizeof(profile_descriptor_list)));
}
static int32_t
audio_sink_profile_create_service_name(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
static const char service_name[] = "Audio SNK";
return (common_profile_create_string8(
buf, eob,
(uint8_t const *)service_name, strlen(service_name)));
}
static int32_t
audio_sink_create_supported_features(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
provider_p provider = (provider_p) data;
sdp_audio_sink_profile_p audio_sink = (sdp_audio_sink_profile_p) provider->data;
if (buf + 3 > eob)
return (-1);
SDP_PUT8(SDP_DATA_UINT16, buf);
SDP_PUT16(audio_sink->features, buf);
return (3);
}
static int32_t
audio_sink_profile_valid(uint8_t const *data, uint32_t datalen)
{
if (datalen < sizeof(struct sdp_audio_sink_profile))
return (0);
return (1);
}
static const attr_t audio_sink_profile_attrs[] = {
{SDP_ATTR_SERVICE_RECORD_HANDLE,
common_profile_create_service_record_handle},
{SDP_ATTR_SERVICE_CLASS_ID_LIST,
audio_sink_profile_create_service_class_id_list},
{SDP_ATTR_PROTOCOL_DESCRIPTOR_LIST,
audio_sink_profile_create_protocol_descriptor_list},
{SDP_ATTR_BROWSE_GROUP_LIST,
audio_sink_profile_create_browse_group_list},
{SDP_ATTR_LANGUAGE_BASE_ATTRIBUTE_ID_LIST,
common_profile_create_language_base_attribute_id_list},
{SDP_ATTR_BLUETOOTH_PROFILE_DESCRIPTOR_LIST,
audio_sink_profile_create_bluetooth_profile_descriptor_list},
{SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID + SDP_ATTR_SERVICE_NAME_OFFSET,
audio_sink_profile_create_service_name},
{SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID + SDP_ATTR_PROVIDER_NAME_OFFSET,
common_profile_create_service_provider_name},
{SDP_ATTR_SUPPORTED_FEATURES,
audio_sink_create_supported_features},
{} /* end entry */
};
profile_t audio_sink_profile_descriptor = {
SDP_SERVICE_CLASS_AUDIO_SINK,
sizeof(sdp_audio_sink_profile_t),
audio_sink_profile_valid,
(attr_t const *const)&audio_sink_profile_attrs
};

188
usr.sbin/bluetooth/sdpd/audio_source.c Normal file
View File

@ -0,0 +1,188 @@
/*-
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
*
* Copyright (c) 2019 Hans Petter Selasky <hselasky@freebsd.org>
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* $FreeBSD$
*/
#include <sys/queue.h>
#define L2CAP_SOCKET_CHECKED
#include <bluetooth.h>
#include <sdp.h>
#include <string.h>
#include "profile.h"
#include "provider.h"
static int32_t
audio_source_profile_create_service_class_id_list(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
static const uint16_t service_classes[] = {
SDP_SERVICE_CLASS_AUDIO_SOURCE,
};
return (common_profile_create_service_class_id_list(
buf, eob,
(uint8_t const *)service_classes,
sizeof(service_classes)));
}
static int32_t
audio_source_profile_create_protocol_descriptor_list(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
provider_p provider = (provider_p) data;
sdp_audio_source_profile_p audio_source = (sdp_audio_source_profile_p) provider->data;
if (buf + 18 > eob)
return (-1);
SDP_PUT8(SDP_DATA_SEQ8, buf);
SDP_PUT8(16, buf);
SDP_PUT8(SDP_DATA_SEQ8, buf);
SDP_PUT8(6, buf);
SDP_PUT8(SDP_DATA_UUID16, buf);
SDP_PUT16(SDP_UUID_PROTOCOL_L2CAP, buf);
SDP_PUT8(SDP_DATA_UINT16, buf);
SDP_PUT16(audio_source->psm, buf);
SDP_PUT8(SDP_DATA_SEQ8, buf);
SDP_PUT8(6, buf);
SDP_PUT8(SDP_DATA_UUID16, buf);
SDP_PUT16(SDP_UUID_PROTOCOL_AVDTP, buf);
SDP_PUT8(SDP_DATA_UINT16, buf);
SDP_PUT16(audio_source->protover, buf);
return (18);
}
static int32_t
audio_source_profile_create_browse_group_list(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
if (buf + 5 > eob)
return (-1);
SDP_PUT8(SDP_DATA_SEQ8, buf);
SDP_PUT8(3, buf);
SDP_PUT8(SDP_DATA_UUID16, buf);
SDP_PUT16(SDP_SERVICE_CLASS_PUBLIC_BROWSE_GROUP, buf);
return (5);
}
static int32_t
audio_source_profile_create_bluetooth_profile_descriptor_list(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
static const uint16_t profile_descriptor_list[] = {
SDP_SERVICE_CLASS_ADVANCED_AUDIO_DISTRIBUTION,
0x0100
};
return (common_profile_create_bluetooth_profile_descriptor_list(
buf, eob,
(uint8_t const *)profile_descriptor_list,
sizeof(profile_descriptor_list)));
}
static int32_t
audio_source_profile_create_service_name(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
static const char service_name[] = "Audio SRC";
return (common_profile_create_string8(
buf, eob,
(uint8_t const *)service_name, strlen(service_name)));
}
static int32_t
audio_source_create_supported_features(
uint8_t *buf, uint8_t const *const eob,
uint8_t const *data, uint32_t datalen)
{
provider_p provider = (provider_p) data;
sdp_audio_source_profile_p audio_source = (sdp_audio_source_profile_p) provider->data;
if (buf + 3 > eob)
return (-1);
SDP_PUT8(SDP_DATA_UINT16, buf);
SDP_PUT16(audio_source->features, buf);
return (3);
}
static int32_t
audio_source_profile_valid(uint8_t const *data, uint32_t datalen)
{
if (datalen < sizeof(struct sdp_audio_source_profile))
return (0);
return (1);
}
static const attr_t audio_source_profile_attrs[] = {
{SDP_ATTR_SERVICE_RECORD_HANDLE,
common_profile_create_service_record_handle},
{SDP_ATTR_SERVICE_CLASS_ID_LIST,
audio_source_profile_create_service_class_id_list},
{SDP_ATTR_PROTOCOL_DESCRIPTOR_LIST,
audio_source_profile_create_protocol_descriptor_list},
{SDP_ATTR_BROWSE_GROUP_LIST,
audio_source_profile_create_browse_group_list},
{SDP_ATTR_LANGUAGE_BASE_ATTRIBUTE_ID_LIST,
common_profile_create_language_base_attribute_id_list},
{SDP_ATTR_BLUETOOTH_PROFILE_DESCRIPTOR_LIST,
audio_source_profile_create_bluetooth_profile_descriptor_list},
{SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID + SDP_ATTR_SERVICE_NAME_OFFSET,
audio_source_profile_create_service_name},
{SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID + SDP_ATTR_PROVIDER_NAME_OFFSET,
common_profile_create_service_provider_name},
{SDP_ATTR_SUPPORTED_FEATURES,
audio_source_create_supported_features},
{} /* end entry */
};
profile_t audio_source_profile_descriptor = {
SDP_SERVICE_CLASS_AUDIO_SOURCE,
sizeof(sdp_audio_source_profile_t),
audio_source_profile_valid,
(attr_t const *const)&audio_source_profile_attrs
};

4
usr.sbin/bluetooth/sdpd/profile.c
View File

@ -48,6 +48,8 @@
profile_p
profile_get_descriptor(uint16_t uuid)
{
extern profile_t audio_sink_profile_descriptor;
extern profile_t audio_source_profile_descriptor;
extern profile_t dun_profile_descriptor;
extern profile_t ftrn_profile_descriptor;
extern profile_t irmc_profile_descriptor;
@ -60,6 +62,8 @@ profile_get_descriptor(uint16_t uuid)
extern profile_t panu_profile_descriptor;
static const profile_p profiles[] = {
&audio_sink_profile_descriptor,
&audio_source_profile_descriptor,
&dun_profile_descriptor,
&ftrn_profile_descriptor,
&irmc_profile_descriptor,