From: Santiago Carot Nemesio <sancane@xxxxxxxxx> --- mcap/mcap.c | 39 ++++++++++++++++++++++++++++++++++++++- 1 files changed, 38 insertions(+), 1 deletions(-) diff --git a/mcap/mcap.c b/mcap/mcap.c index d469dfc..147f322 100644 --- a/mcap/mcap.c +++ b/mcap/mcap.c @@ -1288,6 +1288,43 @@ static gboolean process_md_reconnect_mdl_rsp(struct mcap_mcl *mcl, return close; } +static gboolean process_md_abort_mdl_rsp(struct mcap_mcl *mcl, + uint8_t *cmd, uint32_t len) +{ + struct mcap_mdl_op_cb *abrt = mcl->priv_data; + struct mcap_mdl *mdl = abrt->mdl; + mcap_mdl_del_cb abrt_cb = abrt->cb.del; + gpointer user_data = abrt->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; + + if (gerr) { + abrt_cb(gerr, user_data); + g_error_free(gerr); + return close; + } + + mcl->mdls = g_slist_remove(mcl->mdls, mdl); + g_free(mdl); + update_mcl_state(mcl); + abrt_cb(gerr, user_data); + return close; +} + static gboolean check_rsp(struct mcap_mcl *mcl, uint8_t *cmd, uint32_t len) { mcap4B_rsp *rsp; @@ -1355,7 +1392,7 @@ static void proc_response(struct mcap_mcl *mcl, uint8_t *cmd, uint32_t len) close = process_md_reconnect_mdl_rsp(mcl, cmd, len); break; case MCAP_MD_ABORT_MDL_RSP: - /* close = process_md_abort_mdl_rsp(mcl, cmd, len); */ + close = process_md_abort_mdl_rsp(mcl, cmd, len); break; case MCAP_MD_DELETE_MDL_RSP: /* close = process_md_delete_mdl_rsp(mcl, cmd, len); */ -- 1.6.3.3 -- To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html