CC2340R5: TX Power Index

case ADVERTISING_POWER_CHAR_UUID:
        if ( offset == 0 )
        {
        if ( len != 1 )
        {
        status = ATT_ERR_INVALID_VALUE_SIZE;
        }
        }
        else
        {
        status = ATT_ERR_ATTR_NOT_LONG;
        }
        if ( status == SUCCESS )
        {
            uint8 *pCurValue = (uint8 *)pAttr->pValue;

            if(pValue[0]<= ADVERTISING_POWER_8dB)
            {
              *pCurValue = pValue[0];
                switch (*pCurValue)
                {
                    case ADVERTISING_POWER_0dB:
                       Advertising_Power=0;
                       HCI_EXT_SetTxPowerDbmCmd(0,0);
                       break;

                    case ADVERTISING_POWER_1dB:
                       Advertising_Power=1;
                       HCI_EXT_SetTxPowerDbmCmd(1,0);
                       break;

                    case ADVERTISING_POWER_2dB:
                       Advertising_Power=2;
                       HCI_EXT_SetTxPowerDbmCmd(2,0);
                       break;

                    case ADVERTISING_POWER_3dB:
                       Advertising_Power=3;
                       HCI_EXT_SetTxPowerDbmCmd(3,0);
                       break;

                    case ADVERTISING_POWER_4dB:
                       Advertising_Power=4;
                       HCI_EXT_SetTxPowerDbmCmd(4,0);
                       break;

                    case ADVERTISING_POWER_5dB:
                       Advertising_Power=5;
                       HCI_EXT_SetTxPowerDbmCmd(5,0);
                       break;

                    case ADVERTISING_POWER_6dB:
                       Advertising_Power=6;
                       HCI_EXT_SetTxPowerDbmCmd(6,0);
                       break;

                    case ADVERTISING_POWER_7dB:
                       Advertising_Power=7;
                       HCI_EXT_SetTxPowerDbmCmd(7,0);
                       break;

                    case ADVERTISING_POWER_8dB:
                       Advertising_Power=8;
                       HCI_EXT_SetTxPowerDbmCmd(8,0);
                       break;

                    default:
                       Advertising_Power=0;
                       HCI_EXT_SetTxPowerDbmCmd(0,0);
                       break;
                }
                if(Last_Advertising_Power!=Advertising_Power)
                {
                   Last_Advertising_Power=Advertising_Power;
                   sysParas.advertisementPower=Advertising_Power;
                   BLEAppUtil_invokeFunction(do_para_save,NULL);
                }
            }
        }

void SetTxPower( int8_t val )
{
//    BLEAppUtil_invokeFunction(do_stop_adv, NULL);
    BLEAppUtil_advStop(peripheralAdvHandle_1);//停止广播
    switch( val )
    {
        case -21:   HCI_EXT_SetTxPowerDbmCmd( -21 , 0 );     break;
        case -18:   HCI_EXT_SetTxPowerDbmCmd( -18 , 0 );     break;
        case -15:   HCI_EXT_SetTxPowerDbmCmd( -15 , 0 );     break;
        case -12:   HCI_EXT_SetTxPowerDbmCmd( -12 , 0 );     break;
        case -9:    HCI_EXT_SetTxPowerDbmCmd( -9 , 0 );      break;
        case -6:    HCI_EXT_SetTxPowerDbmCmd( -6 , 0 );      break;
        case -3:    HCI_EXT_SetTxPowerDbmCmd( -3 , 0 );      break;
        case 0:     HCI_EXT_SetTxPowerDbmCmd(  0 , 0 );            break;
        case 1:     HCI_EXT_SetTxPowerDbmCmd(  1 , 0 );            break;
        case 2:     HCI_EXT_SetTxPowerDbmCmd(  2 , 0 );            break;
        case 3:     HCI_EXT_SetTxPowerDbmCmd(  3 , 0 );            break;
        case 4:     HCI_EXT_SetTxPowerDbmCmd(  4 , 0 );            break;
        case 5:     HCI_EXT_SetTxPowerDbmCmd(  5 , 0 );            break;
        default:    HCI_EXT_SetTxPowerDbmCmd( 0 , 0 );  val = 0;   break;
    }

    sysParas.txPower = val;

//    BLEAppUtil_invokeFunction(adv_new_name, NULL);
    BLEAppUtil_advStart(peripheralAdvHandle_1, &advSetStartParamsSet_1);    //开启广播
}

void SetTxPower(  )
{
    BLEAppUtil_advStop(peripheralAdvHandle_1);//停止广播
    HCI_EXT_SetTxPowerDbmCmd( -21 , 0 );    
    BLEAppUtil_advStart(peripheralAdvHandle_1, &advSetStartParamsSet_1);    //开启广播
}

BLEAppUtil_advStop(peripheralAdvHandle_1);//停止广播

/**
 * Aborts.
 *
 * This is preferred over C runtime abort() function,
 * in an external image since the C runtime abort() is only
 * guaranteed in a root image which contains the C runtime
 * entry function that is executed upon startup.
 */
ICall_Errno
ICall_abort(void)
{
#ifdef HALNODEBUG
#elif  defined(EXT_HAL_ASSERT)
  HAL_ASSERT(HAL_ASSERT_CAUSE_ICALL_ABORT);
#else
  {
    volatile uint8_t j=1;
    while(j);                   //一直在这里循环  
  }
#endif /* EXT_HAL_ASSERT */
  ICALL_HOOK_ABORT_FUNC();
  return(ICALL_ERRNO_SUCCESS);
}

 BLEAppUtil_advStop(peripheralAdvHandle_1);//停止广播

BLEAppUtil_advStart(peripheralAdvHandle_1, &advSetStartParamsSet_1); //开启广播

void *threadFxn0(void *arg0)
{
    // ******************************************************************
    // N0 STACK API CALLS CAN OCCUR BEFORE THIS CALL TO ICall_registerApp
    // ******************************************************************
    // Register the current thread as an ICall dispatcher application
    // so that the application can send and receive messages.
    ICall_registerApp(&selfEntity1, &syncEvent1);

    // Register the current thread as an ICall dispatcher application
    // so that the application can send and receive messages.
//    bleStack_createTasks();


    for(;;)
    {
        GPIO_write(CONFIG_GPIO_Red,0);
        vTaskDelay(500);
        GPIO_write(CONFIG_GPIO_Red,1);
        vTaskDelay(500);
    }
}

void *threadFxn1(void *arg0)
{
    // ******************************************************************
    // N0 STACK API CALLS CAN OCCUR BEFORE THIS CALL TO ICall_registerApp
    // ******************************************************************
    // Register the current thread as an ICall dispatcher application
    // so that the application can send and receive messages.
    ICall_registerApp(&selfEntity1, &syncEvent1);

    // Register the current thread as an ICall dispatcher application
    // so that the application can send and receive messages.
//    bleStack_createTasks();


    for(;;)
    {
        GPIO_write(CONFIG_GPIO_Green,0);
        vTaskDelay(500);
        GPIO_write(CONFIG_GPIO_Green,1);
        vTaskDelay(500);
    }
}

void *mainThread(void *arg0)
{
    pthread_t thread0,thread1;
    pthread_attr_t attrs;
    struct sched_param priParam;
    int retc;
    int detachState;

    /* Create application threads */
    pthread_attr_init(&attrs);

    detachState = PTHREAD_CREATE_DETACHED;
    /* Set priority and stack size attributes *///设置优先级和堆栈大小属性
    retc        = pthread_attr_setdetachstate(&attrs, detachState);//设置线程分离状态
    if (retc != 0)
    {
        /* pthread_attr_setdetachstate() failed */
        while (1) {}
    }

    retc |= pthread_attr_setstacksize(&attrs, THREADSTACKSIZE);
    if (retc != 0)
    {
        /* pthread_attr_setstacksize() failed */
        while (1) {}
    }

    /* Create threadFxn0 thread */
    priParam.sched_priority = 0;
    pthread_attr_setschedparam(&attrs, &priParam);

    retc = pthread_create(&thread0, &attrs, &threadFxn0, NULL);
    if (retc != 0)
    {
        /* pthread_create() failed */
        while (1) {}
    }
    priParam.sched_priority = 1;
    pthread_attr_setschedparam(&attrs, &priParam);
    retc = pthread_create(&thread1, &attrs, &threadFxn1, NULL);
    if (retc != 0)
    {
        /* pthread_create() failed */
        while (1) {}
    }
    // Register the current thread as an ICall dispatcher application
    // so that the application can send and receive messages.
    bleStack_createTasks();
    
    return (NULL);
}