test_bikespeed.cpp 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157
  1. #include "gtest/gtest.h"
  2. #include <gtest/gtest.h>
  3. #include <tuple>
  4. #include "scope.h"
  5. #include "test_user.h"
  6. class BikeSpeedTest : public testing::Test
  7. {
  8. protected:
  9. static void SetUpTestSuite()
  10. {
  11. bikespeed_voBikeSpeedInit();
  12. iRt_Init();
  13. }
  14. virtual void SetUp() override
  15. {
  16. }
  17. virtual void TearDown() override
  18. {
  19. bikespeed_voBikeSpeedInit();
  20. }
  21. };
  22. class BikeSpeedTest1 : public BikeSpeedTest, public testing::WithParamInterface<int>
  23. {};
  24. TEST_P(BikeSpeedTest1, FreCal)
  25. {
  26. /* Coef Cal */
  27. bikespeed_voBikeSpeedCof();
  28. bikespeed_stFreGetCof.uwNumbersPulses = BIKESPEED_NUMBERS_PULSES;
  29. int timerPrd = TIM1CLK_KHZ * 1000 / (1000 / 25); // cnt = 18000, same as STM32
  30. int timerCnt = 0;
  31. int bikeSpeedSignal = 0, bikeSpeedCnt = 0, bikeSpeedSignalLast = 0;
  32. int bikeSpeedPrd = GetParam();
  33. int capValue = 0;
  34. /* BikeSpeed Freq Cal */
  35. int j = 0;
  36. for(int i = 0; i < 100000000; i++)
  37. {
  38. /* Input BikeSpeed Signal */
  39. bikeSpeedCnt++;
  40. if(bikeSpeedCnt <= (bikeSpeedPrd/10)) // 10% duty
  41. {
  42. bikeSpeedSignal = 0;
  43. }
  44. else
  45. {
  46. bikeSpeedSignal = 1;
  47. if(bikeSpeedPrd == 18000 && j == 0)
  48. {
  49. if(bikeSpeedCnt >= bikeSpeedPrd - 1)
  50. {
  51. bikeSpeedCnt = 0;
  52. j = 1;
  53. }
  54. }
  55. else
  56. {
  57. if(bikeSpeedCnt >= bikeSpeedPrd)
  58. {
  59. bikeSpeedCnt = 0;
  60. }
  61. }
  62. }
  63. /* Timer */
  64. timerCnt ++ ;
  65. if(timerCnt >= timerPrd)
  66. {
  67. timerCnt = 0;
  68. testTimerIntFlg[TIMER1][TIMER_INT_FLAG_UP] = 1;
  69. }
  70. /* Capture: rising edge trigger*/
  71. if(bikeSpeedSignal - bikeSpeedSignalLast == -1)
  72. {
  73. testCh3CapValue[TIMER1] = timerCnt;
  74. testTimerIntFlg[TIMER1][TIMER_INT_FLAG_CH3] = 1;
  75. }
  76. bikeSpeedSignalLast = bikeSpeedSignal;
  77. /* Interrupt: update and capture */
  78. if(testTimerIntFlg[TIMER1][TIMER_INT_FLAG_UP])
  79. {
  80. bikespeed_voBikeSpeedCal(1);
  81. testTimerIntFlg[TIMER1][TIMER_INT_FLAG_UP] = 0;
  82. }
  83. else if(testTimerIntFlg[TIMER1][TIMER_INT_FLAG_CH3])
  84. {
  85. bikespeed_voBikeSpeedCal(3);
  86. testTimerIntFlg[TIMER1][TIMER_INT_FLAG_CH3] = 0;
  87. }
  88. //UdpScope::Send(0, bikespeed_stFreGetOut.uwFrequencyPu);
  89. }
  90. double bikeSpeedFreqPu = (double)TIM1CLK_KHZ * 1000 * 1048576 / bikeSpeedPrd / FBASE / bikespeed_stFreGetCof.uwNumbersPulses; // Q20
  91. if(bikeSpeedFreqPu > bikespeed_stFreGetCof.uwMaxBikeSpeedFre || bikespeed_stFreGetOut.uwCaputureOverflowCnt > bikespeed_stFreGetOut.uwCaputureOverflowMinCntTest)
  92. {
  93. EXPECT_NEAR(bikespeed_stFreGetOut.uwFrequencyPu, 0, 0.1);
  94. }
  95. else
  96. {
  97. EXPECT_NEAR(bikespeed_stFreGetOut.uwFrequencyPu, bikeSpeedFreqPu, 2);
  98. }
  99. }
  100. INSTANTIATE_TEST_SUITE_P(DiffBikeSpeedPeriod, BikeSpeedTest1,
  101. ::testing::Values(0, 500, 3000, 18000, 100000,10000000));
  102. TEST_F(BikeSpeedTest, FreCal2)
  103. {
  104. /* Coef Cal */
  105. bikespeed_voBikeSpeedCof();
  106. bikespeed_stFreGetCof.uwNumbersPulses = BIKESPEED_NUMBERS_PULSES;
  107. /* Test conditions */
  108. bikespeed_stFreGetOut.bikespeed_fsm = BIKESPEED_WORK;
  109. bikespeed_stFreGetOut.uwCaputureNumCnt = 1;
  110. bikespeed_stFreGetOut.uwCaputure1Cnt = 0;
  111. bikespeed_stFreGetOut.uwCaputureOverflowCnt = 3;
  112. double overflowCnt = bikespeed_stFreGetOut.uwCaputureOverflowCnt;
  113. double cap1Cnt = bikespeed_stFreGetOut.uwCaputure1Cnt;
  114. testTimerIntFlg[TIMER1][TIMER_INT_FLAG_UP] = 1;
  115. testCh3CapValue[TIMER1] = 17900;
  116. testTimerIntFlg[TIMER1][TIMER_INT_FLAG_CH3] = 1;
  117. /* Interrupt: update and capture */
  118. if(testTimerIntFlg[TIMER1][TIMER_INT_FLAG_UP])
  119. {
  120. bikespeed_voBikeSpeedCal(1);
  121. testTimerIntFlg[TIMER1][TIMER_INT_FLAG_UP] = 0;
  122. }
  123. else if(testTimerIntFlg[TIMER1][TIMER_INT_FLAG_CH3])
  124. {
  125. bikespeed_voBikeSpeedCal(3);
  126. testTimerIntFlg[TIMER1][TIMER_INT_FLAG_CH3] = 0;
  127. }
  128. double bikeSpeedFreqPu = overflowCnt * 18000 + bikespeed_stFreGetOut.uwCaputure2Cnt - cap1Cnt;
  129. bikeSpeedFreqPu = (double)TIM1CLK_KHZ * 1000 * 1048576 / bikeSpeedFreqPu / FBASE / bikespeed_stFreGetCof.uwNumbersPulses; // Q20
  130. if(bikeSpeedFreqPu > bikespeed_stFreGetCof.uwMaxBikeSpeedFre || bikespeed_stFreGetOut.uwCaputureOverflowCnt > bikespeed_stFreGetOut.uwCaputureOverflowMinCnt)
  131. {
  132. EXPECT_NEAR(bikespeed_stFreGetOut.uwFrequencyPu, 0, 0.1);
  133. }
  134. else
  135. {
  136. EXPECT_NEAR(bikespeed_stFreGetOut.uwFrequencyPu, bikeSpeedFreqPu, 2);
  137. }
  138. }