#include "GenericFactory.h"

#include <OBSWConfig.h>
#include <datapool/dataPoolInit.h>
#include <fsfw/devicehandlers/CookieIF.h>
#include <objects/systemObjectList.h>
#include <tmtc/apid.h>
#include <tmtc/pusIds.h>

#include <fsfw/events/EventManager.h>
#include <fsfw/health/HealthTable.h>
#include <fsfw/internalError/InternalErrorReporter.h>
#include <fsfw/pus/CService200ModeCommanding.h>
#include <fsfw/pus/Service17Test.h>
#include <fsfw/pus/Service1TelecommandVerification.h>
#include <fsfw/pus/Service2DeviceAccess.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/TimeStamper.h>

#include <mission/utility/TmFunnel.h>
//TODO: include your headers

void ObjectFactory::produceGenericObjects() {
    /* Framework objects */
    new EventManager(objects::EVENT_MANAGER);
    new HealthTable(objects::HEALTH_TABLE);
    new InternalErrorReporter(objects::INTERNAL_ERROR_REPORTER, 0, 0, 0);
    new TimeStamper(objects::TIME_STAMPER);
    new CCSDSDistributor(apid::APID, objects::CCSDS_DISTRIBUTOR);
    new PUSDistributor(apid::APID, objects::PUS_DISTRIBUTOR,
            objects::CCSDS_DISTRIBUTOR);
    new TmFunnel(objects::TM_FUNNEL);

    /* PUS stack */
    new Service1TelecommandVerification(objects::PUS_SERVICE_1_VERIFICATION,
            apid::APID, pus::PUS_SERVICE_1, objects::TM_FUNNEL);
    new Service2DeviceAccess(objects::PUS_SERVICE_2_DEVICE_ACCESS,
            apid::APID, pus::PUS_SERVICE_2, 3, 10);
    new Service5EventReporting(objects::PUS_SERVICE_5_EVENT_REPORTING,
            apid::APID, pus::PUS_SERVICE_5, 50);
    new Service8FunctionManagement(objects::PUS_SERVICE_8_FUNCTION_MGMT,
            apid::APID, pus::PUS_SERVICE_8, 3, 10);
    new Service9TimeManagement(objects::PUS_SERVICE_9_TIME_MGMT, apid::APID,
            pus::PUS_SERVICE_9);
    new Service17Test(objects::PUS_SERVICE_17_TEST, apid::APID,
            pus::PUS_SERVICE_17);
    new CService200ModeCommanding(objects::PUS_SERVICE_200_MODE_MGMT,
            apid::APID, pus::PUS_SERVICE_200);


    /* Demo objects */

    CookieIF* arduinoCookie = new ARDUINOCookie();
//new handler and commIF

#if OBSW_ADD_TEST_CODE == 1
    CookieIF* testCookie = new TestCookie(0);
    new TestEchoComIF(objects::TEST_ECHO_COM_IF);
    new TestDevice(objects::TEST_DEVICE_HANDLER, objects::TEST_ECHO_COM_IF,
            testCookie, true);
#endif
}