main_target.c 4.3 KB

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