eive-obsw/bsp_q7s/ObjectFactory.cpp

236 lines
10 KiB
C++
Raw Normal View History

2020-09-30 17:17:01 +02:00
#include "ObjectFactory.h"
2020-11-20 18:27:07 +01:00
#include <OBSWConfig.h>
#include <tmtc/apid.h>
2020-12-29 13:59:31 +01:00
#include <devices/addresses.h>
2021-01-23 17:22:40 +01:00
#include <devices/gpioIds.h>
2020-11-20 18:27:07 +01:00
#include <tmtc/pusIds.h>
2021-02-14 18:30:12 +01:00
#include <devices/powerSwitcherList.h>
2020-09-30 17:17:01 +02:00
2021-02-14 18:30:12 +01:00
#include <bsp_q7s/devices/HeaterHandler.h>
#include <bsp_q7s/devices/SolarArrayDeploymentHandler.h>
2020-11-20 18:27:07 +01:00
#include <mission/core/GenericFactory.h>
2021-01-28 14:55:21 +01:00
#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>
2021-01-08 09:34:43 +01:00
#include <mission/devices/Tmp1075Handler.h>
2020-12-29 13:59:31 +01:00
#include <mission/devices/devicedefinitions/GomSpacePackets.h>
#include <mission/devices/devicedefinitions/GomspaceDefinitions.h>
2020-11-20 18:27:07 +01:00
#include <mission/utility/TmFunnel.h>
2020-09-30 17:17:01 +02:00
2021-02-14 14:59:43 +01:00
#include <linux/csp/CspCookie.h>
#include <linux/csp/CspComIF.h>
2021-04-01 11:06:26 +02:00
#include <fsfw_hal/linux/i2c/I2cCookie.h>
#include <fsfw_hal/linux/i2c/I2cComIF.h>
2021-03-23 16:52:19 +01:00
#include <fsfw_hal/linux/gpio/LinuxLibgpioIF.h>
#include <fsfw_hal/common/gpio/GpioCookie.h>
2020-12-29 13:59:31 +01:00
2021-02-14 18:30:12 +01:00
#include <fsfw/datapoollocal/LocalDataPoolManager.h>
#include <fsfw/tmtcservices/CommandingServiceBase.h>
#include <fsfw/tmtcservices/PusServiceBase.h>
#include <fsfw/tmtcpacket/pus/TmPacketStored.h>
/* UDP server includes */
#include <fsfw/osal/common/UdpTmTcBridge.h>
#include <fsfw/osal/common/UdpTcPollingTask.h>
2021-02-14 18:30:12 +01:00
2021-02-14 13:07:05 +01:00
#if TEST_LIBGPIOD == 1
2021-02-14 19:22:58 +01:00
#include <linux/boardtest/LibgpiodTest.h>
2021-02-14 09:25:40 +01:00
#endif
2020-11-20 18:27:07 +01:00
void Factory::setStaticFrameworkObjectIds() {
2021-02-14 14:59:43 +01:00
PusServiceBase::packetSource = objects::PUS_PACKET_DISTRIBUTOR;
PusServiceBase::packetDestination = objects::TM_FUNNEL;
2020-09-30 17:17:01 +02:00
2021-02-14 14:59:43 +01:00
CommandingServiceBase::defaultPacketSource = objects::PUS_PACKET_DISTRIBUTOR;
CommandingServiceBase::defaultPacketDestination = objects::TM_FUNNEL;
2020-09-30 17:17:01 +02:00
2021-02-14 14:59:43 +01:00
TmFunnel::downlinkDestination = objects::UDP_BRIDGE;
// No storage object for now.
TmFunnel::storageDestination = objects::NO_OBJECT;
2020-09-30 17:17:01 +02:00
2021-02-14 14:59:43 +01:00
LocalDataPoolManager::defaultHkDestination = objects::NO_OBJECT;
2020-12-29 02:16:39 +01:00
2021-02-14 14:59:43 +01:00
VerificationReporter::messageReceiver = objects::PUS_SERVICE_1_VERIFICATION;
TmPacketStored::timeStamperId = objects::TIME_STAMPER;
2020-09-30 17:17:01 +02:00
}
void ObjectFactory::produce(){
2021-02-14 14:59:43 +01:00
Factory::setStaticFrameworkObjectIds();
ObjectFactory::produceGenericObjects();
2020-09-30 17:17:01 +02:00
2021-01-28 14:55:21 +01:00
#if TE0720 == 1
2021-02-14 14:59:43 +01:00
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"));
2021-01-28 14:55:21 +01:00
#else
2021-02-14 14:59:43 +01:00
I2cCookie* i2cCookieTmp1075tcs1 = new I2cCookie(addresses::TMP1075_TCS_1,
2021-01-28 14:55:21 +01:00
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
2020-12-29 13:59:31 +01:00
/* Communication interfaces */
2021-02-14 14:59:43 +01:00
new CspComIF(objects::CSP_COM_IF);
new I2cComIF(objects::I2C_COM_IF);
2020-12-29 13:59:31 +01:00
2021-02-14 09:25:40 +01:00
#if TE0720 == 0
2021-02-14 14:59:43 +01:00
CspCookie* p60DockCspCookie = new CspCookie(P60Dock::MAX_REPLY_LENGTH,
addresses::P60DOCK);
2021-02-14 09:25:40 +01:00
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,
2021-02-14 14:59:43 +01:00
addresses::ACU);
2020-12-29 13:59:31 +01:00
/* Device Handler */
2021-02-14 14:59:43 +01:00
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.
*/
2021-03-20 15:55:15 +01:00
//p60dockhandler->setModeNormal();
//pdu1handler->setModeNormal();
//pdu2handler->setModeNormal();
//acuhandler->setModeNormal();
2021-04-01 14:06:56 +02:00
(void) p60dockhandler;
(void) pdu1handler;
(void) pdu2handler;
(void) acuhandler;
GpioCookie* gpioCookieAcsBoard = new GpioCookie();
gpio::createRpiGpioConfig(gpioCookieAcsBoard, gpioIds::MGM_0_LIS3_CS, gpio::MGM_0_BCM_PIN,
"MGM_0_LIS3", gpio::Direction::OUT, 1);
gpio::createRpiGpioConfig(gpioCookieAcsBoard, gpioIds::MGM_1_RM3100_CS, gpio::MGM_1_BCM_PIN,
"MGM_1_RM3100", gpio::Direction::OUT, 1);
gpio::createRpiGpioConfig(gpioCookieAcsBoard, gpioIds::MGM_2_LIS3_CS, gpio::MGM_2_BCM_PIN,
"MGM_2_LIS3", gpio::Direction::OUT, 1);
gpio::createRpiGpioConfig(gpioCookieAcsBoard, gpioIds::MGM_3_RM3100_CS, gpio::MGM_3_BCM_PIN,
"MGM_3_RM3100", gpio::Direction::OUT, 1);
gpio::createRpiGpioConfig(gpioCookieAcsBoard, gpioIds::GYRO_0_ADIS_CS, gpio::GYRO_0_BCM_PIN,
"GYRO_0_ADIS", gpio::Direction::OUT, 1);
gpio::createRpiGpioConfig(gpioCookieAcsBoard, gpioIds::GYRO_1_L3G_CS, gpio::GYRO_1_BCM_PIN,
"GYRO_1_L3G", gpio::Direction::OUT, 1);
gpio::createRpiGpioConfig(gpioCookieAcsBoard, gpioIds::GYRO_2_L3G_CS, gpio::GYRO_2_BCM_PIN,
"GYRO_2_L3G", gpio::Direction::OUT, 1);
gpioIF->addGpios(gpioCookieAcsBoard);
std::string spiDev = "/dev/spidev2.0";
2021-04-01 14:06:56 +02:00
SpiCookie* spiCookie = new SpiCookie(addresses::MGM_0_LIS3, gpioIds::MGM_0_LIS3_CS, spiDev,
MGMLIS3MDL::MAX_BUFFER_SIZE, spi::DEFAULT_LIS3_MODE, spi::DEFAULT_LIS3_SPEED);
auto mgmLis3Handler = new MGMHandlerLIS3MDL(objects::MGM_0_LIS3_HANDLER,
objects::SPI_COM_IF, spiCookie);
mgmLis3Handler->setStartUpImmediately();
spiCookie = new SpiCookie(addresses::MGM_1_RM3100, gpioIds::MGM_1_RM3100_CS, spiDev,
RM3100::MAX_BUFFER_SIZE, spi::DEFAULT_RM3100_MODE, spi::DEFAULT_RM3100_SPEED);
auto mgmRm3100Handler = new MGMHandlerRM3100(objects::MGM_1_RM3100_HANDLER,
objects::SPI_COM_IF, spiCookie);
mgmRm3100Handler->setStartUpImmediately();
spiCookie = new SpiCookie(addresses::GYRO_1_L3G, gpioIds::GYRO_1_L3G_CS, spiDev,
L3GD20H::MAX_BUFFER_SIZE, spi::DEFAULT_L3G_MODE, spi::DEFAULT_L3G_SPEED);
auto gyroL3gHandler = new GyroHandlerL3GD20H(objects::GYRO_1_L3G_HANDLER, objects::SPI_COM_IF,
spiCookie);
gyroL3gHandler->setStartUpImmediately();
2021-02-14 09:25:40 +01:00
#endif
2021-02-14 14:59:43 +01:00
/* 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();
2021-02-16 15:32:24 +01:00
GpioCookie* heaterGpiosCookie = new GpioCookie;
2021-02-14 14:59:43 +01:00
new LinuxLibgpioIF(objects::GPIO_IF);
#if TE0720 == 0
2021-02-14 14:59:43 +01:00
/* Pin H2-11 on stack connector */
2021-02-23 13:38:43 +01:00
GpiodRegular gpioConfigHeater0(std::string("gpiochip7"), 18,
2021-02-14 12:35:08 +01:00
std::string("Heater0"), gpio::OUT, 0);
2021-02-16 15:32:24 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_0, gpioConfigHeater0);
2021-02-12 15:24:37 +01:00
/* Pin H2-12 on stack connector */
2021-02-23 13:38:43 +01:00
GpiodRegular gpioConfigHeater1(std::string("gpiochip7"), 14,
2021-02-14 14:59:43 +01:00
std::string("Heater1"), gpio::OUT, 0);
2021-02-16 15:32:24 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_1, gpioConfigHeater1);
2021-02-12 15:24:37 +01:00
2021-02-14 14:59:43 +01:00
/* Pin H2-13 on stack connector */
2021-02-23 13:38:43 +01:00
GpiodRegular gpioConfigHeater2(std::string("gpiochip7"), 20,
2021-02-14 14:59:43 +01:00
std::string("Heater2"), gpio::OUT, 0);
2021-02-16 15:32:24 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_2, gpioConfigHeater2);
2021-02-12 15:24:37 +01:00
2021-02-23 13:38:43 +01:00
GpiodRegular gpioConfigHeater3(std::string("gpiochip7"), 16,
2021-02-14 14:59:43 +01:00
std::string("Heater3"), gpio::OUT, 0);
2021-02-16 15:32:24 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_3, gpioConfigHeater3);
2021-02-12 15:24:37 +01:00
2021-02-23 13:38:43 +01:00
GpiodRegular gpioConfigHeater4(std::string("gpiochip7"), 24,
2021-02-14 14:59:43 +01:00
std::string("Heater4"), gpio::OUT, 0);
2021-02-16 15:32:24 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_4, gpioConfigHeater4);
2021-02-12 15:24:37 +01:00
2021-02-23 13:38:43 +01:00
GpiodRegular gpioConfigHeater5(std::string("gpiochip7"), 26,
2021-02-14 14:59:43 +01:00
std::string("Heater5"), gpio::OUT, 0);
2021-02-16 15:32:24 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_5, gpioConfigHeater5);
2021-02-12 15:24:37 +01:00
2021-02-23 13:38:43 +01:00
GpiodRegular gpioConfigHeater6(std::string("gpiochip7"), 22,
2021-02-14 14:59:43 +01:00
std::string("Heater6"), gpio::OUT, 0);
2021-02-16 15:32:24 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_6, gpioConfigHeater6);
2021-02-12 15:24:37 +01:00
2021-02-23 13:38:43 +01:00
GpiodRegular gpioConfigHeater7(std::string("gpiochip7"), 28,
2021-02-14 14:59:43 +01:00
std::string("Heater7"), gpio::OUT, 0);
2021-02-16 15:32:24 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_7, gpioConfigHeater7);
2021-02-12 15:24:37 +01:00
2021-02-16 15:32:24 +01:00
new HeaterHandler(objects::HEATER_HANDLER, objects::GPIO_IF, heaterGpiosCookie, objects::PCDU_HANDLER,
2021-02-14 14:59:43 +01:00
pcduSwitches::TCS_BOARD_8V_HEATER_IN);
2021-02-16 15:32:24 +01:00
GpioCookie* solarArrayDeplCookie = new GpioCookie;
2021-02-23 13:38:43 +01:00
GpiodRegular gpioConfigDeplSA1(std::string("gpiochip7"), 25,
2021-02-24 11:40:45 +01:00
std::string("DeplSA1"), gpio::OUT, 0);
2021-02-16 15:32:24 +01:00
solarArrayDeplCookie->addGpio(gpioIds::DEPLSA1, gpioConfigDeplSA1);
2021-02-23 13:38:43 +01:00
GpiodRegular gpioConfigDeplSA2(std::string("gpiochip7"), 23,
2021-02-24 11:40:45 +01:00
std::string("DeplSA2"), gpio::OUT, 0);
2021-02-16 15:32:24 +01:00
solarArrayDeplCookie->addGpio(gpioIds::DEPLSA2, gpioConfigDeplSA2);
//TODO: Find out burn time. For now set to 1000 ms.
new SolarArrayDeploymentHandler(objects::SOLAR_ARRAY_DEPL_HANDLER, objects::GPIO_IF,
solarArrayDeplCookie, objects::PCDU_HANDLER, pcduSwitches::DEPLOYMENT_MECHANISM,
gpioIds::DEPLSA1, gpioIds::DEPLSA2, 1000);
2021-01-23 17:22:40 +01:00
#endif
2020-12-29 13:59:31 +01:00
new UdpTmTcBridge(objects::UDP_BRIDGE,
2021-02-14 14:59:43 +01:00
objects::CCSDS_PACKET_DISTRIBUTOR,
objects::TM_STORE, objects::TC_STORE);
new UdpTcPollingTask(objects::UDP_POLLING_TASK, objects::UDP_BRIDGE);
2021-02-14 09:25:40 +01:00
#if TE0720 == 1 && TEST_LIBGPIOD == 1
2021-02-14 14:59:43 +01:00
/* Configure MIO0 as input */
GpioConfig_t gpioConfigMio0(std::string("gpiochip0"), 0,
2021-02-14 12:35:08 +01:00
std::string("MIO0"), gpio::IN, 0);
2021-02-16 15:32:24 +01:00
GpioCookie* gpioCookie = new GpioCookie;
2021-02-22 17:36:44 +01:00
gpioCookie->addGpio(gpioIds::TEST_ID_0, gpioConfigMio0);
2021-02-14 14:59:43 +01:00
new LibgpiodTest(objects::LIBGPIOD_TEST, objects::GPIO_IF, gpioCookie);
#elif TE0720 == 1
2021-02-14 14:59:43 +01:00
/* Configuration for MIO0 on TE0720-03-1CFA */
GpioConfig_t gpioConfigForDummyHeater(std::string("gpiochip0"), 0,
2021-02-14 12:35:08 +01:00
std::string("Heater0"), gpio::OUT, 0);
2021-02-16 15:32:24 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_0, gpioConfigForDummyHeater);
2021-02-22 17:36:44 +01:00
new HeaterHandler(objects::HEATER_HANDLER, objects::GPIO_IF, heaterGpiosCookie,
objects::PCDU_HANDLER, pcduSwitches::TCS_BOARD_8V_HEATER_IN);
2021-02-14 09:25:40 +01:00
#endif
2020-09-30 17:17:01 +02:00
}