#include "ObjectFactory.h"
#include <OBSWConfig.h>
#include <tmtc/apid.h>
#include <devices/addresses.h>
#include <devices/gpioIds.h>
#include <tmtc/pusIds.h>

#include <fsfw/datapoollocal/LocalDataPoolManager.h>
#include <fsfw/tmtcservices/CommandingServiceBase.h>
#include <fsfw/tmtcservices/PusServiceBase.h>
#include <fsfw/osal/linux/TmTcUnixUdpBridge.h>
#include <fsfw/tmtcpacket/pus/TmPacketStored.h>
#include <fsfw/osal/linux/TcUnixUdpPollingTask.h>

#include <fsfwconfig/devices/powerSwitcherList.h>

#include <mission/core/GenericFactory.h>
#include <mission/devices/PDU1Handler.h>
#include <mission/devices/PDU2Handler.h>
#include <mission/devices/ACUHandler.h>
#include <mission/devices/PCDUHandler.h>
#include <mission/devices/P60DockHandler.h>
#include <mission/devices/Tmp1075Handler.h>
#include <mission/devices/HeaterHandler.h>
#include <mission/devices/devicedefinitions/GomSpacePackets.h>
#include <mission/devices/devicedefinitions/GomspaceDefinitions.h>
#include <mission/utility/TmFunnel.h>

#include <bsp_q7s/comIF/cookies/CspCookie.h>
#include <bsp_q7s/comIF/cookies/I2cCookie.h>
#include <bsp_q7s/comIF/CspComIF.h>
#include <bsp_q7s/comIF/I2cComIF.h>
#include <bsp_q7s/gpio/LinuxLibgpioIF.h>
#include <bsp_q7s/gpio/cookies/GpioCookie.h>

# if TEST_LIBGPIOD == 1
#include "LibgpiodTest.h"
#endif

void Factory::setStaticFrameworkObjectIds() {
	PusServiceBase::packetSource = objects::PUS_PACKET_DISTRIBUTOR;
	PusServiceBase::packetDestination = objects::TM_FUNNEL;

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

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

	LocalDataPoolManager::defaultHkDestination = objects::NO_OBJECT;

	VerificationReporter::messageReceiver = objects::PUS_SERVICE_1_VERIFICATION;
	TmPacketStored::timeStamperId = objects::TIME_STAMPER;
}



void ObjectFactory::produce(){
	Factory::setStaticFrameworkObjectIds();
	ObjectFactory::produceGenericObjects();

#if TE0720 == 1
	I2cCookie* i2cCookieTmp1075tcs1 = new I2cCookie(addresses::TMP1075_TCS_1,
			TMP1075::MAX_REPLY_LENGTH, std::string("/dev/i2c-0"));
	I2cCookie* i2cCookieTmp1075tcs2 = new I2cCookie(addresses::TMP1075_TCS_2,
			TMP1075::MAX_REPLY_LENGTH, std::string("/dev/i2c-0"));
#else
	I2cCookie* i2cCookieTmp1075tcs1 = new I2cCookie(addresses::TMP1075_TCS_1,
            TMP1075::MAX_REPLY_LENGTH, std::string("/dev/i2c-1"));
    I2cCookie* i2cCookieTmp1075tcs2 = new I2cCookie(addresses::TMP1075_TCS_2,
            TMP1075::MAX_REPLY_LENGTH, std::string("/dev/i2c-1"));
#endif
    /* Communication interfaces */
	new CspComIF(objects::CSP_COM_IF);
	new I2cComIF(objects::I2C_COM_IF);

#if TE0720 == 0
	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);
    /* Device Handler */
	P60DockHandler* p60dockhandler = new P60DockHandler(objects::P60DOCK_HANDLER, objects::CSP_COM_IF, p60DockCspCookie);
	PDU1Handler* pdu1handler = new PDU1Handler(objects::PDU1_HANDLER, objects::CSP_COM_IF, pdu1CspCookie);
	PDU2Handler* pdu2handler = new PDU2Handler(objects::PDU2_HANDLER, objects::CSP_COM_IF, pdu2CspCookie);
	ACUHandler* acuhandler = new ACUHandler(objects::ACU_HANDLER, objects::CSP_COM_IF, acuCspCookie);
	new PCDUHandler(objects::PCDU_HANDLER, 50);

	/**
	 * Setting PCDU devices to mode normal immediately after start up because PCDU is always
	 * running.
	 */
	p60dockhandler->setModeNormal();
	pdu1handler->setModeNormal();
	pdu2handler->setModeNormal();
	acuhandler->setModeNormal();
#endif
	/* Temperature sensors */
	Tmp1075Handler* tmp1075Handler_1 = new Tmp1075Handler(
			objects::TMP1075_HANDLER_1, objects::I2C_COM_IF,
			i2cCookieTmp1075tcs1);
	tmp1075Handler_1->setStartUpImmediately();
	Tmp1075Handler* tmp1075Handler_2 = new Tmp1075Handler(
			objects::TMP1075_HANDLER_2, objects::I2C_COM_IF,
			i2cCookieTmp1075tcs2);
	tmp1075Handler_2->setStartUpImmediately();

	GpioCookie* gpioCookie = new GpioCookie;
	new LinuxLibgpioIF(objects::GPIO_IF);
#if TE0720 == 0
	/* Pin H2-11 on stack connector */
	GpioConfig_t gpioConfigHeater0(std::string("gpiochip7"), 18,
            std::string("Heater0"), Gpio::OUT, 0);
    gpioCookie->addGpio(gpioIds::HEATER_0, gpioConfigHeater0);

    /* Pin H2-12 on stack connector */
    GpioConfig_t gpioConfigHeater1(std::string("gpiochip7"), 14,
			std::string("Heater1"), Gpio::OUT, 0);
	gpioCookie->addGpio(gpioIds::HEATER_1, gpioConfigHeater1);

	/* Pin H2-13 on stack connector */
    GpioConfig_t gpioConfigHeater2(std::string("gpiochip7"), 20,
			std::string("Heater2"), Gpio::OUT, 0);
	gpioCookie->addGpio(gpioIds::HEATER_2, gpioConfigHeater2);

    GpioConfig_t gpioConfigHeater3(std::string("gpiochip7"), 16,
			std::string("Heater3"), Gpio::OUT, 0);
	gpioCookie->addGpio(gpioIds::HEATER_3, gpioConfigHeater3);

    GpioConfig_t gpioConfigHeater4(std::string("gpiochip7"), 24,
			std::string("Heater4"), Gpio::OUT, 0);
	gpioCookie->addGpio(gpioIds::HEATER_4, gpioConfigHeater4);

    GpioConfig_t gpioConfigHeater5(std::string("gpiochip7"), 26,
			std::string("Heater5"), Gpio::OUT, 0);
	gpioCookie->addGpio(gpioIds::HEATER_5, gpioConfigHeater5);

    GpioConfig_t gpioConfigHeater6(std::string("gpiochip7"), 22,
			std::string("Heater6"), Gpio::OUT, 0);
	gpioCookie->addGpio(gpioIds::HEATER_6, gpioConfigHeater6);

    GpioConfig_t gpioConfigHeater7(std::string("gpiochip7"), 28,
			std::string("Heater7"), Gpio::OUT, 0);
	gpioCookie->addGpio(gpioIds::HEATER_7, gpioConfigHeater7);

	new HeaterHandler(objects::HEATER_HANDLER, objects::GPIO_IF, gpioCookie, objects::PCDU_HANDLER,
	            pcduSwitches::TCS_BOARD_8V_HEATER_IN);
#endif

	new TmTcUnixUdpBridge(objects::UDP_BRIDGE,
			objects::CCSDS_PACKET_DISTRIBUTOR,
			objects::TM_STORE, objects::TC_STORE);
	new TcUnixUdpPollingTask(objects::UDP_POLLING_TASK, objects::UDP_BRIDGE);

#if TE0720 == 1 && TEST_LIBGPIOD == 1
	/* Configure MIO0 as input */
    GpioConfig_t gpioConfigMio0(std::string("gpiochip0"), 0,
            std::string("MIO0"), Gpio::IN, 0);
    gpioCookie->addGpio(gpioIds::Test_ID, gpioConfigMio0);
	new LibgpiodTest(objects::LIBGPIOD_TEST, objects::GPIO_IF, gpioCookie);
#elif TE0720 == 1
	// Configuration for MIO0 on TE0720-03-1CFA
    GpioConfig_t gpioConfigForDummyHeater(std::string("gpiochip0"), 0,
            std::string("Heater0"), Gpio::OUT, 0);
    gpioCookie->addGpio(gpioIds::HEATER_0, gpioConfigForDummyHeater);
    new HeaterHandler(objects::HEATER_HANDLER, objects::GPIO_IF, gpioCookie, objects::PCDU_HANDLER,
            pcduSwitches::TCS_BOARD_8V_HEATER_IN);
#endif
}