main_target.c 4.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138
  1. #include "src/battery_data/battery.h"
  2. #include "ti_msp_dl_config.h"
  3. //#include "ti/driverlib/dl_i2c.h"
  4. #include <stdio.h>
  5. #include "src/interfaces/i2c_target.h"
  6. #include "src/interfaces/i2c_controller.h"
  7. #include "src/config.h"
  8. volatile bool mcu_CommandPending= false;
  9. void I2C_controller_INST_IRQHandler(void) {
  10. switch (DL_I2C_getPendingInterrupt(I2C_controller_INST)) {
  11. case DL_I2C_IIDX_CONTROLLER_START:
  12. controllerRxPackage.count = 0;
  13. DL_I2C_flushControllerTXFIFO(I2C_controller_INST);
  14. break;
  15. case DL_I2C_IIDX_CONTROLLER_RXFIFO_TRIGGER:
  16. /* Store bytes received from target in Rx Msg Buffer */
  17. while (DL_I2C_isControllerRXFIFOEmpty(I2C_controller_INST) != true) {
  18. if (controllerRxPackage.count < controllerRxPackage.len) {
  19. controllerRxPackage.packet[controllerRxPackage.count] =
  20. DL_I2C_receiveControllerData(I2C_controller_INST);
  21. ;
  22. controllerRxPackage.count++;
  23. } else {
  24. /* Ignore and remove from FIFO if the buffer is full */
  25. DL_I2C_receiveControllerData(I2C_controller_INST);
  26. }
  27. }
  28. if (controllerRxPackage.count >= controllerRxPackage.len) {
  29. controllerRxPackage.complete = true;
  30. DL_I2C_enableInterrupt(I2C_controller_INST,
  31. DL_I2C_INTERRUPT_CONTROLLER_STOP);
  32. }
  33. break;
  34. /*TRANSMIT data to ADC*/
  35. case DL_I2C_IIDX_CONTROLLER_TXFIFO_TRIGGER:
  36. if (controllerTxPackage.count < controllerTxPackage.len) {
  37. DL_I2C_fillControllerTXFIFO(I2C_controller_INST,
  38. &controllerTxPackage.packet[controllerTxPackage.count],
  39. (controllerTxPackage.len - controllerTxPackage.count));
  40. controllerTxPackage.count++;
  41. } else {
  42. /*Prevent overflow and just ignore data*/
  43. DL_I2C_fillTargetTXFIFO(I2C_controller_INST, (uint8_t[]){0x00}, 1);
  44. controllerTxPackage.complete = true;
  45. }
  46. if(controllerTxPackage.count >= controllerTxPackage.len){
  47. controllerTxPackage.complete= true;
  48. }
  49. break;
  50. /*STOP condition*/
  51. case DL_I2C_IIDX_CONTROLLER_STOP:
  52. controllerTxPackage.complete = true;
  53. controllerRxPackage.complete = true;
  54. break;
  55. case DL_I2C_IIDX_CONTROLLER_ARBITRATION_LOST:
  56. break;
  57. case DL_I2C_IIDX_CONTROLLER_NACK:
  58. break;
  59. default:
  60. break;
  61. }
  62. }
  63. /**** Interrupt for Pi to MCU ****/
  64. void I2C_target_INST_IRQHandler(void) {
  65. uint32_t status = DL_I2C_getPendingInterrupt(I2C_target_INST);
  66. switch (status) {
  67. case DL_I2C_IIDX_TARGET_START:
  68. DL_I2C_flushTargetTXFIFO(I2C_target_INST);
  69. break;
  70. case DL_I2C_IIDX_TARGET_STOP:
  71. mcu_CommandPending= true;
  72. DL_I2C_flushTargetTXFIFO(I2C_target_INST);
  73. DL_I2C_flushTargetRXFIFO(I2C_target_INST);
  74. break;
  75. case DL_I2C_IIDX_TARGET_RXFIFO_TRIGGER:
  76. if (DL_I2C_isTargetRXFIFOEmpty(I2C_target_INST)) {
  77. return;
  78. }
  79. mcu_CommandPending= true;
  80. break;
  81. case DL_I2C_IIDX_TARGET_TXFIFO_TRIGGER:
  82. mcu_CommandPending= true;
  83. break;
  84. case DL_I2C_IIDX_TARGET_ARBITRATION_LOST:
  85. break;
  86. default:
  87. break;
  88. }
  89. }
  90. int main(void)
  91. {
  92. SYSCFG_DL_init();
  93. battery_slotmgr.init();
  94. NVIC_EnableIRQ(I2C_controller_INST_INT_IRQN);
  95. NVIC_EnableIRQ(I2C_target_INST_INT_IRQN);
  96. initialize_target_address();
  97. while (1) {
  98. if(mcu_CommandPending){
  99. #ifdef DEBUG_TARGET
  100. printf("Calling MCU target action\n");
  101. #endif
  102. mcu_i2c_handle(I2C_target_INST);
  103. mcu_CommandPending = false;
  104. }
  105. for(uint8_t slot= 0; slot< NUM_SLOTS; slot++){
  106. // step 1: update the voltage readings
  107. battery_slotmgr.read_state(slot);
  108. // step 2: control loop to adjust the dac / adc values,
  109. // but only if no error happens
  110. // (0x80 is the error flag of the state)
  111. if ((*battery_slots[slot].state & 0x80) == 0) {
  112. battery_slotmgr.adjust_current(slot);
  113. } else {
  114. battery_slotmgr.disable(slot);
  115. }
  116. }
  117. delay_cycles(MAINLOOP_DELAY);
  118. }
  119. }