/**
 *    ||          ____  _ __
 * +------+      / __ )(_) /_______________ _____  ___
 * | 0xBC |     / __  / / __/ ___/ ___/ __ `/_  / / _ \
 * +------+    / /_/ / / /_/ /__/ /  / /_/ / / /_/  __/
 *  ||  ||    /_____/_/\__/\___/_/   \__,_/ /___/\___/
 *
 * Crazyflie control firmware
 *
 * Copyright (C) 2015 Bitcraze AB
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, in version 3.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program. If not, see <http://www.gnu.org/licenses/>.
 *
 * deck.c - Deck subsystem main entry points
 */

#define DEBUG_MODULE "DECK_CORE"

#include <string.h>

#include "deck.h"
#include "debug.h"

#ifdef DEBUG
  #define DECK_CORE_DBG_PRINT(fmt, ...)  DEBUG_PRINT(fmt, ## __VA_ARGS__)
#else
  #define DECK_CORE_DBG_PRINT(...)
#endif

#ifndef DECK_FORCE
#define DECK_FORCE
#endif

#define xstr(s) str(s)
#define str(s) #s

static char* deck_force = xstr(DECK_FORCE);

extern void deckInfoInit();

void deckInit()
{
  deckDriverCount();
  deckInfoInit();

#ifndef IGNORE_OW_DECKS
  int nDecks;
  int i;

  nDecks = deckCount();

  DEBUG_PRINT("%d deck enumerated\n", nDecks);

  for (i=0; i<nDecks; i++) {
    DeckInfo *deck = deckInfo(i);

    if (deck->driver->init) {
      if (deck->driver->name) {
        DECK_CORE_DBG_PRINT("Calling INIT from driver %s for deck %i\n", deck->driver->name, i);
      } else {
        DECK_CORE_DBG_PRINT("Calling INIT for deck %i\n", i);
      }

      deck->driver->init(deck);
    }
  }
#endif

  // Init build-forced driver
  if (strlen(deck_force)>0) {
    const DeckDriver *driver = deckFindDriverByName(deck_force);
    if (!driver) {
      DEBUG_PRINT("WARNING: compile-time forced driver %s not found\n", deck_force);
    } else if (driver->init) {
      DEBUG_PRINT("Initializing compile-time forced driver %s\n", deck_force);
      driver->init(NULL);  // Passing NULL as deck info
    }
  }
}

bool deckTest()
{
  bool pass = true;
#ifndef IGNORE_OW_DECKS
  int nDecks;
  int i;

  nDecks = deckCount();

  for (i=0; i<nDecks; i++) {
    DeckInfo *deck = deckInfo(i);

    if (deck->driver->test) {
      if (deck->driver->test()) {
        DEBUG_PRINT("Deck %i test [OK].\n", i);
      } else {
        DEBUG_PRINT("Deck %i test [FAIL].\n", i);
        pass = false;
      }
    }
  }
#endif

  // Test build-forced driver
  if (strlen(deck_force)>0) {
    const DeckDriver *driver = deckFindDriverByName(deck_force);
    if (driver && driver->test) {
      if (driver->test()) {
        DEBUG_PRINT("Compile-time forced driver %s test [OK]\n", deck_force);
      } else {
        DEBUG_PRINT("Compile-time forced driver %s test [FAIL]\n", deck_force);
        pass = false;
      }
    }
  }

  return pass;
}