src/test/test_fmap/test_fmap.cpp

   1 #include <cstdint>
   2 #include <crsf_protocol.h>
   3 #include <unity.h>
   4 #include <iostream>
   5 #include <bitset>
   6
   7 static uint16_t fmapf(uint16_t x, float in_min, float in_max, float out_min, float out_max) { return round((x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min); };
   8
   9 void test_fmap_consistent_with_float(void)
  10 {
  11     for (int i = 172; i <= 1811; i++)
  12     {
  13         uint16_t iv = fmap(i, 172, 1811, 0, 1023);
  14         uint16_t fv = fmapf(i, 172, 1811, 0, 1023);
  15
  16         // assert that the integer function is equivalent to the floating point function
  17         TEST_ASSERT_EQUAL(fv, iv);
  18     }
  19 }
  20
  21 void test_fmap_consistent_bider(void)
  22 {
  23     for (int i = 172; i <= 1811; i++)
  24     {
  25         uint16_t iv = fmap(i, 172, 1811, 0, 1023);
  26         uint16_t iiv = fmap(iv, 0, 1023, 172, 1811);
  27         uint16_t fiv = fmapf(iv, 0, 1023, 172, 1811);
  28
  29         // make sure that integer and floats return the same values
  30         TEST_ASSERT_EQUAL(fiv, iiv);
  31
  32         // make sure that the full cycle value is +/- 1 error given that the input range is under 2x the output range
  33         TEST_ASSERT_GREATER_OR_EQUAL(i-1, iiv);
  34         TEST_ASSERT_LESS_OR_EQUAL(i+1, iiv);
  35     }
  36 }
  37
  38 // Unity setup/teardown
  39 void setUp() {}
  40 void tearDown() {}
  41
  42 int main(int argc, char **argv)
  43 {
  44     UNITY_BEGIN();
  45     RUN_TEST(test_fmap_consistent_with_float);
  46     RUN_TEST(test_fmap_consistent_bider);
  47     UNITY_END();
  48
  49     return 0;
  50 }