src/main/io/piniobox.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 <stdint.h>
  22
  23 #include "platform.h"
  24
  25 #ifdef USE_PINIOBOX
  26
  27 #include "build/debug.h"
  28
  29 #include "common/time.h"
  30 #include "common/utils.h"
  31
  32 #include "msp/msp_box.h"
  33
  34 #include "pg/pinio.h"
  35 #include "pg/piniobox.h"
  36
  37 #include "scheduler/scheduler.h"
  38
  39 #include "piniobox.h"
  40
  41 typedef struct pinioBoxRuntimeConfig_s {
  42     uint8_t boxId[PINIO_COUNT];
  43 } pinioBoxRuntimeConfig_t;
  44
  45 static pinioBoxRuntimeConfig_t pinioBoxRuntimeConfig;
  46
  47 void pinioBoxInit(const pinioBoxConfig_t *pinioBoxConfig)
  48 {
  49     // Convert permanentId to boxId_e
  50
  51     for (int i = 0; i < PINIO_COUNT; i++) {
  52         const box_t *box = findBoxByPermanentId(pinioBoxConfig->permanentId[i]);
  53
  54         pinioBoxRuntimeConfig.boxId[i] = box ? box->boxId : BOXID_NONE;
  55     }
  56 }
  57
  58 void pinioBoxUpdate(timeUs_t currentTimeUs)
  59 {
  60     UNUSED(currentTimeUs);
  61
  62     for (int i = 0; i < PINIO_COUNT; i++) {
  63         if (pinioBoxRuntimeConfig.boxId[i] != BOXID_NONE) {
  64             pinioSet(i, getBoxIdState(pinioBoxRuntimeConfig.boxId[i]));
  65         }
  66     }
  67 }
  68
  69 void pinioBoxTaskControl(void)
  70 {
  71     bool enableTask = false;
  72     for (int i = 0; i < PINIO_COUNT; i++) {
  73         if (pinioBoxRuntimeConfig.boxId[i] != BOXID_NONE && isModeActivationConditionPresent(pinioBoxRuntimeConfig.boxId[i])) {
  74             enableTask = true;
  75             break;
  76         }
  77     }
  78     setTaskEnabled(TASK_PINIOBOX, enableTask);
  79 }
  80 #endif