#include "scheduling.h"

#include <fsfw/devicehandlers/DeviceHandlerIF.h>
#include <fsfw/tasks/PeriodicTaskIF.h>
#include <mission/utility/InitMission.h>

#include "OBSWConfig.h"
#include "ObjectFactory.h"
#include "eive/objects.h"

PosixThreadArgs scheduling::RR_SCHEDULING = {.policy = SchedulingPolicy::RR};
PosixThreadArgs scheduling::NORMAL_SCHEDULING;

void scheduling::scheduleScexReader(TaskFactory& factory, PeriodicTaskIF*& scexReaderTask) {
  using namespace scheduling;
  ReturnValue_t result = returnvalue::OK;
#if OBSW_PRINT_MISSED_DEADLINES == 1
  void (*missedDeadlineFunc)(void) = TaskFactory::printMissedDeadline;
#else
  void (*missedDeadlineFunc)(void) = nullptr;
#endif

  result = returnvalue::OK;
  scexReaderTask =
      factory.createPeriodicTask("SCEX_UART_READER", 20, PeriodicTaskIF::MINIMUM_STACK_SIZE, 2.0,
                                 missedDeadlineFunc, &NORMAL_SCHEDULING);
  result = scexReaderTask->addComponent(objects::SCEX_UART_READER);
  if (result != returnvalue::OK) {
    printAddObjectError("SCEX_UART_READER", objects::SCEX_UART_READER);
  }
}

void scheduling::addMpsocSupvHandlers(PeriodicTaskIF* plTask) {
  plTask->addComponent(objects::PLOC_SUPERVISOR_HANDLER, DeviceHandlerIF::PERFORM_OPERATION);
  plTask->addComponent(objects::PLOC_SUPERVISOR_HANDLER, DeviceHandlerIF::SEND_WRITE);
  plTask->addComponent(objects::PLOC_SUPERVISOR_HANDLER, DeviceHandlerIF::GET_WRITE);
  plTask->addComponent(objects::PLOC_SUPERVISOR_HANDLER, DeviceHandlerIF::SEND_READ);
  plTask->addComponent(objects::PLOC_SUPERVISOR_HANDLER, DeviceHandlerIF::GET_READ);
  plTask->addComponent(objects::PLOC_SUPERVISOR_HANDLER, DeviceHandlerIF::SEND_READ);
  plTask->addComponent(objects::PLOC_SUPERVISOR_HANDLER, DeviceHandlerIF::GET_READ);

  plTask->addComponent(objects::PLOC_MPSOC_HANDLER, DeviceHandlerIF::PERFORM_OPERATION);
  plTask->addComponent(objects::PLOC_MPSOC_HANDLER, DeviceHandlerIF::SEND_WRITE);
  plTask->addComponent(objects::PLOC_MPSOC_HANDLER, DeviceHandlerIF::GET_WRITE);
  plTask->addComponent(objects::PLOC_MPSOC_HANDLER, DeviceHandlerIF::SEND_READ);
  plTask->addComponent(objects::PLOC_MPSOC_HANDLER, DeviceHandlerIF::GET_READ);
  plTask->addComponent(objects::PLOC_MPSOC_HANDLER, DeviceHandlerIF::SEND_READ);
  plTask->addComponent(objects::PLOC_MPSOC_HANDLER, DeviceHandlerIF::GET_READ);
}

void scheduling::scheduleScexDev(PeriodicTaskIF*& scexDevHandler) {
  ReturnValue_t result =
      scexDevHandler->addComponent(objects::SCEX, DeviceHandlerIF::PERFORM_OPERATION);
  if (result != returnvalue::OK) {
    printAddObjectError("SCEX_DEV", objects::SCEX);
  }
  result = scexDevHandler->addComponent(objects::SCEX, DeviceHandlerIF::SEND_WRITE);
  if (result != returnvalue::OK) {
    printAddObjectError("SCEX_DEV", objects::SCEX);
  }
  result = scexDevHandler->addComponent(objects::SCEX, DeviceHandlerIF::GET_WRITE);
  if (result != returnvalue::OK) {
    printAddObjectError("SCEX_DEV", objects::SCEX);
  }
  result = scexDevHandler->addComponent(objects::SCEX, DeviceHandlerIF::SEND_READ);
  if (result != returnvalue::OK) {
    printAddObjectError("SCEX_DEV", objects::SCEX);
  }
  result = scexDevHandler->addComponent(objects::SCEX, DeviceHandlerIF::GET_READ);
  if (result != returnvalue::OK) {
    printAddObjectError("SCEX_DEV", objects::SCEX);
  }
  result = scexDevHandler->addComponent(objects::SCEX, DeviceHandlerIF::SEND_READ);
  if (result != returnvalue::OK) {
    printAddObjectError("SCEX_DEV", objects::SCEX);
  }
  result = scexDevHandler->addComponent(objects::SCEX, DeviceHandlerIF::GET_READ);
  if (result != returnvalue::OK) {
    printAddObjectError("SCEX_DEV", objects::SCEX);
  }
}