pcba_test.c 5.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192
  1. #include <string.h>
  2. #include "bsp/gpio.h"
  3. #include "bsp/ml5238.h"
  4. #include "bsp/uart.h"
  5. #include "bsp/gd32_adc.h"
  6. #include "bsp/cs1180.h"
  7. #include "nv_storage.h"
  8. #include "pcba_test.h"
  9. static void pcba_test_timer_handler(shark_timer_t *timer);
  10. static shark_timer_t pcba_test_timer = {.handler = pcba_test_timer_handler};
  11. static int pcba_test_item = -1;
  12. static int powerdown_flags = 0;
  13. static void pcba_test_timer_handler(shark_timer_t *timer) {
  14. if (pcba_test_item == 1) {
  15. UART0_IR_EN(1);
  16. }
  17. pcba_test_item = -1;
  18. }
  19. int pcba_test(uint8_t *data, int len, uint8_t *response){
  20. uint8_t *payload = data + 2;
  21. int resp_len = 0;
  22. response[resp_len ++] = 0xFE;
  23. response[resp_len ++] = 0xFE;
  24. response[resp_len ++] = 0; //len
  25. //response[resp_len ++] = payload[0];
  26. response[resp_len ++] = payload[1];
  27. uint8_t cmd = payload[1];
  28. if (cmd == 0x00) {
  29. response[resp_len ++] = ml5238_noop_register_rw(payload[2]);
  30. }else if (cmd == 0x01) {
  31. response[resp_len ++] = (uint8_t)nv_read_write_test();
  32. }else if (cmd == 0x02){
  33. for (int i = 0; i < PACK_TEMPS_NUM; i++){
  34. response[resp_len ++] = (uint8_t)get_pack_temperature(i) + 40;
  35. }
  36. }else if (cmd == 0x03) {
  37. response[resp_len ++] = io_state()->aux_lock_detect?0:1;
  38. }else if (cmd == 0x04) {
  39. LED1_ON(0);
  40. LED3_ON(0);
  41. LED0_ON(1);
  42. LED2_ON(1);
  43. LED4_ON(1);
  44. response[resp_len ++] = 0;
  45. }else if (cmd == 0x05) {
  46. LED0_ON(0);
  47. LED2_ON(0);
  48. LED4_ON(0);
  49. LED1_ON(1);
  50. LED3_ON(1);
  51. response[resp_len ++] = 0;
  52. }else if (cmd == 0x06) {
  53. LED1_ON(0);
  54. LED3_ON(0);
  55. charger_open(0);
  56. discharger_open(0);
  57. start_aux_power(0);
  58. response[resp_len ++] = 0;
  59. }else if (cmd == 0x07) {
  60. start_aux_power(1);
  61. io_state()->aux_lock_irq = 0;
  62. response[resp_len ++] = 0;
  63. }else if (cmd == 0x08) {
  64. response[resp_len ++] = io_state()->aux_lock_irq;
  65. }else if (cmd == 0x09) {
  66. start_aux_power(0);
  67. response[resp_len ++] = 0;
  68. }else if (cmd == 0x0a) {
  69. ml5238_enable_load_detect(1);
  70. delay_us(1000);
  71. response[resp_len ++] = !ml5238_is_load_disconnect();
  72. }else if (cmd == 0xb) {
  73. charger_open(0);
  74. discharger_open(0);
  75. start_aux_power(0);
  76. delay_us(1000);
  77. response[resp_len ++] = io_state()->charger_detect_irq;
  78. }else if (cmd == 0xc) {
  79. charger_open(0);
  80. discharger_open(0);
  81. start_aux_power(0);
  82. response[resp_len ++] = IS_CHARGER_IN();
  83. }else if (cmd == 0xd) {
  84. response[resp_len ++] = io_state()->aux_lock_detect;
  85. }else if (cmd == 0xe) {
  86. charger_open(1);
  87. discharger_open(1);
  88. start_aux_power(0);
  89. response[resp_len ++] = 0;
  90. powerdown_flags = 0xF;
  91. system_power_down();
  92. }else if (cmd == 0xf){
  93. response[resp_len ++] = !IS_HALL1_DETECTED();
  94. response[resp_len ++] = !IS_HALL2_DETECTED();
  95. }else if (cmd == 0x10) {
  96. if (payload[2] >= 3) {
  97. charger_open(1);
  98. discharger_open(1);
  99. }else if (payload[2] == 1){
  100. charger_open(0);
  101. discharger_open(1);
  102. }else{
  103. charger_open(1);
  104. discharger_open(0);
  105. }
  106. response[resp_len ++] = 0;
  107. }else if (cmd == 0x11) {
  108. response[resp_len ++] = ml5238_is_discharging() | ml5238_is_charging()<<1;
  109. }else if (cmd == 0x22) {
  110. uint16_t health = *(uint16_t *)bms_health();
  111. response[resp_len ++] = AUX_VOL_IS_OPEN();
  112. response[resp_len ++] = health;
  113. response[resp_len ++] = health >> 8;
  114. }else if (cmd == 0xa1) {
  115. charger_open(0);
  116. discharger_open(0);
  117. start_aux_power(0);
  118. response[resp_len ++] = 0;
  119. }else if (cmd == 0x12) {
  120. uint16_t aux_power_adc = (uint16_t)adc_sample_avg(ADC_CHAN_AUX_CURR, 10);
  121. response[resp_len ++] = aux_power_adc;
  122. response[resp_len ++] = aux_power_adc >> 8;
  123. }else if (cmd == 0x13) {
  124. //shark_uart_deinit(SHARK_UART1);
  125. //rcu_periph_clock_enable(RCU_GPIOA);
  126. gpio_mode_output(GPIOA, GPIO_PUPD_NONE, GPIO_OTYPE_PP, GPIO_OSPEED_10MHZ, GPIO_PIN_2);
  127. gpio_mode_input(GPIOA, GPIO_PUPD_NONE, GPIO_PIN_3);
  128. gpio_bit_set(GPIOA, GPIO_PIN_2);
  129. response[resp_len ++] = gpio_input_bit_get(GPIOA, GPIO_PIN_3);
  130. }else if (cmd == 0x16) {
  131. gpio_bit_reset(GPIOA, GPIO_PIN_2);
  132. response[resp_len ++] = gpio_input_bit_get(GPIOA, GPIO_PIN_3);
  133. }else if (cmd == 0x14) {
  134. UART0_IR_EN(0);
  135. response[resp_len ++] = gpio_output_bit_get(GPIOC,GPIO_PIN_14);
  136. pcba_test_item = 1;
  137. shark_timer_post(&pcba_test_timer, 500);
  138. }else if (cmd == 0x15) {
  139. UART0_IR_EN(1);
  140. pcba_test_item = -1;
  141. shark_timer_cancel(&pcba_test_timer);
  142. response[resp_len ++] = gpio_output_bit_get(GPIOC,GPIO_PIN_14);
  143. }else if (cmd == 0x17) {
  144. uint8_t cell_index = 0;
  145. for (int i = 0; i < CELLS_NUM; i++){
  146. if (measure_value()->cell_vol[i] > 3000 && measure_value()->cell_vol[i] < 3400) {
  147. cell_index = i;
  148. break;
  149. }
  150. }
  151. response[resp_len ++] = cell_index;
  152. }else if (cmd == 0x18) {
  153. uint8_t result = 1;
  154. response[resp_len ++] = payload[2];
  155. if (payload[2] == 1) {
  156. charger_open(1);
  157. discharger_open(1);
  158. result = 0;
  159. }else if (payload[2] == 2){
  160. if (measure_value()->load_current >= -5300 && measure_value()->load_current <= -4700){
  161. result = 0;
  162. }
  163. }else if (payload[2] == 3) {
  164. if (bms_health()->load_current_short) {
  165. result = 0;
  166. }
  167. }else if (payload[2] == 4) {
  168. charger_open(0);
  169. discharger_open(0);
  170. result = 0;
  171. }
  172. response[resp_len ++] = result;
  173. }else if (cmd == 0x20) {
  174. response[resp_len ++] = payload[2];
  175. if (payload[2] == 1) {
  176. response[resp_len ++] = cs1180_is_ready();
  177. }else if (payload[2] == 2) {
  178. charger_open(1);
  179. discharger_open(1);
  180. response[resp_len ++] = 0;
  181. }else if (payload[2] == 3) {
  182. memcpy(response + resp_len, &measure_value()->load_current, 4);
  183. resp_len += 4;
  184. }
  185. }else if (cmd == 0x21) {
  186. response[resp_len ++] = powerdown_flags;
  187. }
  188. response[2] = resp_len - 2;
  189. return resp_len;
  190. }