Received: by 2002:a05:6359:c8b:b0:c7:702f:21d4 with SMTP id go11csp5122649rwb; Wed, 21 Sep 2022 03:34:15 -0700 (PDT) X-Google-Smtp-Source: AMsMyM5Ce+zxJHGx6TfstNtrN0BPUxkKOXj7QcNNz+rq+PyBq5UFyJVE7+SOKTo4YXgh7F5HY49y X-Received: by 2002:a17:907:2da1:b0:773:dc01:877a with SMTP id gt33-20020a1709072da100b00773dc01877amr20120642ejc.567.1663756455381; Wed, 21 Sep 2022 03:34:15 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1663756455; cv=none; d=google.com; s=arc-20160816; b=R5Fzc+5FYXEMS6m3L9oMMScAGSM3DxHTgnHUo4XTt0Swuo5wlYq8YfroxN2PUikF6j D6kUDSCCrRWkcPO1gMoc/D2PecSWSjB6aJpnjXKGS6tKlglDtr1wZPiJPp4bQLSJvUqx nZla8R2Ja74ekyuj+0OU9dS1TLmmVKGQ9xwsJ4twaqAkJwFXKaFCcc0syNGrsgBy4rU9 P4RXcEeQ3xbaBIEj/fphBx/uTeI2CKWjlig+/NJx8yW2XbHvDdQp5h/60BZOcMXsqa01 xBBIr9TlOY7JfTUbx8ENN9E1OIvKiAtpRTlUpa0wvtYDae+zDOnLlrbj1wO9t+ORQwev 4CNQ== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:content-transfer-encoding:mime-version :message-id:date:subject:cc:to:from:dkim-signature; bh=O5KqbYJ9fdVS+oJFCbzLh7sN15o4/DiF0SI2aE5qX7g=; b=Cxjfswg7IEDVSBhmvbXIO8Bd0USf2dL5f5CwvwFFbafI9IONGa0n1ySMtRYtwlBTQV WpmSxlFn6hbKOFyqVEkrpwnRP0YfbeEQBzNSbNtswcOKW/lFOsRnaGnnAx8n9QcxW5Nf zBZhjEP9r75/azPgqaRHUUOWMh+HC9N7vhMkN/zNjC7LxKwK9C6CowAoBDESmNDQVz8B EtRKaITKFyC4Mf1F/AZKI3//p1Wdn2++kNSxV49GWD4mqaxLCodqX0JjAWDvh4M06qts gqhY3TyUlUJazLloWDkgax6nV++D/VKq4zHRPuwZPLYEi2udptwZ92wJWHWb3U7kRvmA AsKg== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@intel.com header.s=Intel header.b=lYY0P3ye; spf=pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-bluetooth-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=intel.com Return-Path: Received: from out1.vger.email (out1.vger.email. [2620:137:e000::1:20]) by mx.google.com with ESMTP id s9-20020a056402520900b0044eb3af536bsi2581324edd.160.2022.09.21.03.33.49; Wed, 21 Sep 2022 03:34:15 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20; Authentication-Results: mx.google.com; dkim=pass header.i=@intel.com header.s=Intel header.b=lYY0P3ye; spf=pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-bluetooth-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=intel.com Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S229522AbiIUK0M (ORCPT + 99 others); Wed, 21 Sep 2022 06:26:12 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:59204 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S230088AbiIUK0H (ORCPT ); Wed, 21 Sep 2022 06:26:07 -0400 Received: from mga12.intel.com (mga12.intel.com [192.55.52.136]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 5E4468A1D2 for ; Wed, 21 Sep 2022 03:26:02 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=intel.com; i=@intel.com; q=dns/txt; s=Intel; t=1663755962; x=1695291962; h=from:to:cc:subject:date:message-id:mime-version: content-transfer-encoding; bh=/plOX4wdNj9YNVUvG9rD2OnTNSL1uOjPH9IYZ3X+Hu8=; b=lYY0P3yehq4EAdLpnfWJHmX01S8kM1YbKNG+Wh1feIobJmQeqHSpV4ef +cIVJrxQOcCxzYZGMtUL5mlUlP+9nxnjxRb60vvqiIMm4TcYElRQ3gZ25 kKxssCkAO6Rh3SHRiujFg1BYPc23gXIBGsxykq/SE+RwWj8RxJIMt5pSj bxYvF78oOQ2DgglaYT5RetkmqT1TZqGTYlA0iGolPRqV3kIyOl+OT6wdV ybLOBJAr27p+pMh9Sai6l7cbge98JNH8Axm/mWgOhw4kd1B7OGFdavwBv 3ot78CMOPTGpSB1vII6h1eTWpg0Ew4aSn/S0kJM6gYW25McwEDJEQ37f2 w==; X-IronPort-AV: E=McAfee;i="6500,9779,10476"; a="279688478" X-IronPort-AV: E=Sophos;i="5.93,333,1654585200"; d="scan'208";a="279688478" Received: from fmsmga005.fm.intel.com ([10.253.24.32]) by fmsmga106.fm.intel.com with ESMTP/TLS/ECDHE-RSA-AES256-GCM-SHA384; 21 Sep 2022 03:26:01 -0700 X-ExtLoop1: 1 X-IronPort-AV: E=Sophos;i="5.93,333,1654585200"; d="scan'208";a="948090215" Received: from bsblt022.iind.intel.com ([10.224.186.21]) by fmsmga005.fm.intel.com with ESMTP; 21 Sep 2022 03:26:00 -0700 From: Sathish Narasimman To: linux-bluetooth@vger.kernel.org Cc: Sathish Narasimman Subject: [PATCH BlueZ v2 1/2] shared/vcp: Add bt_vcp_set_debug Date: Wed, 21 Sep 2022 15:57:31 +0530 Message-Id: <20220921102732.688081-1-sathish.narasimman@intel.com> X-Mailer: git-send-email 2.25.1 MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Spam-Status: No, score=-4.4 required=5.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,DKIM_VALID_EF,RCVD_IN_DNSWL_MED,SPF_HELO_PASS, SPF_NONE autolearn=ham autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on lindbergh.monkeyblade.net Precedence: bulk List-ID: X-Mailing-List: linux-bluetooth@vger.kernel.org Add support for bt_vcp_set_debug and replace the exisiting DBG. --- src/shared/vcp.c | 238 ++++++++++++++++++++++++++++++----------------- src/shared/vcp.h | 5 + 2 files changed, 156 insertions(+), 87 deletions(-) diff --git a/src/shared/vcp.c b/src/shared/vcp.c index 4f8dc37e3c3e..5459cf892a7d 100644 --- a/src/shared/vcp.c +++ b/src/shared/vcp.c @@ -26,7 +26,9 @@ #include "src/shared/gatt-server.h" #include "src/shared/gatt-client.h" #include "src/shared/vcp.h" -#include "src/log.h" + +#define DBG(_vcp, fmt, arg...) \ + vcp_debug(_vcp, "%s:%s() " fmt, __FILE__, __func__, ## arg) #define VCP_STEP_SIZE 1 @@ -87,8 +89,11 @@ struct bt_vcp { unsigned int vstate_id; unsigned int vflag_id; + struct queue *notify; struct queue *pending; + bt_vcp_debug_func_t debug_func; + bt_vcp_destroy_func_t debug_destroy; void *debug_data; void *user_data; }; @@ -262,11 +267,23 @@ void bt_vcp_unref(struct bt_vcp *vcp) vcp_free(vcp); } +static void vcp_debug(struct bt_vcp *vcp, const char *format, ...) +{ + va_list ap; + + if (!vcp || !format || !vcp->debug_func) + return; + + va_start(ap, format); + util_debug_va(vcp->debug_func, vcp->debug_data, format, ap); + va_end(ap); +} + static void vcp_disconnected(int err, void *user_data) { struct bt_vcp *vcp = user_data; - DBG("vcp %p disconnected err %d", vcp, err); + DBG(vcp, "vcp %p disconnected err %d", vcp, err); bt_vcp_detach(vcp); } @@ -301,17 +318,17 @@ static uint8_t vcs_rel_vol_down(struct bt_vcs *vcs, struct bt_vcp *vcp, struct vol_state *vstate; uint8_t *change_counter; - DBG(""); + DBG(vcp, "Volume Down"); vdb = vcp_get_vdb(vcp); if (!vdb) { - DBG("error: VDB not availalbe"); + DBG(vcp, "error: VDB not available"); return 0; } vstate = vdb_get_vstate(vdb); if (!vstate) { - DBG("error: VSTATE not availalbe"); + DBG(vcp, "error: VSTATE not available"); return 0; } @@ -320,7 +337,7 @@ static uint8_t vcs_rel_vol_down(struct bt_vcs *vcs, struct bt_vcp *vcp, return 0; if (*change_counter != vstate->counter) { - DBG("Change Counter Mismatch Volume not decremented!"); + DBG(vcp, "Change Counter Mismatch Volume not decremented!"); return BT_ATT_ERROR_INVALID_CHANGE_COUNTER; } @@ -340,17 +357,17 @@ static uint8_t vcs_rel_vol_up(struct bt_vcs *vcs, struct bt_vcp *vcp, struct vol_state *vstate; uint8_t *change_counter; - DBG(""); + DBG(vcp, "Volume Up"); vdb = vcp_get_vdb(vcp); if (!vdb) { - DBG("error: VDB not availalbe"); + DBG(vcp, "error: VDB not available"); return 0; } vstate = vdb_get_vstate(vdb); if (!vstate) { - DBG("error: VCP database not availalbe!!!!"); + DBG(vcp, "error: VCP database not available"); return 0; } @@ -359,7 +376,7 @@ static uint8_t vcs_rel_vol_up(struct bt_vcs *vcs, struct bt_vcp *vcp, return 0; if (*change_counter != vstate->counter) { - DBG("Change Counter Mismatch Volume not decremented!"); + DBG(vcp, "Change Counter Mismatch Volume not decremented!"); return BT_ATT_ERROR_INVALID_CHANGE_COUNTER; } @@ -379,17 +396,17 @@ static uint8_t vcs_unmute_rel_vol_down(struct bt_vcs *vcs, struct bt_vcp *vcp, struct vol_state *vstate; uint8_t *change_counter; - DBG(""); + DBG(vcp, "Un Mute and Volume Down"); vdb = vcp_get_vdb(vcp); if (!vdb) { - DBG("error: VDB not availalbe"); + DBG(vcp, "error: VDB not available"); return 0; } vstate = vdb_get_vstate(vdb); if (!vstate) { - DBG("error: VCP database not availalbe!!!!"); + DBG(vcp, "error: VCP database not available"); return 0; } @@ -398,7 +415,7 @@ static uint8_t vcs_unmute_rel_vol_down(struct bt_vcs *vcs, struct bt_vcp *vcp, return 0; if (*change_counter != vstate->counter) { - DBG("Change Counter Mismatch Volume not decremented!"); + DBG(vcp, "Change Counter Mismatch Volume not decremented!"); return BT_ATT_ERROR_INVALID_CHANGE_COUNTER; } @@ -419,17 +436,17 @@ static uint8_t vcs_unmute_rel_vol_up(struct bt_vcs *vcs, struct bt_vcp *vcp, struct vol_state *vstate; uint8_t *change_counter; - DBG(""); + DBG(vcp, "UN Mute and Volume Up"); vdb = vcp_get_vdb(vcp); if (!vdb) { - DBG("error: VDB not availalbe"); + DBG(vcp, "error: VDB not available"); return 0; } vstate = vdb_get_vstate(vdb); if (!vstate) { - DBG("error: VSTATE not availalbe"); + DBG(vcp, "error: VSTATE not available"); return 0; } @@ -438,7 +455,7 @@ static uint8_t vcs_unmute_rel_vol_up(struct bt_vcs *vcs, struct bt_vcp *vcp, return 0; if (*change_counter != vstate->counter) { - DBG("Change Counter Mismatch Volume not decremented!"); + DBG(vcp, "Change Counter Mismatch Volume not decremented!"); return BT_ATT_ERROR_INVALID_CHANGE_COUNTER; } @@ -459,17 +476,17 @@ static uint8_t vcs_set_absolute_vol(struct bt_vcs *vcs, struct bt_vcp *vcp, struct vol_state *vstate; struct bt_vcs_ab_vol *req; - DBG(""); + DBG(vcp, "Set Absolute Volume"); vdb = vcp_get_vdb(vcp); if (!vdb) { - DBG("error: VDB not availalbe"); + DBG(vcp, "error: VDB not available"); return 0; } vstate = vdb_get_vstate(vdb); if (!vstate) { - DBG("error: VSTATE not availalbe"); + DBG(vcp, "error: VSTATE not available"); return 0; } @@ -478,7 +495,7 @@ static uint8_t vcs_set_absolute_vol(struct bt_vcs *vcs, struct bt_vcp *vcp, return 0; if (req->change_counter != vstate->counter) { - DBG("Change Counter Mismatch Volume not decremented!"); + DBG(vcp, "Change Counter Mismatch Volume not decremented!"); return BT_ATT_ERROR_INVALID_CHANGE_COUNTER; } @@ -498,17 +515,17 @@ static uint8_t vcs_unmute(struct bt_vcs *vcs, struct bt_vcp *vcp, struct vol_state *vstate; uint8_t *change_counter; - DBG(""); + DBG(vcp, "Un Mute"); vdb = vcp_get_vdb(vcp); if (!vdb) { - DBG("error: VDB not availalbe"); + DBG(vcp, "error: VDB not available"); return 0; } vstate = vdb_get_vstate(vdb); if (!vstate) { - DBG("error: VSTATE not availalbe"); + DBG(vcp, "error: VSTATE not available"); return 0; } @@ -517,7 +534,7 @@ static uint8_t vcs_unmute(struct bt_vcs *vcs, struct bt_vcp *vcp, return 0; if (*change_counter != vstate->counter) { - DBG("Change Counter Mismatch Volume not decremented!"); + DBG(vcp, "Change Counter Mismatch Volume not decremented!"); return BT_ATT_ERROR_INVALID_CHANGE_COUNTER; } @@ -537,17 +554,17 @@ static uint8_t vcs_mute(struct bt_vcs *vcs, struct bt_vcp *vcp, struct vol_state *vstate; uint8_t *change_counter; - DBG(""); + DBG(vcp, "MUTE"); vdb = vcp_get_vdb(vcp); if (!vdb) { - DBG("error: VDB not availalbe"); + DBG(vcp, "error: VDB not available"); return 0; } vstate = vdb_get_vstate(vdb); if (!vstate) { - DBG("error: VSTATE not availalbe"); + DBG(vcp, "error: VSTATE not available"); return 0; } @@ -556,7 +573,7 @@ static uint8_t vcs_mute(struct bt_vcs *vcs, struct bt_vcp *vcp, return 0; if (*change_counter != vstate->counter) { - DBG("Change Counter Mismatch Volume not decremented!"); + DBG(vcp, "Change Counter Mismatch Volume not decremented!"); return BT_ATT_ERROR_INVALID_CHANGE_COUNTER; } @@ -622,16 +639,16 @@ static void vcs_cp_write(struct gatt_db_attribute *attrib, struct vcs_op_handler *handler; uint8_t ret = BT_ATT_ERROR_REQUEST_NOT_SUPPORTED; - DBG(""); + DBG(vcp, "VCP Control Point Write"); if (offset) { - DBG("invalid offset %d", offset); + DBG(vcp, "invalid offset %d", offset); ret = BT_ATT_ERROR_INVALID_OFFSET; goto respond; } if (len < sizeof(*vcp_op)) { - DBG("invalid len %ld < %ld sizeof(*param)", len, + DBG(vcp, "invalid len %ld < %ld sizeof(*param)", len, sizeof(*vcp_op)); ret = BT_ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LEN; goto respond; @@ -639,14 +656,12 @@ static void vcs_cp_write(struct gatt_db_attribute *attrib, vcp_op = iov_pull_mem(&iov, sizeof(*vcp_op)); - DBG("op: %x", *vcp_op); - for (handler = vcp_handlers; handler && handler->str; handler++) { if (handler->op != *vcp_op) continue; if (iov.iov_len < handler->size) { - DBG("invalid len %ld < %ld handler->size", len, + DBG(vcp, "invalid len %ld < %ld handler->size", len, handler->size); ret = BT_ATT_ERROR_OPCODE_NOT_SUPPORTED; goto respond; @@ -656,11 +671,11 @@ static void vcs_cp_write(struct gatt_db_attribute *attrib, } if (handler && handler->str) { - DBG("%s", handler->str); + DBG(vcp, "%s", handler->str); ret = handler->func(vcs, vcp, &iov); } else { - DBG("Unknown opcode 0x%02x", *vcp_op); + DBG(vcp, "Unknown opcode 0x%02x", *vcp_op); ret = BT_ATT_ERROR_OPCODE_NOT_SUPPORTED; } @@ -676,8 +691,6 @@ static void vcs_state_read(struct gatt_db_attribute *attrib, struct bt_vcs *vcs = user_data; struct iovec iov; - DBG(""); - iov.iov_base = vcs->vstate; iov.iov_len = sizeof(*vcs->vstate); @@ -693,8 +706,6 @@ static void vcs_flag_read(struct gatt_db_attribute *attrib, struct bt_vcs *vcs = user_data; struct iovec iov; - DBG("vf: %x", vcs->vol_flag); - iov.iov_base = &vcs->vol_flag; iov.iov_len = sizeof(vcs->vol_flag); @@ -797,6 +808,22 @@ void bt_vcp_add_db(struct gatt_db *db) vcp_db_new(db); } +bool bt_vcp_set_debug(struct bt_vcp *vcp, bt_vcp_debug_func_t func, + void *user_data, bt_vcp_destroy_func_t destroy) +{ + if (!vcp) + return false; + + if (vcp->debug_destroy) + vcp->debug_destroy(vcp->debug_data); + + vcp->debug_func = func; + vcp->debug_destroy = destroy; + vcp->debug_data = user_data; + + return true; +} + unsigned int bt_vcp_register(bt_vcp_func_t attached, bt_vcp_func_t detached, void *user_data) { @@ -871,40 +898,28 @@ done: return vcp; } -static void vcp_vstate_register(uint16_t att_ecode, void *user_data) -{ - DBG(""); - if (att_ecode) - DBG("VCS register failed: 0x%04x", att_ecode); -} - -static void vcp_vflag_register(uint16_t att_ecode, void *user_data) -{ - DBG(""); - if (att_ecode) - DBG("VCS register failed: 0x%04x", att_ecode); -} - -static void vcp_vstate_notify(uint16_t value_handle, const uint8_t *value, - uint16_t length, void *user_data) +static void vcp_vstate_notify(struct bt_vcp *vcp, uint16_t value_handle, + const uint8_t *value, uint16_t length, + void *user_data) { struct vol_state vstate; memcpy(&vstate, value, sizeof(struct vol_state)); - DBG("Vol Settings 0x%x", vstate.vol_set); - DBG("Mute Status 0x%x", vstate.mute); - DBG("Vol Counter 0x%x", vstate.counter); + DBG(vcp, "Vol Settings 0x%x", vstate.vol_set); + DBG(vcp, "Mute Status 0x%x", vstate.mute); + DBG(vcp, "Vol Counter 0x%x", vstate.counter); } -static void vcp_vflag_notify(uint16_t value_handle, const uint8_t *value, - uint16_t length, void *user_data) +static void vcp_vflag_notify(struct bt_vcp *vcp, uint16_t value_handle, + const uint8_t *value, uint16_t length, + void *user_data) { uint8_t vflag; memcpy(&vflag, value, sizeof(vflag)); - DBG("Vol Flag 0x%x", vflag); + DBG(vcp, "Vol Flag 0x%x", vflag); } static void read_vol_flag(struct bt_vcp *vcp, bool success, uint8_t att_ecode, @@ -918,17 +933,17 @@ static void read_vol_flag(struct bt_vcp *vcp, bool success, uint8_t att_ecode, }; if (!success) { - DBG("Unable to read VCP Vol State: error 0x%02x", att_ecode); + DBG(vcp, "Unable to read Vol Flag: error 0x%02x", att_ecode); return; } vol_flag = iov_pull_mem(&iov, sizeof(*vol_flag)); if (!vol_flag) { - DBG("Unable to get Vol State"); + DBG(vcp, "Unable to get Vol Flag"); return; } - DBG("Vol Flag:%x", *vol_flag); + DBG(vcp, "Vol Flag:%x", *vol_flag); } static void read_vol_state(struct bt_vcp *vcp, bool success, uint8_t att_ecode, @@ -942,19 +957,19 @@ static void read_vol_state(struct bt_vcp *vcp, bool success, uint8_t att_ecode, }; if (!success) { - DBG("Unable to read VCP Vol State: error 0x%02x", att_ecode); + DBG(vcp, "Unable to read Vol State: error 0x%02x", att_ecode); return; } vs = iov_pull_mem(&iov, sizeof(*vs)); if (!vs) { - DBG("Unable to get Vol State"); + DBG(vcp, "Unable to get Vol State"); return; } - DBG("Vol Set:%x", vs->vol_set); - DBG("Vol Mute:%x", vs->mute); - DBG("Vol Counter:%x", vs->counter); + DBG(vcp, "Vol Set:%x", vs->vol_set); + DBG(vcp, "Vol Mute:%x", vs->mute); + DBG(vcp, "Vol Counter:%x", vs->counter); } static void vcp_pending_destroy(void *data) @@ -991,7 +1006,7 @@ static void vcp_read_value(struct bt_vcp *vcp, uint16_t value_handle, vcp_pending_complete, pending, vcp_pending_destroy); if (!pending->id) { - DBG("Unable to send Read request"); + DBG(vcp, "Unable to send Read request"); free(pending); return; } @@ -999,6 +1014,60 @@ static void vcp_read_value(struct bt_vcp *vcp, uint16_t value_handle, queue_push_tail(vcp->pending, pending); } +static void vcp_register(uint16_t att_ecode, void *user_data) +{ + struct bt_vcp_notify *notify = user_data; + + if (att_ecode) + DBG(notify->vcp, "VCP register failed: 0x%04x", att_ecode); +} + +static void vcp_notify(uint16_t value_handle, const uint8_t *value, + uint16_t length, void *user_data) +{ + struct bt_vcp_notify *notify = user_data; + + if (notify->func) + notify->func(notify->vcp, value_handle, value, length, + notify->user_data); +} + +static void vcp_notify_destroy(void *data) +{ + struct bt_vcp_notify *notify = data; + struct bt_vcp *vcp = notify->vcp; + + if (queue_remove_if(vcp->notify, NULL, notify)) + free(notify); +} + +static unsigned int vcp_register_notify(struct bt_vcp *vcp, + uint16_t value_handle, + vcp_notify_t func, + void *user_data) +{ + struct bt_vcp_notify *notify; + + notify = new0(struct bt_vcp_notify, 1); + notify->vcp = vcp; + notify->func = func; + notify->user_data = user_data; + + notify->id = bt_gatt_client_register_notify(vcp->client, + value_handle, vcp_register, + vcp_notify, notify, + vcp_notify_destroy); + if (!notify->id) { + DBG(vcp, "Unable to register for notifications"); + free(notify); + return 0; + } + + queue_push_tail(vcp->notify, notify); + + return notify->id; +} + static void foreach_vcs_char(struct gatt_db_attribute *attr, void *user_data) { struct bt_vcp *vcp = user_data; @@ -1006,7 +1075,6 @@ static void foreach_vcs_char(struct gatt_db_attribute *attr, void *user_data) bt_uuid_t uuid, uuid_vstate, uuid_cp, uuid_vflag; struct bt_vcs *vcs; - DBG(""); if (!gatt_db_attribute_get_char_data(attr, NULL, &value_handle, NULL, NULL, &uuid)) return; @@ -1016,7 +1084,7 @@ static void foreach_vcs_char(struct gatt_db_attribute *attr, void *user_data) bt_uuid16_create(&uuid_vflag, VOL_FLAG_CHRC_UUID); if (!bt_uuid_cmp(&uuid, &uuid_vstate)) { - DBG("VCS Volume state found: handle 0x%04x", value_handle); + DBG(vcp, "VCS Vol state found: handle 0x%04x", value_handle); vcs = vcp_get_vcs(vcp); if (!vcs || vcs->vs) @@ -1025,16 +1093,15 @@ static void foreach_vcs_char(struct gatt_db_attribute *attr, void *user_data) vcs->vs = attr; vcp_read_value(vcp, value_handle, read_vol_state, vcp); - vcp->vstate_id = bt_gatt_client_register_notify(vcp->client, - value_handle, - vcp_vstate_register, - vcp_vstate_notify, vcp, NULL); + + vcp->vstate_id = vcp_register_notify(vcp, value_handle, + vcp_vstate_notify, NULL); return; } if (!bt_uuid_cmp(&uuid, &uuid_cp)) { - DBG("VCS Volume CP found: handle 0x%04x", value_handle); + DBG(vcp, "VCS Volume CP found: handle 0x%04x", value_handle); vcs = vcp_get_vcs(vcp); if (!vcs || vcs->vol_cp) @@ -1046,7 +1113,7 @@ static void foreach_vcs_char(struct gatt_db_attribute *attr, void *user_data) } if (!bt_uuid_cmp(&uuid, &uuid_vflag)) { - DBG("VCS Vol Flaf found: handle 0x%04x", value_handle); + DBG(vcp, "VCS Vol Flag found: handle 0x%04x", value_handle); vcs = vcp_get_vcs(vcp); if (!vcs || vcs->vf) @@ -1055,12 +1122,10 @@ static void foreach_vcs_char(struct gatt_db_attribute *attr, void *user_data) vcs->vf = attr; vcp_read_value(vcp, value_handle, read_vol_flag, vcp); - vcp->vflag_id = bt_gatt_client_register_notify(vcp->client, - value_handle, - vcp_vflag_register, - vcp_vflag_notify, vcp, NULL); - } + vcp->vflag_id = vcp_register_notify(vcp, value_handle, + vcp_vflag_notify, NULL); + } } static void foreach_vcs_service(struct gatt_db_attribute *attr, @@ -1069,7 +1134,6 @@ static void foreach_vcs_service(struct gatt_db_attribute *attr, struct bt_vcp *vcp = user_data; struct bt_vcs *vcs = vcp_get_vcs(vcp); - DBG(""); vcs->service = attr; gatt_db_service_set_claimed(attr, true); diff --git a/src/shared/vcp.h b/src/shared/vcp.h index 1a999c7776fd..26db5732d19b 100644 --- a/src/shared/vcp.h +++ b/src/shared/vcp.h @@ -33,6 +33,8 @@ struct bt_vcp; +typedef void (*bt_vcp_destroy_func_t)(void *user_data); +typedef void (*bt_vcp_debug_func_t)(const char *str, void *user_data); typedef void (*bt_vcp_func_t)(struct bt_vcp *vcp, void *user_data); struct bt_vcp *bt_vcp_ref(struct bt_vcp *vcp); @@ -43,6 +45,9 @@ void bt_vcp_add_db(struct gatt_db *db); bool bt_vcp_attach(struct bt_vcp *vcp, struct bt_gatt_client *client); void bt_vcp_detach(struct bt_vcp *vcp); +bool bt_vcp_set_debug(struct bt_vcp *vcp, bt_vcp_debug_func_t cb, + void *user_data, bt_vcp_destroy_func_t destroy); + struct bt_att *bt_vcp_get_att(struct bt_vcp *vcp); bool bt_vcp_set_user_data(struct bt_vcp *vcp, void *user_data); -- 2.25.1