#include "GenericFactory.h"
#include <fsfwconfig/objects/systemObjectList.h>
#include <fsfwconfig/tmtc/apid.h>
#include <fsfwconfig/tmtc/pusIds.h>
#include <fsfwconfig/OBSWconfig.h>
#include <fsfwconfig/devices/addresses.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/storagemanager/PoolManager.h>
#include <fsfw/tcdistribution/CCSDSDistributor.h>
#include <fsfw/tcdistribution/PUSDistributor.h>
#include <fsfw/timemanager/TimeStamper.h>
#include <mission/utility/TmFunnel.h>
#include <mission/devices/P60DockHandler.h>
#include <bsp_linux/comIF/cookies/CspCookie.h>
#include <bsp_linux/comIF/CspComIF.h>

#if ADD_TEST_CODE == 1
//#include <test/testtasks/TestTask.h>
#include <test/testtasks/P60DockTestTask.h>
#endif

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);

    {
        static constexpr uint8_t NUMBER_OF_POOLS = 5;
        const uint16_t element_sizes[NUMBER_OF_POOLS] = {16, 32, 64, 128, 1024};
        const uint16_t n_elements[NUMBER_OF_POOLS] = {100, 50, 25, 15, 5};
        new PoolManager<NUMBER_OF_POOLS>(objects::TC_STORE, element_sizes,
                n_elements);
    }

    {
        static constexpr uint8_t NUMBER_OF_POOLS = 5;
        const uint16_t element_sizes[NUMBER_OF_POOLS] = {16, 32, 64, 128, 1024};
        const uint16_t n_elements[NUMBER_OF_POOLS] = {100, 50, 25, 15, 5};
        new PoolManager<NUMBER_OF_POOLS>(objects::TM_STORE, element_sizes,
                n_elements);
    }

    {
        static constexpr uint8_t NUMBER_OF_POOLS = 6;
        const uint16_t element_sizes[NUMBER_OF_POOLS] = {32, 64, 512,
                1024, 2048, 4096};
        const uint16_t n_elements[NUMBER_OF_POOLS] = {200, 100, 50, 25, 15, 5};
        new PoolManager<NUMBER_OF_POOLS>(objects::IPC_STORE, element_sizes,
                n_elements);
    }

    new CCSDSDistributor(apid::EIVE_OBSW, objects::CCSDS_PACKET_DISTRIBUTOR);
    new PUSDistributor(apid::EIVE_OBSW, objects::PUS_PACKET_DISTRIBUTOR,
            objects::CCSDS_PACKET_DISTRIBUTOR);


    /* TMTC Reception via UDP socket */
    new TmFunnel(objects::TM_FUNNEL);

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

    /* Cookies */
	CspCookie* p60DockCspCookie = new CspCookie(P60Dock::MAX_REPLY_LENGTH,
			addresses::P60DOCK);

    /* Communication interfaces */
	new CspComIF(objects::P60_DOCK_COM_IF);

    /* Device Handler */
	new P60DockHandler(objects::P60DOCK_HANDLER, objects::P60_DOCK_COM_IF,
			p60DockCspCookie);

    /* Test Device Handler */
#if ADD_TEST_CODE == 1
//    new TestTask(objects::TEST_TASK);
    new P60DockTestTask(objects::P60DOCK_TEST_TASK);
#endif
}