#include "GenericFactory.h"

#include "OBSWConfig.h"
#include "common/definitions.h"
#include "example/test/FsfwExampleTask.h"
#include "example/test/FsfwReaderTask.h"
#include "example/utility/TmFunnel.h"
#include "fsfw/FSFW.h"
#include "fsfw/cfdp/CfdpDistributor.h"
#include "fsfw/devicehandlers/CookieIF.h"
#include "fsfw/events/EventManager.h"
#include "fsfw/health/HealthTable.h"
#include "fsfw/internalerror/InternalErrorReporter.h"
#include "fsfw/ipc/QueueFactory.h"
#include "fsfw/pus/CService200ModeCommanding.h"
#include "fsfw/pus/Service11TelecommandScheduling.h"
#include "fsfw/pus/Service17Test.h"
#include "fsfw/pus/Service1TelecommandVerification.h"
#include "fsfw/pus/Service20ParameterManagement.h"
#include "fsfw/pus/Service2DeviceAccess.h"
#include "fsfw/pus/Service3Housekeeping.h"
#include "fsfw/pus/Service5EventReporting.h"
#include "fsfw/pus/Service8FunctionManagement.h"
#include "fsfw/pus/Service9TimeManagement.h"
#include "fsfw/tcdistribution/CcsdsDistributor.h"
#include "fsfw/tcdistribution/PusDistributor.h"
#include "fsfw/timemanager/CdsShortTimeStamper.h"
#include "fsfw/tmtcservices/VerificationReporter.h"
#include "fsfw_tests/integration/assemblies/TestAssembly.h"
#include "fsfw_tests/integration/controller/TestController.h"
#include "fsfw_tests/integration/devices/TestCookie.h"
#include "fsfw_tests/integration/devices/TestDeviceHandler.h"
#include "fsfw_tests/integration/devices/TestEchoComIF.h"
#include "fsfw_tests/internal/InternalUnitTester.h"
#include "objects/systemObjectList.h"
#include "tmtc/apid.h"

void ObjectFactory::produceGenericObjects(TmFunnel **tmFunnel, StorageManagerIF &tcStore) {
#if OBSW_ADD_CORE_COMPONENTS == 1
  /* Framework objects */
  new EventManager(objects::EVENT_MANAGER);
  new HealthTable(objects::HEALTH_TABLE);
  new InternalErrorReporter(objects::INTERNAL_ERROR_REPORTER);
  auto *stamperAndReader = new CdsShortTimeStamper(objects::TIME_STAMPER);
  new VerificationReporter();
  auto *ccsdsDistrib = new CcsdsDistributor(apid::APID, objects::CCSDS_DISTRIBUTOR);
  new PusDistributor(apid::APID, objects::PUS_DISTRIBUTOR, ccsdsDistrib);
  *tmFunnel = new TmFunnel(*stamperAndReader, objects::TM_FUNNEL);
#endif /* OBSW_ADD_CORE_COMPONENTS == 1 */

  /* PUS stack */
#if OBSW_ADD_PUS_STACK == 1
  new Service1TelecommandVerification(objects::PUS_SERVICE_1_VERIFICATION, apid::APID,
                                      pus::PUS_SERVICE_1, objects::TM_FUNNEL, 5);
  new Service2DeviceAccess(objects::PUS_SERVICE_2_DEVICE_ACCESS, apid::APID, pus::PUS_SERVICE_2, 3,
                           10);
  new Service3Housekeeping(objects::PUS_SERVICE_3_HOUSEKEEPING, apid::APID, pus::PUS_SERVICE_3);
  new Service5EventReporting(
      PsbParams(objects::PUS_SERVICE_5_EVENT_REPORTING, apid::APID, pus::PUS_SERVICE_5), 20, 40);
  new Service8FunctionManagement(objects::PUS_SERVICE_8_FUNCTION_MGMT, apid::APID,
                                 pus::PUS_SERVICE_8, 3, 10);
  new Service9TimeManagement(
      PsbParams(objects::PUS_SERVICE_9_TIME_MGMT, apid::APID, pus::PUS_SERVICE_9));
  new Service17Test(PsbParams(objects::PUS_SERVICE_17_TEST, apid::APID, pus::PUS_SERVICE_17));
  new Service20ParameterManagement(objects::PUS_SERVICE_20_PARAMETERS, apid::APID,
                                   pus::PUS_SERVICE_20);
#if OBSW_ADD_CORE_COMPONENTS == 1
  new Service11TelecommandScheduling<cfg::OBSW_MAX_SCHEDULED_TCS>(
      PsbParams(objects::PUS_SERVICE_11_TC_SCHEDULER, apid::APID, pus::PUS_SERVICE_11),
      ccsdsDistrib);
#endif
  new CService200ModeCommanding(objects::PUS_SERVICE_200_MODE_MGMT, apid::APID,
                                pus::PUS_SERVICE_200);
#endif /* OBSW_ADD_PUS_STACK == 1 */

#if OBSW_ADD_CFDP_COMPONENTS == 1
  MessageQueueIF *cfdpMsgQueue = QueueFactory::instance()->createMessageQueue(5);
  CfdpDistribCfg cfg(objects::CFDP_DISTRIBUTOR, tcStore, cfdpMsgQueue);
  new CfdpDistributor(cfg);
#endif

#if OBSW_ADD_TASK_EXAMPLE == 1
  /* Demo objects */
  new FsfwExampleTask(objects::TEST_DUMMY_1);
  new FsfwExampleTask(objects::TEST_DUMMY_2);
  new FsfwExampleTask(objects::TEST_DUMMY_3);

  bool enablePrintout = false;
#if OBSW_TASK_EXAMPLE_PRINTOUT == 1
  enablePrintout = true;
#endif
  new FsfwReaderTask(objects::TEST_DUMMY_4, enablePrintout);
#endif /* OBSW_ADD_TASK_EXAMPLE == 1 */

#if OBSW_ADD_DEVICE_HANDLER_DEMO == 1

#if OBSW_DEVICE_HANDLER_PRINTOUT == 1
  bool enableInfoPrintout = true;
#else
  bool enableInfoPrintout = false;
#endif /* OBSW_DEVICE_HANDLER_PRINTOUT == 1 */

  /* Demo device handler object */
  size_t expectedMaxReplyLen = 64;
  CookieIF *testCookie = new TestCookie(static_cast<address_t>(testdevice::DeviceIndex::DEVICE_0),
                                        expectedMaxReplyLen);
  new TestEchoComIF(objects::TEST_ECHO_COM_IF);
  new TestDevice(objects::TEST_DEVICE_HANDLER_0, objects::TEST_ECHO_COM_IF, testCookie,
                 testdevice::DeviceIndex::DEVICE_0, enableInfoPrintout);
  testCookie = new TestCookie(static_cast<address_t>(testdevice::DeviceIndex::DEVICE_1),
                              expectedMaxReplyLen);
  new TestDevice(objects::TEST_DEVICE_HANDLER_1, objects::TEST_ECHO_COM_IF, testCookie,
                 testdevice::DeviceIndex::DEVICE_1, enableInfoPrintout);

  new TestAssembly(objects::TEST_ASSEMBLY, objects::NO_OBJECT, objects::TEST_DEVICE_HANDLER_0,
                   objects::TEST_DEVICE_HANDLER_1);

#endif /* OBSW_ADD_DEVICE_HANDLER_DEMO == 1 */

  /* Demo controller object */
#if OBSW_ADD_CONTROLLER_DEMO == 1

#if OBSW_CONTROLLER_PRINTOUT == 1
#endif
  new TestController(objects::TEST_CONTROLLER, objects::NO_OBJECT);

#endif /* OBSW_ADD_CONTROLLER_DEMO == 1 */

#if OBSW_PERFORM_INTERNAL_UNITTEST == 1
  InternalUnitTester::TestConfig testCfg;
  testCfg.testArrayPrinter = false;
#if defined FSFW_OSAL_HOST
  // Not implemented yet for hosted OSAL (requires C++20)
  testCfg.testSemaphores = false;
#endif
  InternalUnitTester unittester;
  unittester.performTests(testCfg);
#endif /* OBSW_PERFORM_INTERNAL_UNITTEST == 1 */
}

void Factory::setStaticFrameworkObjectIds() {
  MonitoringReportContent<float>::timeStamperId = objects::TIME_STAMPER;
  MonitoringReportContent<double>::timeStamperId = objects::TIME_STAMPER;
  MonitoringReportContent<uint32_t>::timeStamperId = objects::TIME_STAMPER;
  MonitoringReportContent<int32_t>::timeStamperId = objects::TIME_STAMPER;
  MonitoringReportContent<int16_t>::timeStamperId = objects::TIME_STAMPER;
  MonitoringReportContent<uint16_t>::timeStamperId = objects::TIME_STAMPER;

  TmFunnel::downlinkDestination = objects::DOWNLINK_DESTINATION;
  // No storage object for now.
  TmFunnel::storageDestination = objects::NO_OBJECT;

  PusServiceBase::PUS_DISTRIBUTOR = objects::PUS_DISTRIBUTOR;
  PusServiceBase::PACKET_DESTINATION = objects::TM_FUNNEL;

  CommandingServiceBase::defaultPacketSource = objects::PUS_DISTRIBUTOR;
  CommandingServiceBase::defaultPacketDestination = objects::TM_FUNNEL;

  VerificationReporter::DEFAULT_RECEIVER = objects::PUS_SERVICE_1_VERIFICATION;
}