Return-Path: From: Santiago Carot-Nemesio To: linux-bluetooth@vger.kernel.org Cc: Santiago Carot-Nemesio Subject: [PATCH 21/26] Process md_reconnect_mdl_rsp Date: Fri, 4 Jun 2010 10:27:14 +0200 Message-Id: <1275640039-7245-22-git-send-email-sancane@gmail.com> In-Reply-To: <1275640039-7245-21-git-send-email-sancane@gmail.com> References: <1275640039-7245-1-git-send-email-sancane@gmail.com> <1275640039-7245-2-git-send-email-sancane@gmail.com> <1275640039-7245-3-git-send-email-sancane@gmail.com> <1275640039-7245-4-git-send-email-sancane@gmail.com> <1275640039-7245-5-git-send-email-sancane@gmail.com> <1275640039-7245-6-git-send-email-sancane@gmail.com> <1275640039-7245-7-git-send-email-sancane@gmail.com> <1275640039-7245-8-git-send-email-sancane@gmail.com> <1275640039-7245-9-git-send-email-sancane@gmail.com> <1275640039-7245-10-git-send-email-sancane@gmail.com> <1275640039-7245-11-git-send-email-sancane@gmail.com> <1275640039-7245-12-git-send-email-sancane@gmail.com> <1275640039-7245-13-git-send-email-sancane@gmail.com> <1275640039-7245-14-git-send-email-sancane@gmail.com> <1275640039-7245-15-git-send-email-sancane@gmail.com> <1275640039-7245-16-git-send-email-sancane@gmail.com> <1275640039-7245-17-git-send-email-sancane@gmail.com> <1275640039-7245-18-git-send-email-sancane@gmail.com> <1275640039-7245-19-git-send-email-sancane@gmail.com> <1275640039-7245-20-git-send-email-sancane@gmail.com> <1275640039-7245-21-git-send-email-sancane@gmail.com> Sender: linux-bluetooth-owner@vger.kernel.org List-ID: --- mcap/mcap.c | 39 ++++++++++++++++++++++++++++++++++++++- 1 files changed, 38 insertions(+), 1 deletions(-) diff --git a/mcap/mcap.c b/mcap/mcap.c index 4708fe7..bd22d54 100644 --- a/mcap/mcap.c +++ b/mcap/mcap.c @@ -1258,7 +1258,44 @@ fail: static gboolean process_md_reconnect_mdl_rsp(struct mcap_mcl *mcl, uint8_t *cmd, uint32_t len) { - return FALSE; + struct mcap_mdl_op_cb *reconn = mcl->priv_data; + struct mcap_mdl *mdl = reconn->mdl; + mcap_mdl_operation_cb reconn_cb = reconn->cb.op; + gpointer user_data = reconn->user_data; + mcap4B_rsp *rsp = (mcap4B_rsp *) cmd; + mcap_md_req *cmdlast = (mcap_md_req *) mcl->lcmd; + uint16_t mdlid = ntohs(cmdlast->mdl); + GError *gerr = NULL; + gboolean close = FALSE; + + g_free(mcl->priv_data); + mcl->priv_data = NULL; + + rsp->mdl = ntohs(rsp->mdl); + + close = check_err_rsp(rsp->mdl, mdlid, rsp->rc, len, + sizeof(mcap4B_rsp), &gerr); + + g_free(mcl->lcmd); + mcl->lcmd = NULL; + mcl->req = MCL_AVAILABLE; + + reconn_cb(mdl, gerr, user_data); + if (!gerr) + return close; + + g_error_free(gerr); + shutdown_mdl(mdl); + + if (rsp->rc != MCAP_INVALID_MDL) + return close; + + /* Remove cached mdlid */ + mcl->mdls = g_slist_remove(mcl->mdls, mdl); + mcl->cb->mdl_deleted(mdl, mcl->cb->user_data); + g_free(mdl); + + return close; } static gboolean process_md_abort_mdl_rsp(struct mcap_mcl *mcl, -- 1.6.3.3