src/main/drivers/compass/compass_fake.c

   1 /*
   2  * This file is part of Cleanflight and Betaflight.
   3  *
   4  * Cleanflight and Betaflight are free software. You can redistribute
   5  * this software and/or modify this software under the terms of the
   6  * GNU General Public License as published by the Free Software
   7  * Foundation, either version 3 of the License, or (at your option)
   8  * any later version.
   9  *
  10  * Cleanflight and Betaflight are distributed in the hope that they
  11  * will be useful, but WITHOUT ANY WARRANTY; without even the implied
  12  * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  13  * See the GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this software.
  17  *
  18  * If not, see <http://www.gnu.org/licenses/>.
  19  */
  20
  21 #include <stdbool.h>
  22 #include <stdint.h>
  23
  24 #include "platform.h"
  25
  26 #ifdef USE_FAKE_MAG
  27
  28 #include "build/build_config.h"
  29
  30 #include "common/axis.h"
  31 #include "common/utils.h"
  32
  33 #include "compass.h"
  34 #include "compass_fake.h"
  35
  36
  37 static int16_t fakeMagData[XYZ_AXIS_COUNT];
  38
  39 static bool fakeMagInit(magDev_t *mag)
  40 {
  41     UNUSED(mag);
  42
  43     // initially point north
  44     fakeMagData[X] = 4096;
  45     fakeMagData[Y] = 0;
  46     fakeMagData[Z] = 0;
  47     return true;
  48 }
  49
  50 void fakeMagSet(int16_t x, int16_t y, int16_t z)
  51 {
  52     fakeMagData[X] = x;
  53     fakeMagData[Y] = y;
  54     fakeMagData[Z] = z;
  55 }
  56
  57 static bool fakeMagRead(magDev_t *mag, int16_t *magData)
  58 {
  59     UNUSED(mag);
  60
  61     magData[X] = fakeMagData[X];
  62     magData[Y] = fakeMagData[Y];
  63     magData[Z] = fakeMagData[Z];
  64     return true;
  65 }
  66
  67 bool fakeMagDetect(magDev_t *mag)
  68 {
  69     mag->init = fakeMagInit;
  70     mag->read = fakeMagRead;
  71     return true;
  72 }
  73 #endif // USE_FAKE_MAG
  74