EC600G/components/ql-application/bt/bt_hfp_demo.c

/*================================================================
  Copyright (c) 2021, Quectel Wireless Solutions Co., Ltd. All rights reserved.
  Quectel Wireless Solutions Proprietary and Confidential.
=================================================================*/
    
#include <stdio.h>
#include <string.h>
#include <stdlib.h>

#include "ql_api_osi.h"
#include "ql_api_bt.h"
#include "ql_api_bt_hfp.h"

#include "ql_log.h"
#include "bt_hfp_demo.h"

#define QL_BT_HFP_LOG_LEVEL         	QL_LOG_LEVEL_INFO
#define QL_BT_HFP_LOG(msg, ...)			QL_LOG(QL_BT_HFP_LOG_LEVEL, "ql_BT_HFP_DEMO", msg, ##__VA_ARGS__)
#define QL_BT_HFP_LOG_PUSH(msg, ...)	QL_LOG_PUSH("ql_BT_HFP_DEMO", msg, ##__VA_ARGS__)

ql_task_t bt_hfp_demo_task = NULL;
static ql_bt_addr_s ql_bt_hfp_remote_addr = {{0x66, 0xCA, 0xC9, 0xA2, 0x3E, 0x38}};
static unsigned char ql_bt_hfp_volume = 15;  //range:1-15
static unsigned char ql_bt_hfp_phone_nubmer[] = "13249166530";
static unsigned char ql_bt_hfp_ctrl_cmd = 2;
static ql_bt_hfp_call_state_e ql_bt_hfp_call = QL_BT_HFP_CALL_NO_CALL_IN_PROGRESS;    
static ql_bt_hfp_connection_state_e ql_bt_hfp_connect_state = QL_BT_HFP_CONNECTION_STATE_DISCONNECTED;

extern ql_errcode_bt_e ql_bt_demo_start();
extern ql_errcode_bt_e ql_bt_demo_stop();
extern ql_errcode_bt_e ql_bt_demo_get_state();
extern ql_errcode_bt_e ql_bt_demo_get_local_name();
extern ql_errcode_bt_e ql_bt_demo_set_local_name();
extern ql_errcode_bt_e ql_bt_demo_get_scanmde();
extern ql_errcode_bt_e ql_be_demo_set_scanmode();

ql_errcode_bt_e ql_bt_hfp_demo_connect()
{
    ql_errcode_bt_e ret;
    
    ret = ql_bt_hfp_connect(ql_bt_hfp_remote_addr);
    if (ret == QL_BT_SUCCESS)
    {
        QL_BT_HFP_LOG("sucess");
    }
    else
    {
        QL_BT_HFP_LOG("error=%x", ret);
    }

    return ret;
}

ql_errcode_bt_e ql_bt_hfp_demo_disconnect()
{
    ql_errcode_bt_e ret;
    
    ret = ql_bt_hfp_disconnect(ql_bt_hfp_remote_addr);
    if (ret == QL_BT_SUCCESS)
    {
        QL_BT_HFP_LOG("sucess");
    }
    else
    {
        QL_BT_HFP_LOG("error=%x", ret);
    }

    return ret;
}

ql_errcode_bt_e ql_bt_hfp_demo_set_volume()
{
    ql_errcode_bt_e ret;
    
    ret = ql_bt_hfp_set_volume(ql_bt_hfp_remote_addr, ql_bt_hfp_volume);
    if (ret == QL_BT_SUCCESS)
    {
        QL_BT_HFP_LOG("sucess");
    }
    else
    {
        QL_BT_HFP_LOG("error=%x", ret);
    }

    return ret;
}

ql_errcode_bt_e ql_bt_hfp_demo_reject_call()
{
    ql_errcode_bt_e ret;
    
    ret = ql_bt_hfp_reject_call(ql_bt_hfp_remote_addr);
    if (ret == QL_BT_SUCCESS)
    {
        QL_BT_HFP_LOG("sucess");
    }
    else
    {
        QL_BT_HFP_LOG("error=%x", ret);
    }

    return ret;
}


ql_errcode_bt_e ql_bt_hfp_demo_answer_accept_call()
{
    ql_errcode_bt_e ret;
    
    ret = ql_bt_hfp_answer_accept_call(ql_bt_hfp_remote_addr);
    if (ret == QL_BT_SUCCESS)
    {
        QL_BT_HFP_LOG("sucess");
    }
    else
    {
        QL_BT_HFP_LOG("error=%x", ret);
    }

    return ret;
}

ql_errcode_bt_e ql_bt_hfp_demo_answer_reject_call()
{
    ql_errcode_bt_e ret;
    
    ret = ql_bt_hfp_answer_reject_call(ql_bt_hfp_remote_addr);
    if (ret == QL_BT_SUCCESS)
    {
        QL_BT_HFP_LOG("sucess");
    }
    else
    {
        QL_BT_HFP_LOG("error=%x", ret);
    }

    return ret;
}

ql_errcode_bt_e ql_bt_hfp_demo_dial()
{
    ql_errcode_bt_e ret;
    
    ret = ql_bt_hfp_dial(ql_bt_hfp_remote_addr, ql_bt_hfp_phone_nubmer);
    if (ret == QL_BT_SUCCESS)
    {
        QL_BT_HFP_LOG("sucess");
    }
    else
    {
        QL_BT_HFP_LOG("error=%x", ret);
    }

    return ret;
}

ql_errcode_bt_e ql_bt_hfp_demo_redial()
{
    ql_errcode_bt_e ret;
    
    ret = ql_bt_hfp_redial(ql_bt_hfp_remote_addr);
    if (ret == QL_BT_SUCCESS)
    {
        QL_BT_HFP_LOG("sucess");
    }
    else
    {
        QL_BT_HFP_LOG("error=%x", ret);
    }

    return ret;
}

ql_errcode_bt_e ql_bt_hfp_demo_vr_enable()
{
    ql_errcode_bt_e ret;
    
    ret = ql_bt_hfp_vr_enable(ql_bt_hfp_remote_addr);
    if (ret == QL_BT_SUCCESS)
    {
        QL_BT_HFP_LOG("sucess");
    }
    else
    {
        QL_BT_HFP_LOG("error=%x", ret);
    }

    return ret;
}

ql_errcode_bt_e ql_bt_hfp_demo_vr_disable()
{
    ql_errcode_bt_e ret;
    
    ret = ql_bt_hfp_vr_disable(ql_bt_hfp_remote_addr);
    if (ret == QL_BT_SUCCESS)
    {
        QL_BT_HFP_LOG("sucess");
    }
    else
    {
        QL_BT_HFP_LOG("error=%x", ret);
    }

    return ret;
}

ql_errcode_bt_e ql_bt_hfp_demo_three_way_call()
{
    ql_errcode_bt_e ret;
    
    ret = ql_bt_hfp_ctrl_three_way_call(ql_bt_hfp_remote_addr, ql_bt_hfp_ctrl_cmd);
    if (ret == QL_BT_SUCCESS)
    {
        QL_BT_HFP_LOG("sucess");
    }
    else
    {
        QL_BT_HFP_LOG("error=%x", ret);
    }

    return ret;
}




static void ql_bt_hfp_notify_cb(void *ind_msg_buf, void *ctx)
{
    ql_event_t *event_temp = NULL;
    ql_event_t test_event = {0};
    
    if (ind_msg_buf == NULL)
    {
        return ;
        
    }

    event_temp = (ql_event_t *)ind_msg_buf;
    
    switch (event_temp->id)
    {
        case QUEC_BT_HFP_CONNECT_IND:
        case QUEC_BT_HFP_DISCONNECT_IND:
        case QUEC_BT_HFP_CALL_IND:
        case QUEC_BT_HFP_CALL_SETUP_IND:
        case QUEC_BT_HFP_NETWORK_IND:
        case QUEC_BT_HFP_NETWORK_SIGNAL_IND:
        case QUEC_BT_HFP_BATTERY_IND:
        case QUEC_BT_HFP_CALLHELD_IND:
        case QUEC_BT_HFP_AUDIO_IND:
        case QUEC_BT_HFP_VOLUME_IND:
        case QUEC_BT_HFP_NETWORK_TYPE_IND:
        case QUEC_BT_HFP_CODEC_IND:
        case QUEC_BT_HFP_RING_IND:
        {
            ql_bt_hfp_event_info_t *temp = (ql_bt_hfp_event_info_t *)event_temp->param2;
            
            ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)malloc(sizeof(ql_bt_hfp_event_info_t));
            
            if (hfp_info)
            {
                memset(hfp_info, 0x00, sizeof(ql_bt_hfp_event_info_t));
                hfp_info->state = temp->state;
                memcpy(hfp_info->addr.addr, temp->addr.addr, QL_BT_MAC_ADDRESS_SIZE);

                
                test_event.id = event_temp->id;
                test_event.param2 = (uint32)hfp_info;
 
            }

        }  
        break; 

        default:
        {
                test_event.id = event_temp->id;
                test_event.param1 = event_temp->param1;
                test_event.param2 = event_temp->param2;
                test_event.param3 = event_temp->param3;
        }
        break;
    }

    if (test_event.id != 0)
    {
        ql_rtos_event_send(bt_hfp_demo_task,&test_event);
    }

}

/************************************************************************
*以下事件已经通过内核释放内存，不需要继续关注
* QUEC_BT_HFP_CONNECT_IND
* QUEC_BT_HFP_DISCONNECT_IND
* QUEC_BT_HFP_CALL_IND
* QUEC_BT_HFP_CALL_SETUP_IND
* QUEC_BT_HFP_NETWORK_IND
* QUEC_BT_HFP_NETWORK_SIGNAL_IND
* QUEC_BT_HFP_BATTERY_IND
* QUEC_BT_HFP_CALLHELD_IND
* QUEC_BT_HFP_AUDIO_IND
* QUEC_BT_HFP_VOLUME_IND
* QUEC_BT_HFP_NETWORK_TYPE_IND
* QUEC_BT_HFP_RING_IND
* QUEC_BT_HFP_CODEC_IND
************************************************************************/
static ql_errcode_bt_e ql_bt_hfp_event()
{
    ql_event_t test_event = {0};
    ql_errcode_bt_e ret = QL_BT_SUCCESS;
    QL_BT_STATUS status = (QL_BT_STATUS)(test_event.param1);
    if (ql_event_try_wait(&test_event) == 0)
	{
        if(test_event.id == 0)
        {
            return ret;
        }
        
        status = (QL_BT_STATUS)(test_event.param1);
        switch (test_event.id)
        {
            case QUEC_BT_START_STATUS_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("start sucess");
                    ret = ql_bt_demo_get_state();
                    if (ret != QL_BT_SUCCESS)
                    {
                        goto QL_BT_HFP_STOP;
                    }

                    ret = ql_bt_demo_get_local_name();
                    if (ret != QL_BT_SUCCESS)
                    {
                        goto QL_BT_HFP_STOP;
                    } 
                    ret = ql_bt_demo_set_local_name();
                    if (ret != QL_BT_SUCCESS)
                    {
                        goto QL_BT_HFP_STOP;
                    }
                    ret = ql_bt_demo_get_local_name();
                    if (ret != QL_BT_SUCCESS)
                    {
                        goto QL_BT_HFP_STOP;
                    }
                    
                    ret = ql_bt_demo_get_scanmde();
                    if (ret != QL_BT_SUCCESS)
                    {
                        goto QL_BT_HFP_STOP;
                    }
                    ret = ql_be_demo_set_scanmode();
                    if (ret != QL_BT_SUCCESS)
                    {
                        goto QL_BT_HFP_STOP;
                    }
                    ret = ql_bt_demo_get_scanmde();
                    if (ret != QL_BT_SUCCESS)
                    {
                        goto QL_BT_HFP_STOP;
                    }

                    //
                    
                }
                else
                {
                    QL_BT_HFP_LOG("start failed");
                    
                }
            }
            break;
            case QUEC_BT_STOP_STATUS_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("stop sucess");
                }
                else
                {
                    QL_BT_HFP_LOG("stop failed");
                }
            }
            break;
            case QUEC_BT_HFP_CONNECT_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("conn sucess");
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        QL_BT_HFP_LOG("addr=%02x%02x%02x%02x%02x%02x", hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]); 

                        memcpy(ql_bt_hfp_remote_addr.addr, hfp_info->addr.addr, QL_BT_MAC_ADDRESS_SIZE);
                        ql_bt_hfp_connect_state = QL_BT_HFP_CONNECTION_STATE_CONNECTED;
                        free(hfp_info);
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("conn failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_DISCONNECT_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("disconn sucess");
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        QL_BT_HFP_LOG("addr=%02x%02x%02x%02x%02x%02x", hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]); 
                        free(hfp_info);
#if 1
                        if (ql_bt_hfp_connect_state == QL_BT_HFP_CONNECTION_STATE_DISCONNECTING)
                        {
                            ql_rtos_task_sleep_s(3);
                            ret = ql_bt_hfp_demo_connect();
                            if (ret != QL_BT_SUCCESS)
                            {
                                ql_bt_hfp_connect_state = QL_BT_HFP_CONNECTION_STATE_DISCONNECTED;
                                goto QL_BT_HFP_STOP;
                            }
                            else 
                            {
                                ql_bt_hfp_connect_state = QL_BT_HFP_CONNECTION_STATE_CONNECTING;
                                
                            }
                        }
#else
                        ql_bt_hfp_connect_state = QL_BT_HFP_CONNECTION_STATE_DISCONNECTED;
#endif
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("disconn failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_CALL_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("call sucess"); 
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        ql_bt_hfp_call_state_e call_state = (ql_bt_hfp_call_state_e)hfp_info->state;
                        QL_BT_HFP_LOG("call_state=%d,addr=%02x%02x%02x%02x%02x%02x", call_state, hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]); 

                        if (call_state == QL_BT_HFP_CALL_NO_CALL_IN_PROGRESS)
                        {
                            if (ql_bt_hfp_call == QL_BT_HFP_CALL_CALL_IN_PROGRESS)
                            {
                                ql_bt_hfp_call = call_state;
                                if (ql_bt_hfp_connect_state == QL_BT_HFP_CONNECTION_STATE_CONNECTED)
                                {
                                    ret = ql_bt_hfp_demo_disconnect();
                                    if (ret != QL_BT_SUCCESS)
                                    {
                                        goto QL_BT_HFP_STOP;
                                    }  
                                    else 
                                    {
                                        ql_bt_hfp_connect_state = QL_BT_HFP_CONNECTION_STATE_DISCONNECTING;
                                    }
                                }
                            }
                        }
                        else 
                        {
                            if (ql_bt_hfp_call == QL_BT_HFP_CALL_NO_CALL_IN_PROGRESS)
                            {
                                ql_bt_hfp_call = call_state;

                                ret = ql_bt_hfp_demo_set_volume();
                                if (ret != QL_BT_SUCCESS)
                                {
                                    goto QL_BT_HFP_STOP;
                                }
#if 0
                                ql_rtos_task_sleep_ms(100);
                                ret = ql_bt_hfp_demo_vr_disable();
                                if (ret != QL_BT_SUCCESS)
                                {
                                    goto QL_BT_HFP_STOP;
                                }

                                ql_rtos_task_sleep_ms(100);
                                ret = ql_bt_hfp_demo_vr_enable();
                                if (ret != QL_BT_SUCCESS)
                                {
                                    goto QL_BT_HFP_STOP;
                                }
#endif
                                //ql_rtos_task_sleep_ms(100);
                                //ret = ql_bt_hfp_demo_three_way_call();
                                //if (ret != QL_BT_SUCCESS)
                                //{
                                //    goto QL_BT_HFP_STOP;
                                //}

                                ql_rtos_task_sleep_s(30);
                                ret = ql_bt_hfp_demo_reject_call();
                                if (ret != QL_BT_SUCCESS)
                                {
                                    goto QL_BT_HFP_STOP;
                                }
                            }
                        } 
                        free(hfp_info);
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("call failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_CALL_SETUP_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("call set sucess"); 
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        ql_bt_hfp_callsetup_state_e calls_state = (ql_bt_hfp_callsetup_state_e)hfp_info->state;
                        QL_BT_HFP_LOG("calls_state=%d,addr=%02x%02x%02x%02x%02x%02x", calls_state, hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]); 
                        free(hfp_info);
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("call set failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_NETWORK_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("network sucess"); 
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        ql_bt_hfp_network_state_e network = (ql_bt_hfp_network_state_e)hfp_info->state;
                        QL_BT_HFP_LOG("network=%d,addr=%02x%02x%02x%02x%02x%02x", network, hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]); 
                        free(hfp_info);
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("network failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_NETWORK_SIGNAL_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("net signal sucess"); 
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        unsigned char signal = (unsigned char)hfp_info->state;
                        QL_BT_HFP_LOG("signal=%d,addr=%02x%02x%02x%02x%02x%02x", signal, hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]);
                        free(hfp_info);
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("net signal failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_BATTERY_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("battery sucess"); 
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        int level = (int)hfp_info->state;
                        QL_BT_HFP_LOG("level=%d,addr=%02x%02x%02x%02x%02x%02x", level, hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]); 
                        free(hfp_info);
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("battery failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_CALLHELD_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("callheld sucess"); 
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        ql_bt_hfp_callheld_state_e state = (ql_bt_hfp_callheld_state_e)hfp_info->state;
                        QL_BT_HFP_LOG("state=%d,addr=%02x%02x%02x%02x%02x%02x", state, hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]);
                        free(hfp_info);
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("callheld failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_AUDIO_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("audio sucess"); 
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        ql_bt_hfp_audio_state_e state = (ql_bt_hfp_audio_state_e)hfp_info->state;
                        QL_BT_HFP_LOG("state=%d,addr=%02x%02x%02x%02x%02x%02x", state, hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]);
                        free(hfp_info);
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("audio failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_VOLUME_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("volume sucess"); 
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        ql_bt_hfp_volume_type_e type = (ql_bt_hfp_volume_type_e)hfp_info->state;
                        unsigned char volume = test_event.param3;
                        QL_BT_HFP_LOG("type=%d,volume", type, volume); 
                        free(hfp_info);
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("volume failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_NETWORK_TYPE_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("net type sucess"); 
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        ql_bt_hfp_service_type_e type = (ql_bt_hfp_service_type_e)hfp_info->state;
                        QL_BT_HFP_LOG("type=%d,addr=%02x%02x%02x%02x%02x%02x", type, hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]);
                        free(hfp_info);
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("net type failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_CODEC_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("codec sucess"); 
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        ql_bt_hfp_codec_type_e type = (ql_bt_hfp_codec_type_e)hfp_info->state;
                        QL_BT_HFP_LOG("type=%d,addr=%02x%02x%02x%02x%02x%02x", type, hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]);
                        free(hfp_info);
                    }
                }
                else
                {
                    QL_BT_HFP_LOG("codec failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            case QUEC_BT_HFP_RING_IND:
            {
                if (QL_BT_STATUS_SUCCESS == status)
                {
                    QL_BT_HFP_LOG("ring sucess"); 
                    ql_bt_hfp_event_info_t *hfp_info = (ql_bt_hfp_event_info_t *)test_event.param2;
                    if (hfp_info)
                    {   
                        //hfp_info point to a malloc addrss,need to free
                        
                        QL_BT_HFP_LOG("addr=%02x%02x%02x%02x%02x%02x", hfp_info->addr.addr[0], hfp_info->addr.addr[1], \
                            hfp_info->addr.addr[2], hfp_info->addr.addr[3], hfp_info->addr.addr[4], hfp_info->addr.addr[5]); 
                        free(hfp_info);
                    }
                     
                    ret = ql_bt_hfp_demo_answer_accept_call();
                    //ret = ql_bt_hfp_demo_reject_call();
                    if (ret != QL_BT_SUCCESS)
                    {
                        goto QL_BT_HFP_STOP;
                    }
                    
                }
                else
                {
                    QL_BT_HFP_LOG("ring failed");
                    goto QL_BT_HFP_STOP;
                }
            }  
            break;
            default:
            break;
        }
        return ret;
QL_BT_HFP_STOP:
        ret = ql_bt_demo_stop();
	}

    return ret;
}


void ql_bt_hfp_task_pthread(void *ctx)
{
	QlOSStatus err = 0;
    ql_errcode_bt_e ret = QL_BT_SUCCESS;

    ret = ql_bt_hfp_init(ql_bt_hfp_notify_cb);
    if (ret != QL_BT_SUCCESS)
    {
        goto QL_BT_HFP_NOT_INIT_EXIT;
    }

    ret = ql_bt_demo_start();
    if (ret != QL_BT_SUCCESS)
    {
        goto QL_BT_HFP_INIT_EXIT;
    }
    
	while(1)
	{
        ret = ql_bt_hfp_event(); 
        if (ret != QL_BT_SUCCESS)
        {
            break;
        }
	}
    
QL_BT_HFP_INIT_EXIT:
    ql_bt_hfp_release();
QL_BT_HFP_NOT_INIT_EXIT:	
	err = ql_rtos_task_delete(NULL);
	if(err != QL_OSI_SUCCESS)
	{
		QL_BT_HFP_LOG("task deleted failed");
	}
}

QlOSStatus ql_bt_hfp_demo_init(void)
{	
	QlOSStatus err = QL_OSI_SUCCESS;

    QL_BT_HFP_LOG("enter ql_bt_hfp_demo_init");
	err = ql_rtos_task_create(&bt_hfp_demo_task, BT_BLE_DEMO_TASK_STACK_SIZE, BT_BLE_DEMO_TASK_PRIO, "ql_bt_hfp", ql_bt_hfp_task_pthread, NULL, BT_BLE_DEMO_TASK_EVENT_CNT);
	
    return err;
}