hal_charge.c 5.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192
  1. #include "usr_config.h"
  2. #include "bsp_time.h"
  3. #include "system.h"
  4. #include "hal_led.h"
  5. #include "nrf_gpio.h"
  6. #include "hal_ble_client.h"
  7. #include "hal_ble_host.h"
  8. #include "app_flash.h"
  9. #include "hal_battery.h"
  10. #include "ble_comm.h"
  11. #include "app_pair_chargerpin.h"
  12. #include "hal_charge.h"
  13. /************************ 函数声明 ***********************************/
  14. /************************ 变量 ***********************************/
  15. static uint8_t hal_charge_state = BLE_CHARGE_PULLOUT;
  16. static uint8_t pair_state =0;
  17. static void pair_start_cb(){
  18. hal_charge_state = BLE_CHARGE_PULLOUT;
  19. pair_state =1;
  20. }
  21. static void pair_done_cb(){
  22. pair_state =0;
  23. }
  24. PAIR_START_REGISTER(pair_start_cb);
  25. PAIR_DONE_REGISTER(pair_done_cb);
  26. /********************************************************/
  27. uint8_t hal_charge_Getstate(void)
  28. {
  29. return hal_charge_state;
  30. }
  31. static void hal_send_charge(void)
  32. {
  33. uint8_t sbuf[2]={0};
  34. uint8_t L = 0;
  35. if(mFlash.isHost) sbuf[L++] = 0;
  36. else sbuf[L++] = 1;
  37. sbuf[L++] = hal_charge_state;
  38. BLE_Client_Tx_Send(0,BLE_CHARGE,sbuf,L);
  39. }
  40. void cb_BLE_Client_R_CHARGE(void* handle)
  41. {
  42. BLE_Client_Rx_t* target = handle;
  43. DEBUG_LOG("!!!!!!!!cb_BLE_Client_R_CHARGE\n");
  44. hal_send_charge();
  45. BLE_Host_Tx_Send(0,BLE_CHARGE,target->pDat,target->datLen);
  46. }
  47. void cb_BLE_Host_R_CHARGE(void* handle)
  48. {
  49. BLE_Host_Rx_t* target = handle;
  50. BLE_Client_Tx_Send(0,BLE_CHARGE,target->pDat,target->datLen);
  51. // DEBUG_LOG("cb_BLE_Host_R_CHARGE:%d,%d,%d\n",target->pDat[0],target->pDat[1],target->datLen);
  52. }
  53. static void hal_charge_Vol_Charge_Send(void)
  54. {
  55. uint8_t buf[10]={0};
  56. uint8_t L = 0;
  57. buf[L++] = GetBatteryPersent();
  58. buf[L++] = hal_charge_state;
  59. if(mFlash.isHost)BLE_Host_Tx_Send(0,BLE_CHAR_VOL,buf,L);
  60. else BLE_Client_Tx_Send(0,BLE_CHAR_VOL,buf,L);
  61. }
  62. static uint8_t OtherShoesVol = 0;
  63. static uint8_t otherShoes_charge = BLE_CHARGE_PULLOUT;
  64. static void cb_BLE_R_CHAR_VOL(void* handle)
  65. {
  66. BLE_Client_Rx_t* target = handle;
  67. OtherShoesVol = target->pDat[0];
  68. otherShoes_charge = target->pDat[1];
  69. if(!mFlash.isHost)hal_charge_Vol_Charge_Send();
  70. DEBUG_LOG("OtherShoesVol=%d\n",OtherShoesVol);
  71. }
  72. static void cb_BLE_Host_R_CHAR_VOL(void* handle)
  73. {
  74. BLE_Host_Rx_t* target = handle;
  75. OtherShoesVol = target->pDat[0];
  76. otherShoes_charge = target->pDat[1];
  77. // DEBUG_LOG("OtherShoesVol=%d\n",OtherShoesVol);
  78. }
  79. static void hal_charge_Process(void)
  80. {
  81. static uint8_t client_connect =0;
  82. if(slave_isconnect() && !client_connect){
  83. hal_send_charge();
  84. uint8_t data =0;
  85. BLE_Host_Tx_Send(0,BLE_CHARGE,&data,1);
  86. }
  87. else if(!slave_isconnect() && client_connect && (!mFlash.isHost)){
  88. OtherShoesVol = 0;
  89. otherShoes_charge =0;
  90. }
  91. if(client_connect != slave_isconnect())client_connect = slave_isconnect();
  92. int16_t ADC_value =0;
  93. ADC_Read(PIN_CHARGING_CHANNEL,&ADC_value);
  94. if(1 == pair_state || ADC_value < CHARGE_ADC){ //没充电
  95. if(hal_charge_state!=BLE_CHARGE_PULLOUT){ DEBUG_LOG("charge out...\n");
  96. hal_charge_state = BLE_CHARGE_PULLOUT;
  97. Process_SetHoldOn(hal_charge_Process,0);
  98. hal_send_charge();
  99. OtherShoesVol = 0;
  100. otherShoes_charge =0;
  101. if(mFlash.isHost)hal_charge_Vol_Charge_Send(); //共享充电电量和充电状态
  102. }
  103. return;
  104. }
  105. if(mFlash.isHost)hal_charge_Vol_Charge_Send(); //共享充电电量和充电状态
  106. if((otherShoes_charge == BLE_CHARGE_INSERT || otherShoes_charge == BLE_CHARGE_DONE) &&
  107. GetBatteryPersent() >=100 &&
  108. OtherShoesVol >=100 ){ //左右鞋都充满电的情况下
  109. if(hal_charge_state!=BLE_CHARGE_DONE){ DEBUG_LOG("charge done:%d...\n",OtherShoesVol);
  110. hal_charge_state = BLE_CHARGE_DONE;
  111. Process_SetHoldOn(hal_charge_Process,1);
  112. hal_send_charge();
  113. }
  114. }else{ //正在充电
  115. if(hal_charge_state!=BLE_CHARGE_INSERT){ DEBUG_LOG("charge in...\n");
  116. hal_charge_state = BLE_CHARGE_INSERT;
  117. Process_SetHoldOn(hal_charge_Process,1);
  118. hal_send_charge();
  119. }
  120. }
  121. }
  122. static void hal_charge_monitor_process(void)
  123. {
  124. #define BATTERY_VOL_THRESHOLD_MIN 2500 //2.5V
  125. #define BATTERY_VOL_THRESHOLD_MAX 4000 //4V
  126. #define CHARGE_VOL_THRESHOLD 80 //充电前和充电期间的充电电压变化值,单位mv
  127. //监测电池和充电数据
  128. int16_t charge_vol = 0;
  129. // int16_t charge_threshold = 0;
  130. static uint32_t charge_cycle = 50;
  131. static int16_t before_charge_vol = 0; //充电前的电压值
  132. static int16_t charge_vol_max = 0; //充电期间最大的电压值
  133. if(BLE_CHARGE_PULLOUT == hal_charge_state)//没充电
  134. {
  135. charge_vol = ADC_RESULT_IN_MILLI_VOLTS(ADC_GetValue(PIN_ADC_CHARGMEASURE_CHANNEL));
  136. before_charge_vol = before_charge_vol > charge_vol ? charge_vol : before_charge_vol;
  137. charge_vol_max = 0;
  138. charge_cycle = 50;
  139. }else //充电
  140. {
  141. /* 过筛50轮 */
  142. if(charge_cycle != 0){
  143. charge_vol = ADC_RESULT_IN_MILLI_VOLTS(ADC_GetValue(PIN_ADC_CHARGMEASURE_CHANNEL));
  144. charge_vol_max = charge_vol_max < charge_vol ? charge_vol : charge_vol_max;
  145. charge_cycle--;
  146. return;
  147. }
  148. charge_vol = ADC_RESULT_IN_MILLI_VOLTS(ADC_GetValue(PIN_ADC_CHARGMEASURE_CHANNEL));
  149. charge_vol_max = charge_vol_max < charge_vol ? charge_vol : charge_vol_max;
  150. // bat_vol = ADC_RESULT_IN_MILLI_VOLTS(ADC_GetValue(PIN_ADC_BAT_CHANNEL))*5/3;
  151. //当电池电量没满,充电(经测试,电量没满的充电电压跟电池电压有关,最小充电电压100+mv)
  152. // charge_threshold = charge_vol_max - before_charge_vol; //充电前和充电期间的充电电压变化值
  153. }
  154. }
  155. void hal_charge_init(void)
  156. {
  157. BLE_Client_Rx_Regist(BLE_CHAR_VOL,cb_BLE_R_CHAR_VOL);
  158. BLE_Host_Rx_Regist(BLE_CHAR_VOL,cb_BLE_Host_R_CHAR_VOL);
  159. BLE_Client_Rx_Regist(BLE_CHARGE,cb_BLE_Client_R_CHARGE);
  160. BLE_Host_Rx_Regist(BLE_CHARGE,cb_BLE_Host_R_CHARGE);
  161. Process_Start(1000,"app_charge",hal_charge_Process);
  162. hal_charge_Process();
  163. Process_Start(10,"hal_charge_monitor_process",hal_charge_monitor_process);
  164. }