root/usr.sbin/bluetooth/sdpd/audio_source.c
/*-
 * SPDX-License-Identifier: BSD-2-Clause
 *
 * 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.
 */

#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
};