From: Santiago Carot Nemesio <sancane@xxxxxxxxx> --- mcap/mcap.c | 50 ++++++++++++++++++++++++++++++++++++++++++++++++++ 1 files changed, 50 insertions(+), 0 deletions(-) diff --git a/mcap/mcap.c b/mcap/mcap.c index beb7385..1d01937 100644 --- a/mcap/mcap.c +++ b/mcap/mcap.c @@ -213,6 +213,20 @@ static uint16_t generate_mdlid(struct mcap_mcl *mcl) return mdlid; } +static uint8_t *create_req(uint8_t op, uint16_t mdl_id) +{ + uint8_t *req; + mcap_md_req *req_cmd; + + req = g_malloc0(sizeof(mcap_md_req)); + + req_cmd = (mcap_md_req *)req; + req_cmd->op = op; + req_cmd->mdl = htons(mdl_id); + + return req; +} + static uint8_t *create_mdl_req(uint16_t mdl_id, uint8_t mdep, uint8_t conf) { uint8_t *req; @@ -307,6 +321,42 @@ void mcap_req_mdl_creation(struct mcap_mcl *mcl, mcl->tid = g_timeout_add_seconds(RESPONSE_TIMER, wait_response_timer, mcl); } +void mcap_req_mdl_reconnect(struct mcap_mdl *mdl, + GError **err, + mcap_mdl_operation_cb reconnect_cb, + gpointer user_data) +{ + struct mcap_mdl_op_cb *con; + struct mcap_mcl *mcl = mdl->mcl; + uint8_t *cmd; + + if (mdl->state != MDL_CLOSED) { + g_set_error(err, MCAP_ERROR, MCAP_ERROR_FAILED, + "MDL is not closed"); + return; + } + con = g_new0(struct mcap_mdl_op_cb, 1); + + cmd = create_req(MCAP_MD_RECONNECT_MDL_REQ, mdl->mdlid); + mcap_send_std_opcode(mcl, cmd, sizeof(mcap_md_req), err); + if (*err) { + g_free(con); + g_free(cmd); + return; + } + + mdl->state = MDL_WAITING; + + con->mdl = mdl; + con->cb.op = reconnect_cb; + con->user_data = user_data; + + mcl->state = MCL_ACTIVE; + mcl->priv_data = con; + + mcl->tid = g_timeout_add_seconds(RESPONSE_TIMER, wait_response_timer, mcl); +} + static void default_mdl_connected_cb(struct mcap_mdl *mdl, gpointer data) { debug("MCAP Unmanaged mdl connection"); -- 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