#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/Service3Housekeeping.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 <bsp_linux/comIF/cookies/CspCookie.h>
#include <bsp_linux/comIF/CspComIF.h>
#include "mission/devices/GomspaceDeviceHandler.h"
#include "mission/devices/devicedefinitions/GomspaceDefinitions.h"

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

void ObjectFactory::produceGenericObjects() {
    /* Framework objects */
    new EventManager(objects::EVENT_MANAGER);
    new HealthTable(objects::HEALTH_TABLE);
    new InternalErrorReporter(objects::INTERNAL_ERROR_REPORTER);
    new TimeStamper(objects::TIME_STAMPER);

    {
        PoolManager::LocalPoolConfig poolCfg = {
                {100, 16}, {50, 32}, {25, 64}, {15, 128}, {5, 1024}
        };
        new PoolManager(objects::TC_STORE, poolCfg);
    }

    {
        PoolManager::LocalPoolConfig poolCfg = {
                {100, 16}, {50, 32}, {25, 64}, {15, 128}, {5, 1024}
        };
        new PoolManager(objects::TM_STORE, poolCfg);
    }

    {
        PoolManager::LocalPoolConfig poolCfg = {
                {100, 16}, {50, 32}, {25, 64}, {15, 128}, {5, 1024}
        };
        new PoolManager(objects::IPC_STORE, poolCfg);
    }

    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, 20);
    new Service2DeviceAccess(objects::PUS_SERVICE_2_DEVICE_ACCESS,
            apid::EIVE_OBSW, pus::PUS_SERVICE_2, 3, 10);
    new Service3Housekeeping(objects::PUS_SERVICE_3_HOUSEKEEPING,
    			apid::EIVE_OBSW, pus::PUS_SERVICE_3);
    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);
	CspCookie* pdu1CspCookie = new CspCookie(PDU::MAX_REPLY_LENGTH,
			addresses::PDU1);
	CspCookie* pdu2CspCookie = new CspCookie(PDU::MAX_REPLY_LENGTH,
			addresses::PDU2);
	CspCookie* acuCspCookie = new CspCookie(ACU::MAX_REPLY_LENGTH,
				addresses::ACU);

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

    /* Device Handler */
	new GomspaceDeviceHandler(objects::P60DOCK_HANDLER, objects::CSP_COM_IF,
			p60DockCspCookie, P60Dock::MAX_CONFIGTABLE_ADDRESS,
			P60Dock::MAX_HKTABLE_ADDRESS);
	new GomspaceDeviceHandler(objects::PDU1_HANDLER, objects::CSP_COM_IF,
			pdu1CspCookie, PDU::MAX_CONFIGTABLE_ADDRESS,
			PDU::MAX_HKTABLE_ADDRESS);
	new GomspaceDeviceHandler(objects::PDU2_HANDLER, objects::CSP_COM_IF,
			pdu2CspCookie, PDU::MAX_CONFIGTABLE_ADDRESS,
			PDU::MAX_HKTABLE_ADDRESS);
	new GomspaceDeviceHandler(objects::ACU_HANDLER, objects::CSP_COM_IF,
				acuCspCookie, ACU::MAX_CONFIGTABLE_ADDRESS,
				ACU::MAX_HKTABLE_ADDRESS);

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