|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
* BlueZ - Bluetooth protocol stack for Linux
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
* Copyright (C) 2001-2002 Nokia Corporation
|
|
Packit Service |
8264ee |
* Copyright (C) 2002-2003 Maxim Krasnyansky <maxk@qualcomm.com>
|
|
Packit Service |
8264ee |
* Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
|
|
Packit Service |
8264ee |
* Copyright (C) 2002-2003 Stephen Crane <steve.crane@rococosoft.com>
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
* This program is free software; you can redistribute it and/or modify
|
|
Packit Service |
8264ee |
* it under the terms of the GNU General Public License as published by
|
|
Packit Service |
8264ee |
* the Free Software Foundation; either version 2 of the License, or
|
|
Packit Service |
8264ee |
* (at your option) any later version.
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
* This program is distributed in the hope that it will be useful,
|
|
Packit Service |
8264ee |
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
Packit Service |
8264ee |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
Packit Service |
8264ee |
* GNU General Public License for more details.
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
* You should have received a copy of the GNU General Public License
|
|
Packit Service |
8264ee |
* along with this program; if not, write to the Free Software
|
|
Packit Service |
8264ee |
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#ifdef HAVE_CONFIG_H
|
|
Packit Service |
8264ee |
#include <config.h>
|
|
Packit Service |
8264ee |
#endif
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#include <errno.h>
|
|
Packit Service |
8264ee |
#include <stdlib.h>
|
|
Packit Service |
8264ee |
#include <assert.h>
|
|
Packit Service |
8264ee |
#include <sys/time.h>
|
|
Packit Service |
8264ee |
#include <stdbool.h>
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#include <glib.h>
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#include "lib/bluetooth.h"
|
|
Packit Service |
8264ee |
#include "lib/sdp.h"
|
|
Packit Service |
8264ee |
#include "lib/sdp_lib.h"
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#include "src/shared/util.h"
|
|
Packit Service |
8264ee |
#include "sdpd.h"
|
|
Packit Service |
8264ee |
#include "log.h"
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_A2DP_SRC_ANSWER_CALL_DURING_AUDIO (1ULL << 0)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_A2DP_SNK_ANSWER_CALL_DURING_AUDIO (1ULL << 1)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_A2DP_SRC_OUTGOING_CALL_DURING_AUDIO (1ULL << 2)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_A2DP_SNK_OUTGOING_CALL_DURING_AUDIO (1ULL << 3)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_A2DP_SRC_REJECT_CALL_DURING_AUDIO (1ULL << 4)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_A2DP_SNK_SRC_REJECT_CALL_DURING_AUDIO (1ULL << 5)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_A2DP_SRC_TERMINATE_CALL_DURING_AVP (1ULL << 6)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_A2DP_SNK_TERMINATE_CALL_DURING_AVP (1ULL << 7)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_A2DP_SRC_PRESS_PLAY_DURING_ACTIVE_CALL (1ULL << 8)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_A2DP_SNK_PRESS_PLAY_DURING_ACTIVE_CALL (1ULL << 9)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_A2DP_SRC_START_AUDIO_STREAM_AFTER_PLAY (1ULL << 10)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_A2DP_SNK_START_AUDIO_STREAM_AFTER_PLAY (1ULL << 11)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_A2DP_SRC_SUSPEND_AUDIO_STREAM_ON_PAUSE (1ULL << 12)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_A2DP_SNK_SUSPEND_AUDIO_STREAM_ON_PAUSE (1ULL << 13)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_DUN_GW_DATA_COMM_DURING_VOICE_CALL (1ULL << 14)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_DUN_DT_DATA_COMM_DURING_VOICE_CALL (1ULL << 15)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_DUN_GW_OUTGOING_CALL_DURING_DATA_COMM (1ULL << 16)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_DUN_DT_OUTGOING_CALL_DURING_DATA_COMM (1ULL << 17)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_DUN_GW_INCOMING_CALL_DURING_DATA_COMM (1ULL << 18)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_DUN_DT_INCOMING_CALL_DURING_DATA_COMM (1ULL << 19)
|
|
Packit Service |
8264ee |
#define MPSD_A2DP_SRC_DUN_GW_START_AUDIO_DURING_DATA_COMM (1ULL << 20)
|
|
Packit Service |
8264ee |
#define MPSD_A2DP_SNK_DUN_DT_START_AUDIO_DURING_DATA_COMM (1ULL << 21)
|
|
Packit Service |
8264ee |
#define MPSD_A2DP_SRC_DUN_GW_DATA_COMM_DURING_AUDIO_STREAM (1ULL << 22)
|
|
Packit Service |
8264ee |
#define MPSD_A2DP_SNK_DUN_DT_DATA_COMM_DURING_AUDIO_STREAM (1ULL << 23)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_DUN_GW_TERMINATE_CALL_DURING_DATA_COMM (1ULL << 24)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_DUN_DT_TERMINATE_CALL_DURING_DATA_COMM (1ULL << 25)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_PAN_NAP_DATA_COMM_DURING_VOICE_CALL (1ULL << 26)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_PAN_PANU_DATA_COMM_DURING_VOICE_CALL (1ULL << 27)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_PAN_NAP_OUTGOING_CALL_DURING_DATA_COMM (1ULL << 28)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_PAN_PANU_OUTGOING_CALL_DURING_DATA_COMM (1ULL << 29)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_AG_PAN_NAP_INCOMING_CALL_DURING_DATA_COMM (1ULL << 30)
|
|
Packit Service |
8264ee |
#define MPSD_HFP_HF_PAN_PANU_INCOMING_CALL_DURING_DATA_COMM (1ULL << 31)
|
|
Packit Service |
8264ee |
#define MPSD_A2DP_SRC_PAN_NAP_START_AUDIO_DURING_DATA_COMM (1ULL << 32)
|
|
Packit Service |
8264ee |
#define MPSD_A2DP_SNK_PAN_PANU_START_AUDIO_DURING_DATA_COMM (1ULL << 33)
|
|
Packit Service |
8264ee |
#define MPSD_A2DP_SRC_PAN_NAP_DATA_COMM_DURING_AUDIO_STREAM (1ULL << 34)
|
|
Packit Service |
8264ee |
#define MPSD_A2DP_SNK_PAN_PANU_DATA_COMM_DURING_AUDIO_STREAM (1ULL << 35)
|
|
Packit Service |
8264ee |
#define MPSD_A2DP_SRC_PBAP_SRV_PB_DL_DURING_AUDIO_STREAM (1ULL << 36)
|
|
Packit Service |
8264ee |
#define MPSD_A2DP_SNK_PBAP_CLI_PB_DL_DURING_AUDIO_STREAM (1ULL << 37)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_ANSWER_CALL_DURING_AUDIO (1ULL << 0)
|
|
Packit Service |
8264ee |
#define MPMD_A2DP_SRC_AVRCP_TG_ANSWER_CALL_DURING_AUDIO (1ULL << 1)
|
|
Packit Service |
8264ee |
#define MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_OUTGOING_CALL_DURING_AUDIO (1ULL << 2)
|
|
Packit Service |
8264ee |
#define MPMD_A2DP_SRC_AVRCP_TG_OUTGOING_CALL_DURING_AUDIO (1ULL << 3)
|
|
Packit Service |
8264ee |
#define MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_REJECT_CALL_DURING_AUDIO (1ULL << 4)
|
|
Packit Service |
8264ee |
#define MPMD_A2DP_SRC_AVRCP_TG_REJECT_CALL_DURING_AUDIO (1ULL << 5)
|
|
Packit Service |
8264ee |
#define MPMD_HFP_AG_CALL_TERMINATION_DURING_AVP (1ULL << 6)
|
|
Packit Service |
8264ee |
#define MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_TERMINATION_DURING_AVP (1ULL << 7)
|
|
Packit Service |
8264ee |
#define MPMD_A2DP_SRC_AVRCP_TG_TERMINATION_DURING_AVP (1ULL << 8)
|
|
Packit Service |
8264ee |
#define MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_PLAY_DURING_CALL (1ULL << 9)
|
|
Packit Service |
8264ee |
#define MPMD_A2DP_SRC_AVRCP_TG_PRESS_PLAY_DURING_CALL (1ULL << 10)
|
|
Packit Service |
8264ee |
#define MPMD_AVRCP_CT_NO_A2DP_SNK_START_AUDIO_AFTER_PLAY (1ULL << 11)
|
|
Packit Service |
8264ee |
#define MPMD_A2DP_SRC_AVRCP_TG_START_AUDIO_AFTER_PLAY (1ULL << 12)
|
|
Packit Service |
8264ee |
#define MPMD_AVRCP_CT_NO_A2DP_SNK_SUSPEND_AUDIO_AFTER_PAUSE (1ULL << 13)
|
|
Packit Service |
8264ee |
#define MPMD_A2DP_SRC_AVRCP_TG_SUSPEND_AUDIO_AFTER_PAUSE (1ULL << 14)
|
|
Packit Service |
8264ee |
#define MPMD_A2DP_SRC_AVRCP_TG_START_AUDIO_DURING_DATA_COMM (1ULL << 15)
|
|
Packit Service |
8264ee |
#define MPMD_A2DP_SNK_AVRCP_CT_DUN_DT_AUDIO_DURING_DATA_COMM (1ULL << 16)
|
|
Packit Service |
8264ee |
#define MPMD_A2DP_SRC_AVRCP_TG_START_DATA_DURING_AUDIO (1ULL << 17)
|
|
Packit Service |
8264ee |
#define MPMD_A2DP_SNK_AVRCP_CT_DUN_DT_START_DATA_DURING_AUDIO (1ULL << 18)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Note: in spec dependency bit position starts from 1 (bit 0 unused?) */
|
|
Packit Service |
8264ee |
#define MPS_DEPS_SNIFF_MODE_DURRING_STREAMING (1ULL << 1)
|
|
Packit Service |
8264ee |
#define MPS_DEPS_GAVDP_REQUIREMENTS (1ULL << 2)
|
|
Packit Service |
8264ee |
#define MPS_DEPS_DIS_CONNECTION_ORDER_BEHAVIOR (1ULL << 3)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
* default MPS features are all disabled, will be updated if relevant service
|
|
Packit Service |
8264ee |
* is (un)registered
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
#define MPS_MPSD_DEFAULT_FEATURES 0
|
|
Packit Service |
8264ee |
#define MPS_MPMD_DEFAULT_FEATURES 0
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
* Those defines bits for all features that depend on specific profile and role.
|
|
Packit Service |
8264ee |
* If profile is not supported then all those bits should not be set in record
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
#define MPS_MPSD_HFP_AG (MPSD_HFP_AG_A2DP_SRC_ANSWER_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_OUTGOING_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_REJECT_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_TERMINATE_CALL_DURING_AVP | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_PRESS_PLAY_DURING_ACTIVE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_START_AUDIO_STREAM_AFTER_PLAY | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_DUN_GW_DATA_COMM_DURING_VOICE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_SUSPEND_AUDIO_STREAM_ON_PAUSE | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_DUN_GW_OUTGOING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_DUN_GW_INCOMING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_DUN_GW_TERMINATE_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_PAN_NAP_DATA_COMM_DURING_VOICE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_PAN_NAP_OUTGOING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_PAN_NAP_INCOMING_CALL_DURING_DATA_COMM)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_HFP_HF (MPSD_HFP_HF_A2DP_SNK_ANSWER_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_OUTGOING_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_SRC_REJECT_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_TERMINATE_CALL_DURING_AVP | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_PRESS_PLAY_DURING_ACTIVE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_START_AUDIO_STREAM_AFTER_PLAY | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_SUSPEND_AUDIO_STREAM_ON_PAUSE | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_DUN_DT_DATA_COMM_DURING_VOICE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_DUN_DT_OUTGOING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_DUN_DT_INCOMING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_DUN_DT_TERMINATE_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_PAN_PANU_DATA_COMM_DURING_VOICE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_PAN_PANU_OUTGOING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_PAN_PANU_INCOMING_CALL_DURING_DATA_COMM)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_A2DP_SRC (MPSD_HFP_AG_A2DP_SRC_ANSWER_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_OUTGOING_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_REJECT_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_TERMINATE_CALL_DURING_AVP | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_PRESS_PLAY_DURING_ACTIVE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_START_AUDIO_STREAM_AFTER_PLAY | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_A2DP_SRC_SUSPEND_AUDIO_STREAM_ON_PAUSE | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SRC_DUN_GW_START_AUDIO_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SRC_DUN_GW_DATA_COMM_DURING_AUDIO_STREAM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SRC_PAN_NAP_START_AUDIO_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SRC_PAN_NAP_DATA_COMM_DURING_AUDIO_STREAM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SRC_PBAP_SRV_PB_DL_DURING_AUDIO_STREAM)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_A2DP_SNK (MPSD_HFP_HF_A2DP_SNK_ANSWER_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_OUTGOING_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_SRC_REJECT_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_TERMINATE_CALL_DURING_AVP | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_PRESS_PLAY_DURING_ACTIVE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_START_AUDIO_STREAM_AFTER_PLAY | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_A2DP_SNK_SUSPEND_AUDIO_STREAM_ON_PAUSE | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SNK_DUN_DT_START_AUDIO_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SNK_DUN_DT_DATA_COMM_DURING_AUDIO_STREAM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SNK_PAN_PANU_START_AUDIO_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SNK_PAN_PANU_DATA_COMM_DURING_AUDIO_STREAM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SNK_PBAP_CLI_PB_DL_DURING_AUDIO_STREAM)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_AVRCP_CT MPS_MPSD_A2DP_SNK
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_AVRCP_TG MPS_MPSD_A2DP_SRC
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_DUN_GW (MPSD_HFP_AG_DUN_GW_DATA_COMM_DURING_VOICE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_DUN_GW_OUTGOING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_DUN_GW_INCOMING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SRC_DUN_GW_START_AUDIO_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SRC_DUN_GW_DATA_COMM_DURING_AUDIO_STREAM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_DUN_GW_TERMINATE_CALL_DURING_DATA_COMM)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_DUN_DT (MPSD_HFP_HF_DUN_DT_DATA_COMM_DURING_VOICE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_DUN_DT_OUTGOING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_DUN_DT_INCOMING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SNK_DUN_DT_START_AUDIO_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SNK_DUN_DT_DATA_COMM_DURING_AUDIO_STREAM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_DUN_DT_TERMINATE_CALL_DURING_DATA_COMM)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_PAN_NAP (MPSD_HFP_AG_PAN_NAP_DATA_COMM_DURING_VOICE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_PAN_NAP_OUTGOING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_AG_PAN_NAP_INCOMING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SRC_PAN_NAP_START_AUDIO_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SRC_PAN_NAP_DATA_COMM_DURING_AUDIO_STREAM)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_PAN_PANU (MPSD_HFP_HF_PAN_PANU_DATA_COMM_DURING_VOICE_CALL | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_PAN_PANU_OUTGOING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_HFP_HF_PAN_PANU_INCOMING_CALL_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SNK_PAN_PANU_START_AUDIO_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPSD_A2DP_SNK_PAN_PANU_DATA_COMM_DURING_AUDIO_STREAM)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_PBAP_SRC MPSD_A2DP_SRC_PBAP_SRV_PB_DL_DURING_AUDIO_STREAM
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_PBAP_CLI MPSD_A2DP_SNK_PBAP_CLI_PB_DL_DURING_AUDIO_STREAM
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPSD_ALL (MPS_MPSD_HFP_AG | MPS_MPSD_HFP_HF | \
|
|
Packit Service |
8264ee |
MPS_MPSD_A2DP_SRC | MPS_MPSD_A2DP_SNK | \
|
|
Packit Service |
8264ee |
MPS_MPSD_AVRCP_CT | MPS_MPSD_AVRCP_TG | \
|
|
Packit Service |
8264ee |
MPS_MPSD_DUN_GW | MPS_MPSD_DUN_DT | \
|
|
Packit Service |
8264ee |
MPS_MPSD_PAN_NAP | MPS_MPSD_PAN_PANU | \
|
|
Packit Service |
8264ee |
MPS_MPSD_PBAP_SRC | MPS_MPSD_PBAP_CLI)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPMD_HFP_AG MPMD_HFP_AG_CALL_TERMINATION_DURING_AVP
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPMD_HFP_HF ( \
|
|
Packit Service |
8264ee |
MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_ANSWER_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_OUTGOING_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_REJECT_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_TERMINATION_DURING_AVP | \
|
|
Packit Service |
8264ee |
MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_PLAY_DURING_CALL)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPMD_A2DP_SRC (MPMD_A2DP_SRC_AVRCP_TG_ANSWER_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SRC_AVRCP_TG_OUTGOING_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SRC_AVRCP_TG_REJECT_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SRC_AVRCP_TG_TERMINATION_DURING_AVP | \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SRC_AVRCP_TG_PRESS_PLAY_DURING_CALL | \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SRC_AVRCP_TG_START_AUDIO_AFTER_PLAY | \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SRC_AVRCP_TG_SUSPEND_AUDIO_AFTER_PAUSE | \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SRC_AVRCP_TG_START_AUDIO_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SRC_AVRCP_TG_START_DATA_DURING_AUDIO)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPMD_A2DP_SNK ( \
|
|
Packit Service |
8264ee |
MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_ANSWER_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_OUTGOING_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_REJECT_CALL_DURING_AUDIO | \
|
|
Packit Service |
8264ee |
MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_TERMINATION_DURING_AVP | \
|
|
Packit Service |
8264ee |
MPMD_HFP_HF_A2DP_SNK_AVRCP_CT_PLAY_DURING_CALL | \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SNK_AVRCP_CT_DUN_DT_AUDIO_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SNK_AVRCP_CT_DUN_DT_START_DATA_DURING_AUDIO)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPMD_AVRCP_CT MPS_MPMD_A2DP_SNK
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* should be set only if CT is supported but SNK is not supported */
|
|
Packit Service |
8264ee |
#define MPS_MPMD_AVRCP_CT_ONLY ( \
|
|
Packit Service |
8264ee |
MPMD_AVRCP_CT_NO_A2DP_SNK_START_AUDIO_AFTER_PLAY | \
|
|
Packit Service |
8264ee |
MPMD_AVRCP_CT_NO_A2DP_SNK_SUSPEND_AUDIO_AFTER_PAUSE)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPMD_AVRCP_TG MPS_MPMD_A2DP_SRC
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPMD_DUN_DT ( \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SNK_AVRCP_CT_DUN_DT_AUDIO_DURING_DATA_COMM | \
|
|
Packit Service |
8264ee |
MPMD_A2DP_SNK_AVRCP_CT_DUN_DT_START_DATA_DURING_AUDIO)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define MPS_MPMD_ALL (MPS_MPMD_HFP_AG | MPS_MPMD_HFP_HF | MPS_MPMD_A2DP_SRC | \
|
|
Packit Service |
8264ee |
MPS_MPMD_A2DP_SNK | MPS_MPMD_AVRCP_CT | \
|
|
Packit Service |
8264ee |
MPS_MPMD_AVRCP_CT_ONLY | MPS_MPMD_AVRCP_TG | \
|
|
Packit Service |
8264ee |
MPS_MPMD_DUN_DT)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Assume all dependencies are supported */
|
|
Packit Service |
8264ee |
#define MPS_DEFAULT_DEPS (MPS_DEPS_SNIFF_MODE_DURRING_STREAMING | \
|
|
Packit Service |
8264ee |
MPS_DEPS_GAVDP_REQUIREMENTS | \
|
|
Packit Service |
8264ee |
MPS_DEPS_DIS_CONNECTION_ORDER_BEHAVIOR)
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static sdp_record_t *server = NULL;
|
|
Packit Service |
8264ee |
static uint32_t fixed_dbts = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
* List of version numbers supported by the SDP server.
|
|
Packit Service |
8264ee |
* Add to this list when newer versions are supported.
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
static sdp_version_t sdpVnumArray[1] = {
|
|
Packit Service |
8264ee |
{ 1, 0 }
|
|
Packit Service |
8264ee |
};
|
|
Packit Service |
8264ee |
static const int sdpServerVnumEntries = 1;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static uint32_t mps_handle = 0;
|
|
Packit Service |
8264ee |
static bool mps_mpmd = false;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
* A simple function which returns the time of day in
|
|
Packit Service |
8264ee |
* seconds. Used for updating the service db state
|
|
Packit Service |
8264ee |
* attribute of the service record of the SDP server
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
uint32_t sdp_get_time(void)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
* To handle failure in gettimeofday, so an old
|
|
Packit Service |
8264ee |
* value is returned and service does not fail
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
static struct timeval tm;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
gettimeofday(&tm, NULL);
|
|
Packit Service |
8264ee |
return (uint32_t) tm.tv_sec;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
* The service database state is an attribute of the service record
|
|
Packit Service |
8264ee |
* of the SDP server itself. This attribute is guaranteed to
|
|
Packit Service |
8264ee |
* change if any of the contents of the service repository
|
|
Packit Service |
8264ee |
* changes. This function updates the timestamp of value of
|
|
Packit Service |
8264ee |
* the svcDBState attribute
|
|
Packit Service |
8264ee |
* Set the SDP server DB. Simply a timestamp which is the marker
|
|
Packit Service |
8264ee |
* when the DB was modified.
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
static void update_db_timestamp(void)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
if (fixed_dbts) {
|
|
Packit Service |
8264ee |
sdp_data_t *d = sdp_data_alloc(SDP_UINT32, &fixed_dbts);
|
|
Packit Service |
8264ee |
sdp_attr_replace(server, SDP_ATTR_SVCDB_STATE, d);
|
|
Packit Service |
8264ee |
} else {
|
|
Packit Service |
8264ee |
uint32_t dbts = sdp_get_time();
|
|
Packit Service |
8264ee |
sdp_data_t *d = sdp_data_alloc(SDP_UINT32, &dbts);
|
|
Packit Service |
8264ee |
sdp_attr_replace(server, SDP_ATTR_SVCDB_STATE, d);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
void set_fixed_db_timestamp(uint32_t dbts)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
fixed_dbts = dbts;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
void register_public_browse_group(void)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_list_t *browselist;
|
|
Packit Service |
8264ee |
uuid_t bgscid, pbgid;
|
|
Packit Service |
8264ee |
sdp_data_t *sdpdata;
|
|
Packit Service |
8264ee |
sdp_record_t *browse = sdp_record_alloc();
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
browse->handle = SDP_SERVER_RECORD_HANDLE + 1;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_record_add(BDADDR_ANY, browse);
|
|
Packit Service |
8264ee |
sdpdata = sdp_data_alloc(SDP_UINT32, &browse->handle);
|
|
Packit Service |
8264ee |
sdp_attr_add(browse, SDP_ATTR_RECORD_HANDLE, sdpdata);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&bgscid, BROWSE_GRP_DESC_SVCLASS_ID);
|
|
Packit Service |
8264ee |
browselist = sdp_list_append(0, &bgscid);
|
|
Packit Service |
8264ee |
sdp_set_service_classes(browse, browselist);
|
|
Packit Service |
8264ee |
sdp_list_free(browselist, 0);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&pbgid, PUBLIC_BROWSE_GROUP);
|
|
Packit Service |
8264ee |
sdp_attr_add_new(browse, SDP_ATTR_GROUP_ID,
|
|
Packit Service |
8264ee |
SDP_UUID16, &pbgid.value.uuid16);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
* The SDP server must present its own service record to
|
|
Packit Service |
8264ee |
* the service repository. This can be accessed by service
|
|
Packit Service |
8264ee |
* discovery clients. This method constructs a service record
|
|
Packit Service |
8264ee |
* and stores it in the repository
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
void register_server_service(void)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_list_t *classIDList;
|
|
Packit Service |
8264ee |
uuid_t classID;
|
|
Packit Service |
8264ee |
void **versions, **versionDTDs;
|
|
Packit Service |
8264ee |
uint8_t dtd;
|
|
Packit Service |
8264ee |
sdp_data_t *pData;
|
|
Packit Service |
8264ee |
int i;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
server = sdp_record_alloc();
|
|
Packit Service |
8264ee |
server->pattern = NULL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Force the record to be SDP_SERVER_RECORD_HANDLE */
|
|
Packit Service |
8264ee |
server->handle = SDP_SERVER_RECORD_HANDLE;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_record_add(BDADDR_ANY, server);
|
|
Packit Service |
8264ee |
sdp_attr_add(server, SDP_ATTR_RECORD_HANDLE,
|
|
Packit Service |
8264ee |
sdp_data_alloc(SDP_UINT32, &server->handle));
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&classID, SDP_SERVER_SVCLASS_ID);
|
|
Packit Service |
8264ee |
classIDList = sdp_list_append(0, &classID);
|
|
Packit Service |
8264ee |
sdp_set_service_classes(server, classIDList);
|
|
Packit Service |
8264ee |
sdp_list_free(classIDList, 0);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
* Set the version numbers supported, these are passed as arguments
|
|
Packit Service |
8264ee |
* to the server on command line. Now defaults to 1.0
|
|
Packit Service |
8264ee |
* Build the version number sequence first
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
versions = malloc(sdpServerVnumEntries * sizeof(void *));
|
|
Packit Service |
8264ee |
versionDTDs = malloc(sdpServerVnumEntries * sizeof(void *));
|
|
Packit Service |
8264ee |
dtd = SDP_UINT16;
|
|
Packit Service |
8264ee |
for (i = 0; i < sdpServerVnumEntries; i++) {
|
|
Packit Service |
8264ee |
uint16_t *version = malloc(sizeof(uint16_t));
|
|
Packit Service |
8264ee |
*version = sdpVnumArray[i].major;
|
|
Packit Service |
8264ee |
*version = (*version << 8);
|
|
Packit Service |
8264ee |
*version |= sdpVnumArray[i].minor;
|
|
Packit Service |
8264ee |
versions[i] = version;
|
|
Packit Service |
8264ee |
versionDTDs[i] = &dtd;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
pData = sdp_seq_alloc(versionDTDs, versions, sdpServerVnumEntries);
|
|
Packit Service |
8264ee |
for (i = 0; i < sdpServerVnumEntries; i++)
|
|
Packit Service |
8264ee |
free(versions[i]);
|
|
Packit Service |
8264ee |
free(versions);
|
|
Packit Service |
8264ee |
free(versionDTDs);
|
|
Packit Service |
8264ee |
sdp_attr_add(server, SDP_ATTR_VERSION_NUM_LIST, pData);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
update_db_timestamp();
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
void register_device_id(uint16_t source, uint16_t vendor,
|
|
Packit Service |
8264ee |
uint16_t product, uint16_t version)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
const uint16_t spec = 0x0103;
|
|
Packit Service |
8264ee |
const uint8_t primary = 1;
|
|
Packit Service |
8264ee |
sdp_list_t *class_list, *group_list, *profile_list;
|
|
Packit Service |
8264ee |
uuid_t class_uuid, group_uuid;
|
|
Packit Service |
8264ee |
sdp_data_t *sdp_data, *primary_data, *source_data;
|
|
Packit Service |
8264ee |
sdp_data_t *spec_data, *vendor_data, *product_data, *version_data;
|
|
Packit Service |
8264ee |
sdp_profile_desc_t profile;
|
|
Packit Service |
8264ee |
sdp_record_t *record = sdp_record_alloc();
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("Adding device id record for %04x:%04x:%04x:%04x",
|
|
Packit Service |
8264ee |
source, vendor, product, version);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
record->handle = sdp_next_handle();
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_record_add(BDADDR_ANY, record);
|
|
Packit Service |
8264ee |
sdp_data = sdp_data_alloc(SDP_UINT32, &record->handle);
|
|
Packit Service |
8264ee |
sdp_attr_add(record, SDP_ATTR_RECORD_HANDLE, sdp_data);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&class_uuid, PNP_INFO_SVCLASS_ID);
|
|
Packit Service |
8264ee |
class_list = sdp_list_append(0, &class_uuid);
|
|
Packit Service |
8264ee |
sdp_set_service_classes(record, class_list);
|
|
Packit Service |
8264ee |
sdp_list_free(class_list, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&group_uuid, PUBLIC_BROWSE_GROUP);
|
|
Packit Service |
8264ee |
group_list = sdp_list_append(NULL, &group_uuid);
|
|
Packit Service |
8264ee |
sdp_set_browse_groups(record, group_list);
|
|
Packit Service |
8264ee |
sdp_list_free(group_list, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&profile.uuid, PNP_INFO_PROFILE_ID);
|
|
Packit Service |
8264ee |
profile.version = spec;
|
|
Packit Service |
8264ee |
profile_list = sdp_list_append(NULL, &profile);
|
|
Packit Service |
8264ee |
sdp_set_profile_descs(record, profile_list);
|
|
Packit Service |
8264ee |
sdp_list_free(profile_list, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
spec_data = sdp_data_alloc(SDP_UINT16, &spec);
|
|
Packit Service |
8264ee |
sdp_attr_add(record, 0x0200, spec_data);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
vendor_data = sdp_data_alloc(SDP_UINT16, &vendor);
|
|
Packit Service |
8264ee |
sdp_attr_add(record, 0x0201, vendor_data);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
product_data = sdp_data_alloc(SDP_UINT16, &product);
|
|
Packit Service |
8264ee |
sdp_attr_add(record, 0x0202, product_data);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
version_data = sdp_data_alloc(SDP_UINT16, &version);
|
|
Packit Service |
8264ee |
sdp_attr_add(record, 0x0203, version_data);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
primary_data = sdp_data_alloc(SDP_BOOL, &primary);
|
|
Packit Service |
8264ee |
sdp_attr_add(record, 0x0204, primary_data);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
source_data = sdp_data_alloc(SDP_UINT16, &source);
|
|
Packit Service |
8264ee |
sdp_attr_add(record, 0x0205, source_data);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
update_db_timestamp();
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static bool class_supported(uint16_t class)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_list_t *list;
|
|
Packit Service |
8264ee |
uuid_t uuid;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&uuid, class);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
for (list = sdp_get_record_list(); list; list = list->next) {
|
|
Packit Service |
8264ee |
sdp_record_t *rec = list->data;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (sdp_uuid_cmp(&rec->svclass, &uuid) == 0)
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static uint64_t mps_mpsd_features(void)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
uint64_t feat = MPS_MPSD_ALL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(HANDSFREE_AGW_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_HFP_AG;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(HANDSFREE_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_HFP_HF;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(AUDIO_SOURCE_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_A2DP_SRC;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(AUDIO_SINK_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_A2DP_SNK;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(AV_REMOTE_CONTROLLER_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_AVRCP_CT;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(AV_REMOTE_TARGET_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_AVRCP_TG;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(DIALUP_NET_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_DUN_GW;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* TODO */
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_DUN_DT;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(NAP_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_PAN_NAP;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(PANU_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_PAN_PANU;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(PBAP_PSE_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_PBAP_SRC;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(PBAP_PCE_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPSD_PBAP_CLI;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return feat;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static uint64_t mps_mpmd_features(void)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
uint64_t feat = MPS_MPMD_ALL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(HANDSFREE_AGW_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPMD_HFP_AG;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(HANDSFREE_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPMD_HFP_HF;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(AUDIO_SOURCE_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPMD_A2DP_SRC;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(AUDIO_SINK_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPMD_A2DP_SNK;
|
|
Packit Service |
8264ee |
else
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPMD_AVRCP_CT_ONLY;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(AV_REMOTE_CONTROLLER_SVCLASS_ID)) {
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPMD_AVRCP_CT;
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPMD_AVRCP_CT_ONLY;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!class_supported(AV_REMOTE_TARGET_SVCLASS_ID))
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPMD_AVRCP_TG;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* TODO */
|
|
Packit Service |
8264ee |
feat &= ~MPS_MPMD_DUN_DT;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return feat;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static sdp_record_t *mps_record(int mpmd)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_data_t *mpsd_features, *mpmd_features, *dependencies;
|
|
Packit Service |
8264ee |
sdp_list_t *svclass_id, *pfseq, *root;
|
|
Packit Service |
8264ee |
uuid_t root_uuid, svclass_uuid;
|
|
Packit Service |
8264ee |
sdp_profile_desc_t profile;
|
|
Packit Service |
8264ee |
sdp_record_t *record;
|
|
Packit Service |
8264ee |
uint64_t mpsd_feat = MPS_MPSD_DEFAULT_FEATURES;
|
|
Packit Service |
8264ee |
uint64_t mpmd_feat = MPS_MPMD_DEFAULT_FEATURES;
|
|
Packit Service |
8264ee |
uint16_t deps = MPS_DEFAULT_DEPS;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
record = sdp_record_alloc();
|
|
Packit Service |
8264ee |
if (!record)
|
|
Packit Service |
8264ee |
return NULL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
|
|
Packit Service |
8264ee |
root = sdp_list_append(NULL, &root_uuid);
|
|
Packit Service |
8264ee |
sdp_set_browse_groups(record, root);
|
|
Packit Service |
8264ee |
sdp_list_free(root, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&svclass_uuid, MPS_SVCLASS_ID);
|
|
Packit Service |
8264ee |
svclass_id = sdp_list_append(NULL, &svclass_uuid);
|
|
Packit Service |
8264ee |
sdp_set_service_classes(record, svclass_id);
|
|
Packit Service |
8264ee |
sdp_list_free(svclass_id, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&profile.uuid, MPS_PROFILE_ID);
|
|
Packit Service |
8264ee |
profile.version = 0x0100;
|
|
Packit Service |
8264ee |
pfseq = sdp_list_append(NULL, &profile);
|
|
Packit Service |
8264ee |
sdp_set_profile_descs(record, pfseq);
|
|
Packit Service |
8264ee |
sdp_list_free(pfseq, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
mpsd_features = sdp_data_alloc(SDP_UINT64, &mpsd_feat);
|
|
Packit Service |
8264ee |
sdp_attr_add(record, SDP_ATTR_MPSD_SCENARIOS, mpsd_features);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (mpmd) {
|
|
Packit Service |
8264ee |
mpmd_features = sdp_data_alloc(SDP_UINT64, &mpmd_feat);
|
|
Packit Service |
8264ee |
sdp_attr_add(record, SDP_ATTR_MPMD_SCENARIOS, mpmd_features);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
dependencies = sdp_data_alloc(SDP_UINT16, &deps);
|
|
Packit Service |
8264ee |
sdp_attr_add(record, SDP_ATTR_MPS_DEPENDENCIES, dependencies);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_set_info_attr(record, "Multi Profile", 0, 0);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return record;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
void register_mps(bool mpmd)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_record_t *record;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
record = mps_record(mpmd);
|
|
Packit Service |
8264ee |
if (!record)
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (add_record_to_server(BDADDR_ANY, record) < 0) {
|
|
Packit Service |
8264ee |
sdp_record_free(record);
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
mps_handle = record->handle;
|
|
Packit Service |
8264ee |
mps_mpmd = mpmd;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void update_mps(void)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_record_t *rec;
|
|
Packit Service |
8264ee |
sdp_data_t *data;
|
|
Packit Service |
8264ee |
uint64_t mpsd_feat, mpmd_feat;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!mps_handle)
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
rec = sdp_record_find(mps_handle);
|
|
Packit Service |
8264ee |
if (!rec)
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
mpsd_feat = mps_mpsd_features();
|
|
Packit Service |
8264ee |
data = sdp_data_alloc(SDP_UINT64, &mpsd_feat);
|
|
Packit Service |
8264ee |
sdp_attr_replace(rec, SDP_ATTR_MPSD_SCENARIOS, data);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (mps_mpmd) {
|
|
Packit Service |
8264ee |
mpmd_feat = mps_mpmd_features();
|
|
Packit Service |
8264ee |
data = sdp_data_alloc(SDP_UINT64, &mpmd_feat);
|
|
Packit Service |
8264ee |
sdp_attr_replace(rec, SDP_ATTR_MPMD_SCENARIOS, data);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
int add_record_to_server(const bdaddr_t *src, sdp_record_t *rec)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_data_t *data;
|
|
Packit Service |
8264ee |
sdp_list_t *pattern;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (rec->handle == 0xffffffff) {
|
|
Packit Service |
8264ee |
rec->handle = sdp_next_handle();
|
|
Packit Service |
8264ee |
if (rec->handle < 0x10000)
|
|
Packit Service |
8264ee |
return -ENOSPC;
|
|
Packit Service |
8264ee |
} else {
|
|
Packit Service |
8264ee |
if (sdp_record_find(rec->handle))
|
|
Packit Service |
8264ee |
return -EEXIST;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("Adding record with handle 0x%05x", rec->handle);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_record_add(src, rec);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
data = sdp_data_alloc(SDP_UINT32, &rec->handle);
|
|
Packit Service |
8264ee |
sdp_attr_replace(rec, SDP_ATTR_RECORD_HANDLE, data);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (sdp_data_get(rec, SDP_ATTR_BROWSE_GRP_LIST) == NULL) {
|
|
Packit Service |
8264ee |
uuid_t uuid;
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&uuid, PUBLIC_BROWSE_GROUP);
|
|
Packit Service |
8264ee |
sdp_pattern_add_uuid(rec, &uuid);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
for (pattern = rec->pattern; pattern; pattern = pattern->next) {
|
|
Packit Service |
8264ee |
char uuid[32];
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (pattern->data == NULL)
|
|
Packit Service |
8264ee |
continue;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_uuid2strn((uuid_t *) pattern->data, uuid, sizeof(uuid));
|
|
Packit Service |
8264ee |
DBG("Record pattern UUID %s", uuid);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
update_mps();
|
|
Packit Service |
8264ee |
update_db_timestamp();
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
int remove_record_from_server(uint32_t handle)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_record_t *rec;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Refuse to remove the server's own record */
|
|
Packit Service |
8264ee |
if (handle == SDP_SERVER_RECORD_HANDLE)
|
|
Packit Service |
8264ee |
return -EINVAL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("Removing record with handle 0x%05x", handle);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
rec = sdp_record_find(handle);
|
|
Packit Service |
8264ee |
if (!rec)
|
|
Packit Service |
8264ee |
return -ENOENT;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (sdp_record_remove(handle) == 0) {
|
|
Packit Service |
8264ee |
update_mps();
|
|
Packit Service |
8264ee |
update_db_timestamp();
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_record_free(rec);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* FIXME: refactor for server-side */
|
|
Packit Service |
8264ee |
static sdp_record_t *extract_pdu_server(bdaddr_t *device, uint8_t *p,
|
|
Packit Service |
8264ee |
unsigned int bufsize,
|
|
Packit Service |
8264ee |
uint32_t handleExpected, int *scanned)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
int extractStatus = -1, localExtractedLength = 0;
|
|
Packit Service |
8264ee |
uint8_t dtd;
|
|
Packit Service |
8264ee |
int seqlen = 0;
|
|
Packit Service |
8264ee |
sdp_record_t *rec = NULL;
|
|
Packit Service |
8264ee |
uint16_t attrId, lookAheadAttrId;
|
|
Packit Service |
8264ee |
sdp_data_t *pAttr = NULL;
|
|
Packit Service |
8264ee |
uint32_t handle = 0xffffffff;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
*scanned = sdp_extract_seqtype(p, bufsize, &dtd, &seqlen);
|
|
Packit Service |
8264ee |
p += *scanned;
|
|
Packit Service |
8264ee |
bufsize -= *scanned;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (bufsize < sizeof(uint8_t) + sizeof(uint8_t)) {
|
|
Packit Service |
8264ee |
SDPDBG("Unexpected end of packet");
|
|
Packit Service |
8264ee |
return NULL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
lookAheadAttrId = get_be16(p + sizeof(uint8_t));
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
SDPDBG("Look ahead attr id : %d", lookAheadAttrId);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (lookAheadAttrId == SDP_ATTR_RECORD_HANDLE) {
|
|
Packit Service |
8264ee |
if (bufsize < (sizeof(uint8_t) * 2) +
|
|
Packit Service |
8264ee |
sizeof(uint16_t) + sizeof(uint32_t)) {
|
|
Packit Service |
8264ee |
SDPDBG("Unexpected end of packet");
|
|
Packit Service |
8264ee |
return NULL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
handle = get_be32(p + sizeof(uint8_t) + sizeof(uint16_t) +
|
|
Packit Service |
8264ee |
sizeof(uint8_t));
|
|
Packit Service |
8264ee |
SDPDBG("SvcRecHandle : 0x%x", handle);
|
|
Packit Service |
8264ee |
rec = sdp_record_find(handle);
|
|
Packit Service |
8264ee |
} else if (handleExpected != 0xffffffff)
|
|
Packit Service |
8264ee |
rec = sdp_record_find(handleExpected);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!rec) {
|
|
Packit Service |
8264ee |
rec = sdp_record_alloc();
|
|
Packit Service |
8264ee |
rec->attrlist = NULL;
|
|
Packit Service |
8264ee |
if (lookAheadAttrId == SDP_ATTR_RECORD_HANDLE) {
|
|
Packit Service |
8264ee |
rec->handle = handle;
|
|
Packit Service |
8264ee |
sdp_record_add(device, rec);
|
|
Packit Service |
8264ee |
} else if (handleExpected != 0xffffffff) {
|
|
Packit Service |
8264ee |
rec->handle = handleExpected;
|
|
Packit Service |
8264ee |
sdp_record_add(device, rec);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
} else {
|
|
Packit Service |
8264ee |
sdp_list_free(rec->attrlist, (sdp_free_func_t) sdp_data_free);
|
|
Packit Service |
8264ee |
rec->attrlist = NULL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
while (localExtractedLength < seqlen) {
|
|
Packit Service |
8264ee |
int attrSize = sizeof(uint8_t);
|
|
Packit Service |
8264ee |
int attrValueLength = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (bufsize < attrSize + sizeof(uint16_t)) {
|
|
Packit Service |
8264ee |
SDPDBG("Unexpected end of packet: Terminating extraction of attributes");
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
SDPDBG("Extract PDU, sequenceLength: %d localExtractedLength: %d",
|
|
Packit Service |
8264ee |
seqlen, localExtractedLength);
|
|
Packit Service |
8264ee |
dtd = *(uint8_t *) p;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
attrId = get_be16(p + attrSize);
|
|
Packit Service |
8264ee |
attrSize += sizeof(uint16_t);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
SDPDBG("DTD of attrId : %d Attr id : 0x%x", dtd, attrId);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
pAttr = sdp_extract_attr(p + attrSize, bufsize - attrSize,
|
|
Packit Service |
8264ee |
&attrValueLength, rec);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
SDPDBG("Attr id : 0x%x attrValueLength : %d", attrId, attrValueLength);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
attrSize += attrValueLength;
|
|
Packit Service |
8264ee |
if (pAttr == NULL) {
|
|
Packit Service |
8264ee |
SDPDBG("Terminating extraction of attributes");
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
localExtractedLength += attrSize;
|
|
Packit Service |
8264ee |
p += attrSize;
|
|
Packit Service |
8264ee |
bufsize -= attrSize;
|
|
Packit Service |
8264ee |
sdp_attr_replace(rec, attrId, pAttr);
|
|
Packit Service |
8264ee |
extractStatus = 0;
|
|
Packit Service |
8264ee |
SDPDBG("Extract PDU, seqLength: %d localExtractedLength: %d",
|
|
Packit Service |
8264ee |
seqlen, localExtractedLength);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (extractStatus == 0) {
|
|
Packit Service |
8264ee |
SDPDBG("Successful extracting of Svc Rec attributes");
|
|
Packit Service |
8264ee |
#ifdef SDP_DEBUG
|
|
Packit Service |
8264ee |
sdp_print_service_attr(rec->attrlist);
|
|
Packit Service |
8264ee |
#endif
|
|
Packit Service |
8264ee |
*scanned += seqlen;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
return rec;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
* Add the newly created service record to the service repository
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
int service_register_req(sdp_req_t *req, sdp_buf_t *rsp)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
int scanned = 0;
|
|
Packit Service |
8264ee |
sdp_data_t *handle;
|
|
Packit Service |
8264ee |
uint8_t *p = req->buf + sizeof(sdp_pdu_hdr_t);
|
|
Packit Service |
8264ee |
int bufsize = req->len - sizeof(sdp_pdu_hdr_t);
|
|
Packit Service |
8264ee |
sdp_record_t *rec;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
req->flags = *p++;
|
|
Packit Service |
8264ee |
if (req->flags & SDP_DEVICE_RECORD) {
|
|
Packit Service |
8264ee |
bacpy(&req->device, (bdaddr_t *) p);
|
|
Packit Service |
8264ee |
p += sizeof(bdaddr_t);
|
|
Packit Service |
8264ee |
bufsize -= sizeof(bdaddr_t);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* save image of PDU: we need it when clients request this attribute */
|
|
Packit Service |
8264ee |
rec = extract_pdu_server(&req->device, p, bufsize, 0xffffffff, &scanned);
|
|
Packit Service |
8264ee |
if (!rec)
|
|
Packit Service |
8264ee |
goto invalid;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (rec->handle == 0xffffffff) {
|
|
Packit Service |
8264ee |
rec->handle = sdp_next_handle();
|
|
Packit Service |
8264ee |
if (rec->handle < 0x10000) {
|
|
Packit Service |
8264ee |
sdp_record_free(rec);
|
|
Packit Service |
8264ee |
goto invalid;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
} else {
|
|
Packit Service |
8264ee |
if (sdp_record_find(rec->handle)) {
|
|
Packit Service |
8264ee |
/* extract_pdu_server will add the record handle
|
|
Packit Service |
8264ee |
* if it is missing. So instead of failing, skip
|
|
Packit Service |
8264ee |
* the record adding to avoid duplication. */
|
|
Packit Service |
8264ee |
goto success;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sdp_record_add(&req->device, rec);
|
|
Packit Service |
8264ee |
if (!(req->flags & SDP_RECORD_PERSIST))
|
|
Packit Service |
8264ee |
sdp_svcdb_set_collectable(rec, req->sock);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
handle = sdp_data_alloc(SDP_UINT32, &rec->handle);
|
|
Packit Service |
8264ee |
sdp_attr_replace(rec, SDP_ATTR_RECORD_HANDLE, handle);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
success:
|
|
Packit Service |
8264ee |
/* if the browse group descriptor is NULL,
|
|
Packit Service |
8264ee |
* ensure that the record belongs to the ROOT group */
|
|
Packit Service |
8264ee |
if (sdp_data_get(rec, SDP_ATTR_BROWSE_GRP_LIST) == NULL) {
|
|
Packit Service |
8264ee |
uuid_t uuid;
|
|
Packit Service |
8264ee |
sdp_uuid16_create(&uuid, PUBLIC_BROWSE_GROUP);
|
|
Packit Service |
8264ee |
sdp_pattern_add_uuid(rec, &uuid);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
update_db_timestamp();
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Build a rsp buffer */
|
|
Packit Service |
8264ee |
put_be32(rec->handle, rsp->data);
|
|
Packit Service |
8264ee |
rsp->data_size = sizeof(uint32_t);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
invalid:
|
|
Packit Service |
8264ee |
put_be16(SDP_INVALID_SYNTAX, rsp->data);
|
|
Packit Service |
8264ee |
rsp->data_size = sizeof(uint16_t);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return -1;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
* Update a service record
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
int service_update_req(sdp_req_t *req, sdp_buf_t *rsp)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_record_t *orec, *nrec;
|
|
Packit Service |
8264ee |
int status = 0, scanned = 0;
|
|
Packit Service |
8264ee |
uint8_t *p = req->buf + sizeof(sdp_pdu_hdr_t);
|
|
Packit Service |
8264ee |
int bufsize = req->len - sizeof(sdp_pdu_hdr_t);
|
|
Packit Service |
8264ee |
uint32_t handle = get_be32(p);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
SDPDBG("Svc Rec Handle: 0x%x", handle);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
p += sizeof(uint32_t);
|
|
Packit Service |
8264ee |
bufsize -= sizeof(uint32_t);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
orec = sdp_record_find(handle);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
SDPDBG("SvcRecOld: %p", orec);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!orec) {
|
|
Packit Service |
8264ee |
status = SDP_INVALID_RECORD_HANDLE;
|
|
Packit Service |
8264ee |
goto done;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
nrec = extract_pdu_server(BDADDR_ANY, p, bufsize, handle, &scanned);
|
|
Packit Service |
8264ee |
if (!nrec) {
|
|
Packit Service |
8264ee |
status = SDP_INVALID_SYNTAX;
|
|
Packit Service |
8264ee |
goto done;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
assert(nrec == orec);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
update_db_timestamp();
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
done:
|
|
Packit Service |
8264ee |
p = rsp->data;
|
|
Packit Service |
8264ee |
put_be16(status, p);
|
|
Packit Service |
8264ee |
rsp->data_size = sizeof(uint16_t);
|
|
Packit Service |
8264ee |
return status;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
* Remove a registered service record
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
int service_remove_req(sdp_req_t *req, sdp_buf_t *rsp)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
uint8_t *p = req->buf + sizeof(sdp_pdu_hdr_t);
|
|
Packit Service |
8264ee |
uint32_t handle = get_be32(p);
|
|
Packit Service |
8264ee |
sdp_record_t *rec;
|
|
Packit Service |
8264ee |
int status = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* extract service record handle */
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
rec = sdp_record_find(handle);
|
|
Packit Service |
8264ee |
if (rec) {
|
|
Packit Service |
8264ee |
sdp_svcdb_collect(rec);
|
|
Packit Service |
8264ee |
status = sdp_record_remove(handle);
|
|
Packit Service |
8264ee |
sdp_record_free(rec);
|
|
Packit Service |
8264ee |
if (status == 0)
|
|
Packit Service |
8264ee |
update_db_timestamp();
|
|
Packit Service |
8264ee |
} else {
|
|
Packit Service |
8264ee |
status = SDP_INVALID_RECORD_HANDLE;
|
|
Packit Service |
8264ee |
SDPDBG("Could not find record : 0x%x", handle);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
p = rsp->data;
|
|
Packit Service |
8264ee |
put_be16(status, p);
|
|
Packit Service |
8264ee |
rsp->data_size = sizeof(uint16_t);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return status;
|
|
Packit Service |
8264ee |
}
|