bluetooth control motor
Dependents: BLE_LED_IDB0XA1_demo MOTOR_BLE_V2 Motor_Ble_v1 Motor_Ble_v10223 ... more
Fork of X_NUCLEO_IDB0XA1 by
Diff: source/utils/Utils.cpp
- Revision:
- 226:be2f4e1d0515
- Parent:
- 132:51056160fa4a
--- a/source/utils/Utils.cpp Tue Apr 26 14:30:17 2016 +0200 +++ b/source/utils/Utils.cpp Tue Apr 26 14:32:13 2016 +0200 @@ -20,106 +20,74 @@ /*! @brief sets values of EN_HIGH_POWER and PA_LEVEL corresponding to dBMLevel of tx power - @returns value of tx power in dbm actually set - - @params[in] dBMLevel - dBMLevel of tx power to be set - - @params[in] dBMLevel - dBMLevel of tx power to be set - - @endcode */ /**************************************************************************/ -double getHighPowerAndPALevelValue(int8_t dBMLevel, int8_t& EN_HIGH_POWER, int8_t& PA_LEVEL) { - double dbm = (double) dBMLevel; - if(dbm<-18.0) { - dbm = -18; +tBleStatus getHighPowerAndPALevelValue(int8_t dBMLevel, int8_t& EN_HIGH_POWER, int8_t& PA_LEVEL) { + tBleStatus ret = BLE_STATUS_SUCCESS; + + if(dBMLevel==-18) { EN_HIGH_POWER = 0; PA_LEVEL = 0; } - else if(dbm>8.0) { - dbm = 8; - EN_HIGH_POWER = 1; - PA_LEVEL = 7; + else if(dBMLevel==-15) { + EN_HIGH_POWER = 0; + PA_LEVEL = 1; } - - // As a policy we are setting tx power level to the higher side - if((dbm>-18.0) && (dbm<=-15)) { - // set tx power to -15dBM - EN_HIGH_POWER = 0; + else if(dBMLevel==-14) { + EN_HIGH_POWER = 1; PA_LEVEL = 0; } - else if((dbm>-15) && (dbm<=-14.7)) { - // set tx power to -14.7dBM + else if(dBMLevel==-12) { EN_HIGH_POWER = 0; - PA_LEVEL = 1; + PA_LEVEL = 2; } - else if((dbm>-14.7) && (dbm<=-11.7)) { - // set tx power to -11.7dBM + else if(dBMLevel==-11) { EN_HIGH_POWER = 1; - PA_LEVEL = 1; - } - else if((dbm>-11.7) && (dbm<=-11.4)) { - // set tx power to -11.4dBM + PA_LEVEL = 1; + } + else if(dBMLevel==-9) { EN_HIGH_POWER = 0; - PA_LEVEL = 2; + PA_LEVEL = 3; } - else if((dbm>-11.4) && (dbm<=-8.4)) { - // set tx power to -8.4dBM + else if(dBMLevel==-8) { EN_HIGH_POWER = 1; - PA_LEVEL = 2; - } - else if((dbm>-8.4) && (dbm<=-8.1)) { - // set tx power to -8.1dBM - EN_HIGH_POWER = 0; - PA_LEVEL = 3; + PA_LEVEL = 2; } - else if((dbm>-8.1) && (dbm<=-5.1)) { - // set tx power to -5.1dBM + else if(dBMLevel==-6) { + EN_HIGH_POWER = 0; + PA_LEVEL = 4; + } + else if(dBMLevel==-5) { EN_HIGH_POWER = 1; - PA_LEVEL = 3; - } - else if((dbm>-5.1) && (dbm<=-4.9)) { - // set tx power to -4.9dBM - EN_HIGH_POWER = 0; - PA_LEVEL = 4; + PA_LEVEL = 3; } - else if((dbm>-4.9) && (dbm<=-2.1)) { - // set tx power to -2.1dBM + else if(dBMLevel==-2) { EN_HIGH_POWER = 1; - PA_LEVEL = 4; + PA_LEVEL = 4; } - else if((dbm>-2.1) && (dbm<=-1.6)) { - // set tx power to -1.6dBM - EN_HIGH_POWER = 0; - PA_LEVEL = 5; - } - else if((dbm>-1.6) && (dbm<=1.4)) { - // set tx power to -1.6dBM - EN_HIGH_POWER = 1; - PA_LEVEL = 5; - } - else if((dbm>1.4) && (dbm<=1.7)) { - // set tx power to 1.7dBM + else if(dBMLevel==0) { EN_HIGH_POWER = 0; - PA_LEVEL = 6; + PA_LEVEL = 6; } - else if((dbm>1.7) && (dbm<=4.7)) { - // set tx power to 4.7dBM + else if(dBMLevel==2) { EN_HIGH_POWER = 1; - PA_LEVEL = 6; - } - else if((dbm>4.7) && (dbm<=5.0)) { - // set tx power to 5.0dBM + PA_LEVEL = 5; + } + else if(dBMLevel==4) { + EN_HIGH_POWER = 1; + PA_LEVEL = 6; + } + else if(dBMLevel==5) { EN_HIGH_POWER = 0; - PA_LEVEL = 7; + PA_LEVEL = 7; } - else if((dbm>5.0) && (dbm<=8)) { - // set tx power to 8.0dBM + else if(dBMLevel==8) { EN_HIGH_POWER = 1; - PA_LEVEL = 7; - } - - return dbm; + PA_LEVEL = 7; + } + else { + ret = ERR_INVALID_HCI_CMD_PARAMS; + } + + return ret; }