eive-obsw/bsp_q7s/objectFactory.cpp

1074 lines
50 KiB
C++
Raw Normal View History

2023-07-03 16:55:45 +02:00
#include "objectFactory.h"
2022-04-28 15:29:57 +02:00
2023-03-30 17:16:59 +02:00
#include <fsfw/devicehandlers/HealthDevice.h>
2022-11-10 15:39:08 +01:00
#include <fsfw/subsystem/Subsystem.h>
2023-06-15 08:39:06 +02:00
#include <fsfw/tasks/TaskFactory.h>
2023-07-03 16:55:45 +02:00
#include <fsfw_hal/linux/uio/UioMapper.h>
2023-03-24 21:01:00 +01:00
#include <linux/acs/AcsBoardPolling.h>
#include <linux/acs/GpsHyperionLinuxController.h>
2023-03-24 21:01:00 +01:00
#include <linux/acs/ImtqPollingTask.h>
#include <linux/acs/RwPollingTask.h>
#include <linux/acs/StrComHandler.h>
2023-03-24 20:50:33 +01:00
#include <linux/com/SyrlinksComHandler.h>
2023-03-26 16:42:00 +02:00
#include <linux/payload/PlocMemoryDumper.h>
#include <linux/payload/PlocMpsocHandler.h>
2023-05-15 15:15:58 +02:00
#include <linux/payload/PlocMpsocSpecialComHelper.h>
2023-03-26 16:42:00 +02:00
#include <linux/payload/PlocSupervisorHandler.h>
#include <linux/payload/ScexUartReader.h>
2023-05-15 15:15:58 +02:00
#include <linux/payload/plocMpsocHelpers.h>
2023-03-26 16:42:00 +02:00
#include <linux/power/CspComIF.h>
2023-03-24 20:50:33 +01:00
#include <mission/acs/GyrL3gCustomHandler.h>
#include <mission/acs/MgmLis3CustomHandler.h>
#include <mission/acs/MgmRm3100CustomHandler.h>
#include <mission/acs/str/StarTrackerHandler.h>
#include <mission/acs/str/strHelpers.h>
2023-03-31 01:14:59 +02:00
#include <mission/com/LiveTmTask.h>
#include <mission/com/PersistentLogTmStoreTask.h>
#include <mission/com/PersistentSingleTmStoreTask.h>
2023-03-26 16:16:54 +02:00
#include <mission/power/CspCookie.h>
2023-03-24 20:50:33 +01:00
#include <mission/system/acs/ImtqAssembly.h>
2023-03-30 17:16:59 +02:00
#include <mission/system/acs/StrAssembly.h>
2023-04-04 17:55:57 +02:00
#include <mission/system/acs/StrFdir.h>
2023-04-13 23:54:23 +02:00
#include <mission/system/com/SyrlinksAssembly.h>
#include <mission/system/objects/CamSwitcher.h>
2023-04-13 23:54:23 +02:00
#include <mission/system/tcs/TmpDevFdir.h>
2023-07-03 16:55:45 +02:00
#include <cstdint>
#include <cstring>
2021-05-17 16:53:06 +02:00
#include "OBSWConfig.h"
2021-07-19 12:44:43 +02:00
#include "bsp_q7s/boardtest/Q7STestTask.h"
2022-01-17 13:48:55 +01:00
#include "bsp_q7s/callbacks/gnssCallback.h"
2022-01-19 18:11:35 +01:00
#include "bsp_q7s/callbacks/pcduSwitchCb.h"
2022-03-26 16:38:42 +01:00
#include "bsp_q7s/callbacks/q7sGpioCallbacks.h"
2022-01-17 13:48:55 +01:00
#include "bsp_q7s/callbacks/rwSpiCallback.h"
2021-08-17 17:11:59 +02:00
#include "busConf.h"
2022-01-17 13:48:55 +01:00
#include "ccsdsConfig.h"
#include "devConf.h"
2021-05-17 16:53:06 +02:00
#include "devices/addresses.h"
#include "devices/gpioIds.h"
#include "devices/powerSwitcherList.h"
2022-09-16 12:28:39 +02:00
#include "eive/definitions.h"
2022-03-26 16:38:42 +01:00
#include "fsfw/ipc/QueueFactory.h"
#include "linux/ObjectFactory.h"
2022-02-24 12:02:23 +01:00
#include "linux/boardtest/I2cTestClass.h"
#include "linux/boardtest/SpiTestClass.h"
#include "linux/boardtest/UartTestClass.h"
2022-03-26 16:38:42 +01:00
#include "linux/callbacks/gpioCallbacks.h"
#include "linux/ipcore/AxiPtmeConfig.h"
#include "linux/ipcore/PapbVcInterface.h"
#include "linux/ipcore/PdecHandler.h"
#include "linux/ipcore/Ptme.h"
#include "linux/ipcore/PtmeConfig.h"
2023-02-23 15:27:24 +01:00
#include "mission/config/configfile.h"
2023-03-24 20:50:33 +01:00
#include "mission/system/acs/AcsBoardFdir.h"
#include "mission/system/acs/AcsSubsystem.h"
#include "mission/system/acs/RwAssembly.h"
#include "mission/system/acs/SusFdir.h"
#include "mission/system/acs/acsModeTree.h"
#include "mission/system/com/SyrlinksFdir.h"
#include "mission/system/com/comModeTree.h"
2023-04-04 20:34:28 +02:00
#include "mission/system/power/GomspacePowerFdir.h"
2023-04-13 23:54:23 +02:00
#include "mission/system/tcs/RtdFdir.h"
#include "mission/system/tcs/TcsBoardAssembly.h"
#include "mission/system/tcs/tcsModeTree.h"
2022-11-10 15:39:08 +01:00
#include "mission/system/tree/payloadModeTree.h"
#include "mission/tmtc/tmFilters.h"
2023-02-13 11:28:27 +01:00
#include "mission/utility/GlobalConfigHandler.h"
2022-02-24 12:02:23 +01:00
#include "tmtc/pusIds.h"
2022-02-24 12:02:23 +01:00
#if OBSW_TEST_LIBGPIOD == 1
#include "linux/boardtest/LibgpiodTest.h"
#endif
2023-03-26 16:42:00 +02:00
#include <mission/SolarArrayDeploymentHandler.h>
2023-03-24 20:50:33 +01:00
#include <mission/acs/GyrAdis1650XHandler.h>
#include <mission/acs/ImtqHandler.h>
#include <mission/acs/rwHelpers.h>
2023-03-24 19:49:08 +01:00
#include <mission/com/SyrlinksHandler.h>
2023-03-31 01:14:59 +02:00
#include <mission/com/VirtualChannelWithQueue.h>
2023-03-26 16:42:00 +02:00
#include <mission/payload/PayloadPcduHandler.h>
#include <mission/payload/RadiationSensorHandler.h>
#include <mission/payload/payloadPcduDefinitions.h>
#include <mission/payload/radSensorDefinitions.h>
2023-03-26 16:13:54 +02:00
#include <mission/power/AcuHandler.h>
#include <mission/power/BpxBatteryHandler.h>
#include <mission/power/P60DockHandler.h>
#include <mission/power/PcduHandler.h>
#include <mission/power/Pdu1Handler.h>
#include <mission/power/Pdu2Handler.h>
#include <mission/power/gsDefs.h>
2023-03-26 16:42:00 +02:00
#include <mission/tcs/HeaterHandler.h>
#include <mission/tcs/Max31865Definitions.h>
#include <mission/tcs/Max31865PT1000Handler.h>
#include <mission/tcs/Tmp1075Handler.h>
2022-10-20 10:32:17 +02:00
2022-02-24 12:02:23 +01:00
#include <sstream>
2023-07-03 16:55:45 +02:00
#include "bsp_q7s/core/defs.h"
2022-01-17 13:48:55 +01:00
#include "fsfw/datapoollocal/LocalDataPoolManager.h"
#include "fsfw/tmtcpacket/pus/tm.h"
#include "fsfw/tmtcservices/CommandingServiceBase.h"
#include "fsfw/tmtcservices/PusServiceBase.h"
#include "fsfw_hal/common/gpio/GpioCookie.h"
2022-03-28 10:10:01 +02:00
#include "fsfw_hal/common/gpio/gpioDefinitions.h"
2022-01-17 13:48:55 +01:00
#include "fsfw_hal/devicehandlers/GyroL3GD20Handler.h"
#include "fsfw_hal/devicehandlers/MgmLIS3MDLHandler.h"
#include "fsfw_hal/devicehandlers/MgmRM3100Handler.h"
#include "fsfw_hal/linux/gpio/LinuxLibgpioIF.h"
#include "fsfw_hal/linux/i2c/I2cComIF.h"
#include "fsfw_hal/linux/i2c/I2cCookie.h"
2022-11-10 17:42:19 +01:00
#include "fsfw_hal/linux/serial/SerialComIF.h"
#include "fsfw_hal/linux/serial/SerialCookie.h"
2022-01-17 13:48:55 +01:00
#include "fsfw_hal/linux/spi/SpiComIF.h"
#include "fsfw_hal/linux/spi/SpiCookie.h"
2023-03-24 20:50:33 +01:00
#include "mission/acs/RwHandler.h"
2023-03-24 19:49:08 +01:00
#include "mission/com/CcsdsIpCoreHandler.h"
#include "mission/com/syrlinksDefs.h"
2023-03-26 16:42:00 +02:00
#include "mission/genericFactory.h"
2023-03-24 20:50:33 +01:00
#include "mission/system/acs/AcsBoardAssembly.h"
#include "mission/tmtc/TmFunnelHandler.h"
2020-09-30 17:17:01 +02:00
2023-04-13 23:54:23 +02:00
using gpio::Direction;
using gpio::Levels;
2022-05-25 10:59:20 +02:00
ResetArgs RESET_ARGS_GNSS;
2023-03-09 17:44:05 +01:00
std::atomic_bool LINK_STATE = CcsdsIpCoreHandler::LINK_DOWN;
std::atomic_bool PTME_LOCKED = false;
2023-09-11 19:23:48 +02:00
std::atomic_uint16_t signals::I2C_FATAL_ERRORS = 0;
2023-07-03 16:55:45 +02:00
uint8_t core::FW_VERSION_MAJOR = 0;
uint8_t core::FW_VERSION_MINOR = 0;
uint8_t core::FW_VERSION_REVISION = 0;
bool core::FW_VERSION_HAS_SHA = false;
char core::FW_VERSION_GIT_SHA[4] = {};
2021-07-19 12:44:43 +02:00
2020-11-20 18:27:07 +01:00
void Factory::setStaticFrameworkObjectIds() {
2022-08-15 18:34:26 +02:00
PusServiceBase::PUS_DISTRIBUTOR = objects::PUS_PACKET_DISTRIBUTOR;
2022-10-21 14:49:54 +02:00
PusServiceBase::PACKET_DESTINATION = objects::PUS_TM_FUNNEL;
2020-09-30 17:17:01 +02:00
2022-01-17 13:48:55 +01:00
CommandingServiceBase::defaultPacketSource = objects::PUS_PACKET_DISTRIBUTOR;
2022-10-21 14:49:54 +02:00
CommandingServiceBase::defaultPacketDestination = objects::PUS_TM_FUNNEL;
2020-09-30 17:17:01 +02:00
2022-05-27 16:24:41 +02:00
#if OBSW_Q7S_EM == 1
2022-05-27 13:44:40 +02:00
DeviceHandlerBase::powerSwitcherId = objects::NO_OBJECT;
#else
DeviceHandlerBase::powerSwitcherId = objects::PCDU_HANDLER;
2022-05-27 16:24:41 +02:00
#endif /* OBSW_Q7S_EM == 1 */
2022-05-27 13:44:40 +02:00
2022-01-17 13:48:55 +01:00
LocalDataPoolManager::defaultHkDestination = objects::PUS_SERVICE_3_HOUSEKEEPING;
2020-12-29 02:16:39 +01:00
2022-08-15 18:34:26 +02:00
VerificationReporter::DEFAULT_RECEIVER = objects::PUS_SERVICE_1_VERIFICATION;
2020-09-30 17:17:01 +02:00
}
2022-05-25 10:25:40 +02:00
void ObjectFactory::setStatics() { Factory::setStaticFrameworkObjectIds(); }
2021-07-19 12:44:43 +02:00
2023-07-10 11:03:17 +02:00
void ObjectFactory::createTmpComponents(
std::vector<std::pair<object_id_t, address_t>> tmpDevsToAdd) {
const char* tmpI2cDev = q7s::I2C_PS_EIVE;
if (core::FW_VERSION_MAJOR == 4) {
tmpI2cDev = q7s::I2C_PL_EIVE;
} else if (core::FW_VERSION_MAJOR >= 5) {
tmpI2cDev = q7s::I2C_Q7_EIVE;
}
2022-11-11 16:24:44 +01:00
std::vector<I2cCookie*> tmpDevCookies;
2023-06-17 15:28:05 +02:00
for (size_t idx = 0; idx < tmpDevsToAdd.size(); idx++) {
2022-11-11 16:24:44 +01:00
tmpDevCookies.push_back(
2023-07-10 11:14:19 +02:00
new I2cCookie(tmpDevsToAdd[idx].second, TMP1075::MAX_REPLY_LENGTH, tmpI2cDev));
2022-11-11 16:24:44 +01:00
auto* tmpDevHandler =
2023-06-17 15:28:05 +02:00
new Tmp1075Handler(tmpDevsToAdd[idx].first, objects::I2C_COM_IF, tmpDevCookies[idx]);
tmpDevHandler->setCustomFdir(new TmpDevFdir(tmpDevsToAdd[idx].first));
2023-01-23 11:31:15 +01:00
tmpDevHandler->connectModeTreeParent(satsystem::tcs::SUBSYSTEM);
2022-11-11 16:24:44 +01:00
}
2021-07-19 12:44:43 +02:00
}
2020-12-29 13:59:31 +01:00
2022-11-10 18:07:59 +01:00
void ObjectFactory::createCommunicationInterfaces(LinuxLibgpioIF** gpioComIF,
SerialComIF** uartComIF, SpiComIF** spiMainComIF,
2023-02-16 16:08:17 +01:00
I2cComIF** i2cComIF) {
if (gpioComIF == nullptr or uartComIF == nullptr or spiMainComIF == nullptr) {
2022-01-17 13:48:55 +01:00
sif::error << "ObjectFactory::createCommunicationInterfaces: Invalid passed ComIF pointer"
<< std::endl;
}
*gpioComIF = new LinuxLibgpioIF(objects::GPIO_IF);
/* Communication interfaces */
2023-03-24 11:33:43 +01:00
new CspComIF(objects::CSP_COM_IF, "CSP_ROUTER", 60);
2022-02-02 17:36:40 +01:00
*i2cComIF = new I2cComIF(objects::I2C_COM_IF);
2022-11-10 17:42:19 +01:00
*uartComIF = new SerialComIF(objects::UART_COM_IF);
2022-10-26 17:11:57 +02:00
*spiMainComIF = new SpiComIF(objects::SPI_MAIN_COM_IF, q7s::SPI_DEFAULT_DEV, **gpioComIF);
2021-07-19 12:44:43 +02:00
}
2020-12-29 13:59:31 +01:00
2023-03-26 15:28:00 +02:00
void ObjectFactory::createPcduComponents(LinuxLibgpioIF* gpioComIF, PowerSwitchIF** pwrSwitcher,
bool enableHkSets) {
2022-08-26 14:28:06 +02:00
CspCookie* p60DockCspCookie = new CspCookie(P60Dock::MAX_REPLY_SIZE, addresses::P60DOCK, 500);
CspCookie* pdu1CspCookie = new CspCookie(PDU::MAX_REPLY_SIZE, addresses::PDU1, 500);
CspCookie* pdu2CspCookie = new CspCookie(PDU::MAX_REPLY_SIZE, addresses::PDU2, 500);
2022-04-28 15:58:31 +02:00
auto p60Fdir = new GomspacePowerFdir(objects::P60DOCK_HANDLER);
2023-03-26 15:28:00 +02:00
P60DockHandler* p60dockhandler = new P60DockHandler(objects::P60DOCK_HANDLER, objects::CSP_COM_IF,
p60DockCspCookie, p60Fdir, enableHkSets);
2022-04-28 15:58:31 +02:00
auto pdu1Fdir = new GomspacePowerFdir(objects::PDU1_HANDLER);
2023-03-26 15:28:00 +02:00
Pdu1Handler* pdu1handler = new Pdu1Handler(objects::PDU1_HANDLER, objects::CSP_COM_IF,
pdu1CspCookie, pdu1Fdir, enableHkSets);
2022-04-28 15:58:31 +02:00
auto pdu2Fdir = new GomspacePowerFdir(objects::PDU2_HANDLER);
2023-03-26 15:28:00 +02:00
Pdu2Handler* pdu2handler = new Pdu2Handler(objects::PDU2_HANDLER, objects::CSP_COM_IF,
pdu2CspCookie, pdu2Fdir, enableHkSets);
2022-04-28 15:58:31 +02:00
#if OBSW_ADD_GOMSPACE_ACU == 1
CspCookie* acuCspCookie = new CspCookie(ACU::MAX_REPLY_SIZE, addresses::ACU, 500);
2022-04-28 15:58:31 +02:00
auto acuFdir = new GomspacePowerFdir(objects::ACU_HANDLER);
2023-03-26 15:28:00 +02:00
ACUHandler* acuhandler = new ACUHandler(objects::ACU_HANDLER, objects::CSP_COM_IF, acuCspCookie,
acuFdir, enableHkSets);
#endif
2023-03-14 13:56:19 +01:00
auto pcduHandler = new PcduHandler(objects::PCDU_HANDLER, 50);
2022-01-17 13:48:55 +01:00
/**
* Setting PCDU devices to mode normal immediately after start up because PCDU is always
* running.
*/
p60dockhandler->setModeNormal();
pdu1handler->setModeNormal();
pdu2handler->setModeNormal();
#if OBSW_ADD_GOMSPACE_ACU == 1
2022-01-17 13:48:55 +01:00
acuhandler->setModeNormal();
#endif
2022-03-04 16:03:57 +01:00
if (pwrSwitcher != nullptr) {
*pwrSwitcher = pcduHandler;
}
2022-04-26 10:37:25 +02:00
#if OBSW_DEBUG_P60DOCK == 1
p60dockhandler->setDebugMode(true);
#endif
#if OBSW_DEBUG_ACU == 1
acuhandler->setDebugMode(true);
#endif
2021-07-19 12:44:43 +02:00
}
2021-04-01 14:06:56 +02:00
2022-12-21 14:11:31 +01:00
ReturnValue_t ObjectFactory::createRadSensorComponent(LinuxLibgpioIF* gpioComIF,
Stack5VHandler& stackHandler) {
2023-05-11 15:05:44 +02:00
createRadSensorChipSelect(gpioComIF);
2022-01-17 13:48:55 +01:00
SpiCookie* spiCookieRadSensor =
2023-07-18 09:44:44 +02:00
new SpiCookie(addresses::RAD_SENSOR, gpioIds::CS_RAD_SENSOR, radSens::READ_SIZE,
spi::DEFAULT_MAX_1227_MODE, spi::DEFAULT_MAX_1227_SPEED);
2022-05-14 11:34:25 +02:00
spiCookieRadSensor->setMutexParams(MutexIF::TimeoutType::WAITING, spi::RAD_SENSOR_CS_TIMEOUT);
auto radSensor = new RadiationSensorHandler(objects::RAD_SENSOR, objects::SPI_MAIN_COM_IF,
2022-12-21 14:11:31 +01:00
spiCookieRadSensor, gpioComIF, stackHandler);
2022-02-24 11:47:32 +01:00
static_cast<void>(radSensor);
2022-03-17 10:48:35 +01:00
#if OBSW_DEBUG_RAD_SENSOR == 1
radSensor->enablePeriodicDataPrint(true);
2022-02-24 11:47:32 +01:00
#endif
2022-10-26 17:11:57 +02:00
return returnvalue::OK;
2021-07-19 12:44:43 +02:00
}
2021-07-01 17:27:51 +02:00
void ObjectFactory::createAcsBoardGpios(GpioCookie& cookie) {
2022-01-17 13:48:55 +01:00
std::stringstream consumer;
GpiodRegularByLineName* gpio = nullptr;
consumer << "0x" << std::hex << objects::GYRO_0_ADIS_HANDLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_0_ADIS_CS, consumer.str(), Direction::OUT,
Levels::HIGH);
cookie.addGpio(gpioIds::GYRO_0_ADIS_CS, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::GYRO_1_L3G_HANDLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_1_L3G_CS, consumer.str(), Direction::OUT,
Levels::HIGH);
cookie.addGpio(gpioIds::GYRO_1_L3G_CS, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::GYRO_2_ADIS_HANDLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_2_ADIS_CS, consumer.str(), Direction::OUT,
Levels::HIGH);
cookie.addGpio(gpioIds::GYRO_2_ADIS_CS, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::GYRO_3_L3G_HANDLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_3_L3G_CS, consumer.str(), Direction::OUT,
Levels::HIGH);
cookie.addGpio(gpioIds::GYRO_3_L3G_CS, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::MGM_0_LIS3_HANDLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::MGM_0_CS, consumer.str(), Direction::OUT,
Levels::HIGH);
cookie.addGpio(gpioIds::MGM_0_LIS3_CS, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::MGM_1_RM3100_HANDLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::MGM_1_CS, consumer.str(), Direction::OUT,
Levels::HIGH);
cookie.addGpio(gpioIds::MGM_1_RM3100_CS, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::MGM_2_LIS3_HANDLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::MGM_2_CS, consumer.str(), Direction::OUT,
Levels::HIGH);
cookie.addGpio(gpioIds::MGM_2_LIS3_CS, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::MGM_3_RM3100_HANDLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::MGM_3_CS, consumer.str(), Direction::OUT,
Levels::HIGH);
cookie.addGpio(gpioIds::MGM_3_RM3100_CS, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::GPS_CONTROLLER;
// GNSS reset pins are active low
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::RESET_GNSS_0, consumer.str(), Direction::OUT,
Levels::HIGH);
cookie.addGpio(gpioIds::GNSS_0_NRESET, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::GPS_CONTROLLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::RESET_GNSS_1, consumer.str(), Direction::OUT,
Levels::HIGH);
cookie.addGpio(gpioIds::GNSS_1_NRESET, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::GYRO_0_ADIS_HANDLER;
// Enable pins must be pulled low for regular operations
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_0_ENABLE, consumer.str(), Direction::OUT,
Levels::LOW);
cookie.addGpio(gpioIds::GYRO_0_ENABLE, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::GYRO_2_ADIS_HANDLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_2_ENABLE, consumer.str(), Direction::OUT,
Levels::LOW);
cookie.addGpio(gpioIds::GYRO_2_ENABLE, gpio);
2022-01-17 13:48:55 +01:00
// Enable pins for GNSS
consumer.str("");
consumer << "0x" << std::hex << objects::GPS_CONTROLLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::GNSS_0_ENABLE, consumer.str(), Direction::OUT,
Levels::LOW);
cookie.addGpio(gpioIds::GNSS_0_ENABLE, gpio);
2022-01-17 13:48:55 +01:00
consumer.str("");
consumer << "0x" << std::hex << objects::GPS_CONTROLLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::GNSS_1_ENABLE, consumer.str(), Direction::OUT,
Levels::LOW);
cookie.addGpio(gpioIds::GNSS_1_ENABLE, gpio);
2022-01-17 13:48:55 +01:00
2022-02-01 11:17:00 +01:00
// Select pin. 0 for GPS side A, 1 for GPS side B
consumer.str("");
consumer << "0x" << std::hex << objects::GPS_CONTROLLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::GNSS_SELECT, consumer.str(), Direction::OUT,
Levels::LOW);
cookie.addGpio(gpioIds::GNSS_SELECT, gpio);
}
void ObjectFactory::createAcsBoardComponents(SpiComIF& spiComIF, LinuxLibgpioIF* gpioComIF,
2023-04-04 20:59:25 +02:00
SerialComIF* uartComIF, PowerSwitchIF& pwrSwitcher,
2023-05-11 15:05:44 +02:00
bool enableHkSets, adis1650x::Type adisType) {
using namespace gpio;
GpioCookie* gpioCookieAcsBoard = new GpioCookie();
createAcsBoardGpios(*gpioCookieAcsBoard);
2022-04-28 18:38:38 +02:00
gpioChecker(gpioComIF->addGpios(gpioCookieAcsBoard), "ACS Board");
AcsBoardFdir* fdir = nullptr;
2022-03-17 19:59:47 +01:00
static_cast<void>(fdir);
2022-01-17 13:48:55 +01:00
2022-09-15 13:03:22 +02:00
#if OBSW_ADD_ACS_BOARD == 1
2023-02-26 14:55:33 +01:00
new AcsBoardPolling(objects::ACS_BOARD_POLLING_TASK, spiComIF, *gpioComIF);
2022-01-17 13:48:55 +01:00
std::string spiDev = q7s::SPI_DEFAULT_DEV;
2023-02-13 17:04:04 +01:00
std::array<DeviceHandlerBase*, 8> assemblyChildren;
2022-01-17 13:48:55 +01:00
SpiCookie* spiCookie =
2023-02-26 21:26:49 +01:00
new SpiCookie(addresses::MGM_0_LIS3, gpioIds::MGM_0_LIS3_CS, mgmLis3::MAX_BUFFER_SIZE,
spi::DEFAULT_LIS3_MODE, spi::DEFAULT_LIS3_SPEED);
2023-02-12 21:27:10 +01:00
spiCookie->setMutexParams(MutexIF::TimeoutType::WAITING, spi::ACS_BOARD_CS_TIMEOUT);
2023-02-28 01:25:25 +01:00
auto mgmLis3Handler0 =
new MgmLis3CustomHandler(objects::MGM_0_LIS3_HANDLER, objects::ACS_BOARD_POLLING_TASK,
spiCookie, spi::LIS3_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::MGM_0_LIS3_HANDLER);
2022-09-30 13:30:22 +02:00
mgmLis3Handler0->setCustomFdir(fdir);
2023-02-13 13:53:13 +01:00
assemblyChildren[0] = mgmLis3Handler0;
2022-02-23 19:26:02 +01:00
#if OBSW_TEST_ACS == 1
2022-01-17 13:48:55 +01:00
mgmLis3Handler->setStartUpImmediately();
mgmLis3Handler->setToGoToNormalMode(true);
2022-03-17 10:04:51 +01:00
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_ACS == 1
mgmLis3Handler->enablePeriodicPrintouts(true, 10);
2021-09-16 18:51:06 +02:00
#endif
2022-01-17 13:48:55 +01:00
spiCookie =
2023-02-26 21:26:49 +01:00
new SpiCookie(addresses::MGM_1_RM3100, gpioIds::MGM_1_RM3100_CS, mgmRm3100::MAX_BUFFER_SIZE,
spi::DEFAULT_RM3100_MODE, spi::DEFAULT_RM3100_SPEED);
2023-02-12 21:27:10 +01:00
spiCookie->setMutexParams(MutexIF::TimeoutType::WAITING, spi::ACS_BOARD_CS_TIMEOUT);
2022-09-30 13:30:22 +02:00
auto mgmRm3100Handler1 =
2023-02-28 01:25:25 +01:00
new MgmRm3100CustomHandler(objects::MGM_1_RM3100_HANDLER, objects::ACS_BOARD_POLLING_TASK,
spiCookie, spi::RM3100_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::MGM_1_RM3100_HANDLER);
2022-09-30 13:30:22 +02:00
mgmRm3100Handler1->setCustomFdir(fdir);
2023-02-13 13:53:13 +01:00
assemblyChildren[1] = mgmRm3100Handler1;
2022-02-23 19:26:02 +01:00
#if OBSW_TEST_ACS == 1
2022-01-17 13:48:55 +01:00
mgmRm3100Handler->setStartUpImmediately();
mgmRm3100Handler->setToGoToNormalMode(true);
2022-03-17 10:04:51 +01:00
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_ACS == 1
mgmRm3100Handler->enablePeriodicPrintouts(true, 10);
2021-09-16 17:33:47 +02:00
#endif
2023-02-26 21:26:49 +01:00
spiCookie = new SpiCookie(addresses::MGM_2_LIS3, gpioIds::MGM_2_LIS3_CS, mgmLis3::MAX_BUFFER_SIZE,
spi::DEFAULT_LIS3_MODE, spi::DEFAULT_LIS3_SPEED);
2023-02-12 21:27:10 +01:00
spiCookie->setMutexParams(MutexIF::TimeoutType::WAITING, spi::ACS_BOARD_CS_TIMEOUT);
2023-02-28 01:25:25 +01:00
auto* mgmLis3Handler2 =
new MgmLis3CustomHandler(objects::MGM_2_LIS3_HANDLER, objects::ACS_BOARD_POLLING_TASK,
spiCookie, spi::LIS3_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::MGM_2_LIS3_HANDLER);
2022-09-30 13:30:22 +02:00
mgmLis3Handler2->setCustomFdir(fdir);
2023-02-13 13:53:13 +01:00
assemblyChildren[2] = mgmLis3Handler2;
2022-02-23 19:26:02 +01:00
#if OBSW_TEST_ACS == 1
2022-03-17 10:04:51 +01:00
mgmLis3Handler->setStartUpImmediately();
mgmLis3Handler->setToGoToNormalMode(true);
2022-02-23 19:26:02 +01:00
#endif
2022-03-17 10:04:51 +01:00
#if OBSW_DEBUG_ACS == 1
mgmLis3Handler->enablePeriodicPrintouts(true, 10);
2021-09-16 17:33:47 +02:00
#endif
2022-01-17 13:48:55 +01:00
spiCookie =
2023-02-26 21:26:49 +01:00
new SpiCookie(addresses::MGM_3_RM3100, gpioIds::MGM_3_RM3100_CS, mgmRm3100::MAX_BUFFER_SIZE,
spi::DEFAULT_RM3100_MODE, spi::DEFAULT_RM3100_SPEED);
2023-02-12 21:27:10 +01:00
spiCookie->setMutexParams(MutexIF::TimeoutType::WAITING, spi::ACS_BOARD_CS_TIMEOUT);
2022-09-30 14:30:30 +02:00
auto* mgmRm3100Handler3 =
2023-02-28 01:25:25 +01:00
new MgmRm3100CustomHandler(objects::MGM_3_RM3100_HANDLER, objects::ACS_BOARD_POLLING_TASK,
spiCookie, spi::RM3100_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::MGM_3_RM3100_HANDLER);
2022-09-30 13:30:22 +02:00
mgmRm3100Handler3->setCustomFdir(fdir);
2023-02-13 13:53:13 +01:00
assemblyChildren[3] = mgmRm3100Handler3;
2022-02-23 19:26:02 +01:00
#if OBSW_TEST_ACS == 1
2022-01-17 13:48:55 +01:00
mgmRm3100Handler->setStartUpImmediately();
mgmRm3100Handler->setToGoToNormalMode(true);
2022-03-17 10:04:51 +01:00
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_ACS == 1
mgmRm3100Handler->enablePeriodicPrintouts(true, 10);
2021-09-16 18:51:06 +02:00
#endif
2022-01-17 13:48:55 +01:00
// Commented until ACS board V2 in in clean room again
// Gyro 0 Side A
spiCookie =
2023-02-26 14:55:33 +01:00
new SpiCookie(addresses::GYRO_0_ADIS, gpioIds::GYRO_0_ADIS_CS, adis1650x::MAXIMUM_REPLY_SIZE,
spi::DEFAULT_ADIS16507_MODE, spi::DEFAULT_ADIS16507_SPEED);
2023-02-12 21:27:10 +01:00
spiCookie->setMutexParams(MutexIF::TimeoutType::WAITING, spi::ACS_BOARD_CS_TIMEOUT);
2023-05-11 15:05:44 +02:00
auto adisHandler = new GyrAdis1650XHandler(objects::GYRO_0_ADIS_HANDLER,
objects::ACS_BOARD_POLLING_TASK, spiCookie, adisType);
fdir = new AcsBoardFdir(objects::GYRO_0_ADIS_HANDLER);
adisHandler->setCustomFdir(fdir);
2023-02-13 13:53:13 +01:00
assemblyChildren[4] = adisHandler;
2022-02-23 19:26:02 +01:00
#if OBSW_TEST_ACS == 1
2022-01-17 13:48:55 +01:00
adisHandler->setStartUpImmediately();
2022-01-19 14:08:30 +01:00
adisHandler->setToGoToNormalModeImmediately();
2022-03-17 10:04:51 +01:00
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_ACS == 1
adisHandler->enablePeriodicPrintouts(true, 10);
2021-09-16 17:33:47 +02:00
#endif
2022-01-17 13:48:55 +01:00
// Gyro 1 Side A
2023-02-26 14:55:33 +01:00
spiCookie = new SpiCookie(addresses::GYRO_1_L3G, gpioIds::GYRO_1_L3G_CS, l3gd20h::MAX_BUFFER_SIZE,
spi::DEFAULT_L3G_MODE, spi::DEFAULT_L3G_SPEED);
2023-02-12 21:27:10 +01:00
spiCookie->setMutexParams(MutexIF::TimeoutType::WAITING, spi::ACS_BOARD_CS_TIMEOUT);
2023-02-26 14:55:33 +01:00
auto gyroL3gHandler1 =
new GyrL3gCustomHandler(objects::GYRO_1_L3G_HANDLER, objects::ACS_BOARD_POLLING_TASK,
spiCookie, spi::L3G_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::GYRO_1_L3G_HANDLER);
2022-09-30 13:30:22 +02:00
gyroL3gHandler1->setCustomFdir(fdir);
2023-02-13 13:53:13 +01:00
assemblyChildren[5] = gyroL3gHandler1;
2022-02-23 19:26:02 +01:00
#if OBSW_TEST_ACS == 1
2022-01-17 13:48:55 +01:00
gyroL3gHandler->setStartUpImmediately();
gyroL3gHandler->setToGoToNormalMode(true);
2022-03-17 10:04:51 +01:00
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_ACS == 1
gyroL3gHandler->enablePeriodicPrintouts(true, 10);
#endif
2022-01-17 13:48:55 +01:00
// Gyro 2 Side B
spiCookie =
2023-02-26 14:55:33 +01:00
new SpiCookie(addresses::GYRO_2_ADIS, gpioIds::GYRO_2_ADIS_CS, adis1650x::MAXIMUM_REPLY_SIZE,
spi::DEFAULT_ADIS16507_MODE, spi::DEFAULT_ADIS16507_SPEED);
2023-02-12 21:27:10 +01:00
spiCookie->setMutexParams(MutexIF::TimeoutType::WAITING, spi::ACS_BOARD_CS_TIMEOUT);
2023-05-11 15:05:44 +02:00
adisHandler = new GyrAdis1650XHandler(objects::GYRO_2_ADIS_HANDLER,
objects::ACS_BOARD_POLLING_TASK, spiCookie, adisType);
fdir = new AcsBoardFdir(objects::GYRO_2_ADIS_HANDLER);
adisHandler->setCustomFdir(fdir);
2023-02-13 13:53:13 +01:00
assemblyChildren[6] = adisHandler;
2022-02-23 19:26:02 +01:00
#if OBSW_TEST_ACS == 1
2022-01-17 13:48:55 +01:00
adisHandler->setStartUpImmediately();
2022-01-19 14:08:30 +01:00
adisHandler->setToGoToNormalModeImmediately();
#endif
2022-01-17 13:48:55 +01:00
// Gyro 3 Side B
2023-02-26 14:55:33 +01:00
spiCookie = new SpiCookie(addresses::GYRO_3_L3G, gpioIds::GYRO_3_L3G_CS, l3gd20h::MAX_BUFFER_SIZE,
spi::DEFAULT_L3G_MODE, spi::DEFAULT_L3G_SPEED);
2023-02-12 21:27:10 +01:00
spiCookie->setMutexParams(MutexIF::TimeoutType::WAITING, spi::ACS_BOARD_CS_TIMEOUT);
2023-02-26 14:55:33 +01:00
auto gyroL3gHandler3 =
new GyrL3gCustomHandler(objects::GYRO_3_L3G_HANDLER, objects::ACS_BOARD_POLLING_TASK,
spiCookie, spi::L3G_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::GYRO_3_L3G_HANDLER);
2022-09-30 13:30:22 +02:00
gyroL3gHandler3->setCustomFdir(fdir);
2023-02-13 13:53:13 +01:00
assemblyChildren[7] = gyroL3gHandler3;
2022-02-23 19:26:02 +01:00
#if OBSW_TEST_ACS == 1
2022-01-17 13:48:55 +01:00
gyroL3gHandler->setStartUpImmediately();
gyroL3gHandler->setToGoToNormalMode(true);
2022-03-04 18:12:16 +01:00
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_ACS == 1
gyroL3gHandler->enablePeriodicPrintouts(true, 10);
2021-09-16 17:33:47 +02:00
#endif
2022-01-17 13:48:55 +01:00
bool debugGps = false;
2021-09-16 17:24:34 +02:00
#if OBSW_DEBUG_GPS == 1
2022-01-17 13:48:55 +01:00
debugGps = true;
2021-09-16 17:24:34 +02:00
#endif
2022-05-25 10:59:20 +02:00
RESET_ARGS_GNSS.gpioComIF = gpioComIF;
2023-06-22 16:54:49 +02:00
RESET_ARGS_GNSS.waitPeriodMs = 5;
2023-04-04 20:59:25 +02:00
auto gpsCtrl = new GpsHyperionLinuxController(objects::GPS_CONTROLLER, objects::NO_OBJECT,
enableHkSets, debugGps);
2022-05-25 10:59:20 +02:00
gpsCtrl->setResetPinTriggerFunction(gps::triggerGpioResetPin, &RESET_ARGS_GNSS);
2022-03-04 16:03:57 +01:00
2023-04-03 18:54:47 +02:00
ObjectFactory::createAcsBoardAssy(pwrSwitcher, assemblyChildren, gpsCtrl, gpioComIF);
2022-01-19 18:05:17 +01:00
#endif /* OBSW_ADD_ACS_HANDLERS == 1 */
2021-07-19 12:44:43 +02:00
}
void ObjectFactory::createHeaterComponents(GpioIF* gpioIF, PowerSwitchIF* pwrSwitcher,
2022-11-25 11:01:06 +01:00
HealthTableIF* healthTable,
HeaterHandler*& heaterHandler) {
2022-02-28 15:47:34 +01:00
using namespace gpio;
2022-01-17 13:48:55 +01:00
GpioCookie* heaterGpiosCookie = new GpioCookie;
GpiodRegularByLineName* gpio = nullptr;
std::stringstream consumer;
consumer << "0x" << std::hex << objects::HEATER_HANDLER;
/* Pin H2-11 on stack connector */
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::HEATER_0, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_0, gpio);
/* Pin H2-12 on stack connector */
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::HEATER_1, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_1, gpio);
/* Pin H2-13 on stack connector */
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::HEATER_2, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_2, gpio);
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::HEATER_3, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_3, gpio);
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::HEATER_4, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_4, gpio);
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::HEATER_5, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_5, gpio);
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::HEATER_6, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_6, gpio);
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::HEATER_7, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
heaterGpiosCookie->addGpio(gpioIds::HEATER_7, gpio);
gpioIF->addGpios(heaterGpiosCookie);
2022-11-25 11:01:06 +01:00
ObjectFactory::createGenericHeaterComponents(*gpioIF, *pwrSwitcher, heaterHandler);
2021-07-19 12:44:43 +02:00
}
2021-02-16 15:32:24 +01:00
2022-10-12 13:56:25 +02:00
void ObjectFactory::createSolarArrayDeploymentComponents(PowerSwitchIF& pwrSwitcher,
GpioIF& gpioIF) {
2022-02-28 15:47:34 +01:00
using namespace gpio;
2022-01-17 13:48:55 +01:00
GpioCookie* solarArrayDeplCookie = new GpioCookie;
GpiodRegularByLineName* gpio = nullptr;
std::stringstream consumer;
consumer << "0x" << std::hex << objects::SOLAR_ARRAY_DEPL_HANDLER;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::SA_DPL_PIN_0, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
solarArrayDeplCookie->addGpio(gpioIds::DEPLSA1, gpio);
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::SA_DPL_PIN_1, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
solarArrayDeplCookie->addGpio(gpioIds::DEPLSA2, gpio);
2022-10-12 13:56:25 +02:00
ReturnValue_t result = gpioIF.addGpios(solarArrayDeplCookie);
if (result != returnvalue::OK) {
sif::error << "Adding Solar Array Deployment GPIO cookie failed" << std::endl;
}
2022-01-17 13:48:55 +01:00
2022-10-12 13:56:25 +02:00
new SolarArrayDeploymentHandler(objects::SOLAR_ARRAY_DEPL_HANDLER, gpioIF, pwrSwitcher,
2023-03-16 18:47:51 +01:00
power::Switches::PDU2_CH5_DEPLOYMENT_MECHANISM_8V,
2022-10-12 14:09:07 +02:00
gpioIds::DEPLSA1, gpioIds::DEPLSA2, *SdCardManager::instance());
2021-07-19 12:44:43 +02:00
}
2021-02-22 09:24:42 +01:00
2022-04-14 11:17:07 +02:00
void ObjectFactory::createSyrlinksComponents(PowerSwitchIF* pwrSwitcher) {
2022-11-11 11:41:40 +01:00
auto* syrlinksUartCookie =
2023-03-22 02:20:14 +01:00
new SerialCookie(objects::SYRLINKS_HANDLER, q7s::UART_SYRLINKS_DEV, serial::SYRLINKS_BAUD,
2022-11-11 16:24:44 +01:00
syrlinks::MAX_REPLY_SIZE, UartModes::NON_CANONICAL);
2022-01-17 13:48:55 +01:00
syrlinksUartCookie->setParityEven();
2021-02-22 09:24:42 +01:00
2023-03-24 00:59:41 +01:00
new SyrlinksComHandler(objects::SYRLINKS_COM_HANDLER);
2023-03-01 18:06:36 +01:00
auto* syrlinksAssy = new SyrlinksAssembly(objects::SYRLINKS_ASSY);
syrlinksAssy->connectModeTreeParent(satsystem::com::SUBSYSTEM);
2023-01-27 14:44:40 +01:00
auto syrlinksFdir = new SyrlinksFdir(objects::SYRLINKS_HANDLER);
2022-04-28 15:29:57 +02:00
auto syrlinksHandler =
2023-03-24 00:59:41 +01:00
new SyrlinksHandler(objects::SYRLINKS_HANDLER, objects::SYRLINKS_COM_HANDLER,
2023-03-24 21:20:27 +01:00
syrlinksUartCookie, power::PDU1_CH1_SYRLINKS_12V, syrlinksFdir);
2022-04-14 11:17:07 +02:00
syrlinksHandler->setPowerSwitcher(pwrSwitcher);
2023-03-01 18:06:36 +01:00
syrlinksHandler->connectModeTreeParent(*syrlinksAssy);
2022-04-26 10:37:25 +02:00
#if OBSW_DEBUG_SYRLINKS == 1
syrlinksHandler->setDebugMode(true);
#endif
2021-07-19 12:44:43 +02:00
}
2021-02-22 09:24:42 +01:00
void ObjectFactory::createPayloadComponents(LinuxLibgpioIF* gpioComIF, PowerSwitchIF& pwrSwitch) {
2022-03-28 10:10:01 +02:00
using namespace gpio;
2022-03-28 09:08:11 +02:00
std::stringstream consumer;
2022-11-10 15:39:08 +01:00
auto* camSwitcher =
2023-03-16 18:47:51 +01:00
new CamSwitcher(objects::CAM_SWITCHER, pwrSwitch, power::PDU2_CH8_PAYLOAD_CAMERA);
2023-03-14 11:21:37 +01:00
camSwitcher->connectModeTreeParent(satsystem::payload::SUBSYSTEM);
2022-03-28 09:08:11 +02:00
#if OBSW_ADD_PLOC_MPSOC == 1
consumer << "0x" << std::hex << objects::PLOC_MPSOC_HANDLER;
2022-03-28 13:54:46 +02:00
auto gpioConfigMPSoC = new GpiodRegularByLineName(q7s::gpioNames::ENABLE_MPSOC_UART,
consumer.str(), Direction::OUT, Levels::HIGH);
2022-03-28 10:10:01 +02:00
auto mpsocGpioCookie = new GpioCookie;
mpsocGpioCookie->addGpio(gpioIds::ENABLE_MPSOC_UART, gpioConfigMPSoC);
2022-04-28 18:38:38 +02:00
gpioChecker(gpioComIF->addGpios(mpsocGpioCookie), "PLOC MPSoC");
2022-03-28 09:08:11 +02:00
auto mpsocCookie =
2023-03-22 02:20:14 +01:00
new SerialCookie(objects::PLOC_MPSOC_HANDLER, q7s::UART_PLOC_MPSOC_DEV,
serial::PLOC_MPSOC_BAUD, mpsoc::MAX_REPLY_SIZE, UartModes::NON_CANONICAL);
2022-03-28 09:08:11 +02:00
mpsocCookie->setNoFixedSizeReply();
2023-05-15 15:15:58 +02:00
auto plocMpsocHelper = new PlocMpsocSpecialComHelper(objects::PLOC_MPSOC_HELPER);
auto* mpsocHandler = new PlocMpsocHandler(
2022-11-10 15:39:08 +01:00
objects::PLOC_MPSOC_HANDLER, objects::UART_COM_IF, mpsocCookie, plocMpsocHelper,
Gpio(gpioIds::ENABLE_MPSOC_UART, gpioComIF), objects::PLOC_SUPERVISOR_HANDLER);
2023-03-14 11:21:37 +01:00
mpsocHandler->connectModeTreeParent(satsystem::payload::SUBSYSTEM);
2022-03-28 09:08:11 +02:00
#endif /* OBSW_ADD_PLOC_MPSOC == 1 */
#if OBSW_ADD_PLOC_SUPERVISOR == 1
consumer << "0x" << std::hex << objects::PLOC_SUPERVISOR_HANDLER;
2022-03-28 10:10:01 +02:00
auto gpioConfigSupv = new GpiodRegularByLineName(q7s::gpioNames::ENABLE_SUPV_UART, consumer.str(),
Direction::OUT, Levels::LOW);
2022-03-28 10:10:01 +02:00
auto supvGpioCookie = new GpioCookie;
supvGpioCookie->addGpio(gpioIds::ENABLE_SUPV_UART, gpioConfigSupv);
gpioComIF->addGpios(supvGpioCookie);
2023-03-22 02:20:14 +01:00
auto supervisorCookie = new SerialCookie(objects::PLOC_SUPERVISOR_HANDLER,
q7s::UART_PLOC_SUPERVSIOR_DEV, serial::PLOC_SUPV_BAUD,
supv::MAX_PACKET_SIZE * 20, UartModes::NON_CANONICAL);
2022-03-28 09:08:11 +02:00
supervisorCookie->setNoFixedSizeReply();
2022-11-16 15:03:10 +01:00
auto supvHelper = new PlocSupvUartManager(objects::PLOC_SUPERVISOR_HELPER);
auto* supvHandler = new PlocSupervisorHandler(objects::PLOC_SUPERVISOR_HANDLER, supervisorCookie,
Gpio(gpioIds::ENABLE_SUPV_UART, gpioComIF),
2023-03-18 11:17:24 +01:00
power::PDU1_CH6_PLOC_12V, *supvHelper);
2023-05-12 09:32:24 +02:00
supvHandler->setPowerSwitcher(&pwrSwitch);
2023-03-14 11:21:37 +01:00
supvHandler->connectModeTreeParent(satsystem::payload::SUBSYSTEM);
2022-03-28 09:08:11 +02:00
#endif /* OBSW_ADD_PLOC_SUPERVISOR == 1 */
static_cast<void>(consumer);
}
2022-05-11 00:54:29 +02:00
void ObjectFactory::createReactionWheelComponents(LinuxLibgpioIF* gpioComIF,
PowerSwitchIF* pwrSwitcher) {
2022-02-28 15:47:34 +01:00
using namespace gpio;
2022-01-17 13:48:55 +01:00
GpioCookie* gpioCookieRw = new GpioCookie;
2022-02-28 15:47:34 +01:00
GpioCallback* csRw1 =
new GpioCallback("Chip select reaction wheel 1", Direction::OUT, Levels::HIGH,
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
2022-01-17 13:48:55 +01:00
gpioCookieRw->addGpio(gpioIds::CS_RW1, csRw1);
2022-02-28 15:47:34 +01:00
GpioCallback* csRw2 =
new GpioCallback("Chip select reaction wheel 2", Direction::OUT, Levels::HIGH,
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
2022-01-17 13:48:55 +01:00
gpioCookieRw->addGpio(gpioIds::CS_RW2, csRw2);
2022-02-28 15:47:34 +01:00
GpioCallback* csRw3 =
new GpioCallback("Chip select reaction wheel 3", Direction::OUT, Levels::HIGH,
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
2022-01-17 13:48:55 +01:00
gpioCookieRw->addGpio(gpioIds::CS_RW3, csRw3);
2022-02-28 15:47:34 +01:00
GpioCallback* csRw4 =
new GpioCallback("Chip select reaction wheel 4", Direction::OUT, Levels::HIGH,
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
2022-01-17 13:48:55 +01:00
gpioCookieRw->addGpio(gpioIds::CS_RW4, csRw4);
std::stringstream consumer;
GpiodRegularByLineName* gpio = nullptr;
consumer << "0x" << std::hex << objects::RW1;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::EN_RW_1, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
gpioCookieRw->addGpio(gpioIds::EN_RW1, gpio);
consumer.str("");
consumer << "0x" << std::hex << objects::RW2;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::EN_RW_2, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
gpioCookieRw->addGpio(gpioIds::EN_RW2, gpio);
consumer.str("");
consumer << "0x" << std::hex << objects::RW3;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::EN_RW_3, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
gpioCookieRw->addGpio(gpioIds::EN_RW3, gpio);
consumer.str("");
consumer << "0x" << std::hex << objects::RW4;
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::EN_RW_4, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
gpioCookieRw->addGpio(gpioIds::EN_RW4, gpio);
2022-04-28 18:38:38 +02:00
gpioChecker(gpioComIF->addGpios(gpioCookieRw), "RWs");
2022-01-17 13:48:55 +01:00
2022-02-23 19:26:02 +01:00
#if OBSW_ADD_RW == 1
std::array<std::pair<address_t, gpioId_t>, 4> rwCookieParams = {
{{addresses::RW1, gpioIds::CS_RW1},
{addresses::RW2, gpioIds::CS_RW2},
{addresses::RW3, gpioIds::CS_RW3},
{addresses::RW4, gpioIds::CS_RW4}}};
std::array<SpiCookie*, 4> rwCookies = {};
2022-05-10 18:39:23 +02:00
std::array<object_id_t, 4> rwIds = {objects::RW1, objects::RW2, objects::RW3, objects::RW4};
std::array<gpioId_t, 4> rwGpioIds = {gpioIds::EN_RW1, gpioIds::EN_RW2, gpioIds::EN_RW3,
gpioIds::EN_RW4};
2023-02-13 11:49:26 +01:00
std::array<DeviceHandlerBase*, 4> rws = {};
2023-02-16 17:57:21 +01:00
new RwPollingTask(objects::RW_POLLING_TASK, q7s::SPI_RW_DEV, *gpioComIF);
for (uint8_t idx = 0; idx < rwCookies.size(); idx++) {
2023-02-16 16:54:58 +01:00
rwCookies[idx] = new RwCookie(idx, rwCookieParams[idx].first, rwCookieParams[idx].second,
rws::MAX_REPLY_SIZE, spi::RW_MODE, spi::RW_SPEED);
2023-02-16 17:57:21 +01:00
auto* rwHandler = new RwHandler(rwIds[idx], objects::RW_POLLING_TASK, rwCookies[idx], gpioComIF,
2023-02-14 18:41:43 +01:00
rwGpioIds[idx], idx);
#if OBSW_TEST_RW == 1
rws[idx]->setStartUpImmediately();
2021-09-23 15:35:33 +02:00
#endif
#if OBSW_DEBUG_RW == 1
2023-02-13 11:49:26 +01:00
rwHandler->setDebugMode(true);
2021-09-23 15:35:33 +02:00
#endif
2023-02-13 11:49:26 +01:00
rws[idx] = rwHandler;
}
2022-05-10 18:39:23 +02:00
2023-03-18 11:17:24 +01:00
createRwAssy(*pwrSwitcher, power::Switches::PDU2_CH2_RW_5V, rws, rwIds);
2022-02-23 19:26:02 +01:00
#endif /* OBSW_ADD_RW == 1 */
2021-07-19 12:44:43 +02:00
}
2021-05-02 13:48:39 +02:00
2023-03-09 19:42:20 +01:00
ReturnValue_t ObjectFactory::createCcsdsComponents(CcsdsComponentArgs& args) {
2022-02-28 15:47:34 +01:00
using namespace gpio;
2022-01-17 13:48:55 +01:00
// GPIO definitions of signals connected to the virtual channel interfaces of the PTME IP Core
GpioCookie* gpioCookiePtmeIp = new GpioCookie;
GpiodRegularByLineName* gpio = nullptr;
gpio = new GpiodRegularByLineName(q7s::gpioNames::PAPB_EMPTY_SIGNAL_VC0, "PAPB VC0");
2022-01-17 13:48:55 +01:00
gpioCookiePtmeIp->addGpio(gpioIds::VC0_PAPB_EMPTY, gpio);
gpio = new GpiodRegularByLineName(q7s::gpioNames::PAPB_EMPTY_SIGNAL_VC1, "PAPB VC1");
2022-01-17 13:48:55 +01:00
gpioCookiePtmeIp->addGpio(gpioIds::VC1_PAPB_EMPTY, gpio);
gpio = new GpiodRegularByLineName(q7s::gpioNames::PAPB_EMPTY_SIGNAL_VC2, "PAPB VC2");
2022-01-17 13:48:55 +01:00
gpioCookiePtmeIp->addGpio(gpioIds::VC2_PAPB_EMPTY, gpio);
gpio = new GpiodRegularByLineName(q7s::gpioNames::PAPB_EMPTY_SIGNAL_VC3, "PAPB VC3");
2022-01-17 13:48:55 +01:00
gpioCookiePtmeIp->addGpio(gpioIds::VC3_PAPB_EMPTY, gpio);
2023-03-18 14:34:09 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PTME_RESETN, "PTME RESETN",
2023-03-30 23:52:37 +02:00
gpio::Direction::OUT, gpio::Levels::HIGH);
2023-03-18 14:34:09 +01:00
gpioCookiePtmeIp->addGpio(gpioIds::PTME_RESETN, gpio);
2023-03-09 19:42:20 +01:00
gpioChecker(args.gpioComIF.addGpios(gpioCookiePtmeIp), "PTME PAPB VCs");
2023-03-22 19:54:04 +01:00
2022-01-17 13:48:55 +01:00
// Creating virtual channel interfaces
2023-06-26 17:08:39 +02:00
VirtualChannelIF* vc0 = new PapbVcInterface(&args.gpioComIF, gpioIds::VC0_PAPB_EMPTY,
q7s::UIO_PTME, q7s::uiomapids::PTME_VC0);
VirtualChannelIF* vc1 = new PapbVcInterface(&args.gpioComIF, gpioIds::VC1_PAPB_EMPTY,
q7s::UIO_PTME, q7s::uiomapids::PTME_VC1);
VirtualChannelIF* vc2 = new PapbVcInterface(&args.gpioComIF, gpioIds::VC2_PAPB_EMPTY,
q7s::UIO_PTME, q7s::uiomapids::PTME_VC2);
VirtualChannelIF* vc3 = new PapbVcInterface(&args.gpioComIF, gpioIds::VC3_PAPB_EMPTY,
q7s::UIO_PTME, q7s::uiomapids::PTME_VC3);
2022-01-17 13:48:55 +01:00
// Creating ptme object and adding virtual channel interfaces
Ptme* ptme = new Ptme(objects::PTME);
ptme->addVcInterface(ccsds::VC0, vc0);
ptme->addVcInterface(ccsds::VC1, vc1);
ptme->addVcInterface(ccsds::VC2, vc2);
ptme->addVcInterface(ccsds::VC3, vc3);
AxiPtmeConfig* axiPtmeConfig =
new AxiPtmeConfig(objects::AXI_PTME_CONFIG, q7s::UIO_PTME, q7s::uiomapids::PTME_CONFIG);
PtmeConfig* ptmeConfig = new PtmeConfig(objects::PTME_CONFIG, axiPtmeConfig);
2023-03-18 14:34:09 +01:00
PtmeGpios gpios;
gpios.enableTxClock = gpioIds::RS485_EN_TX_CLOCK;
2023-03-22 21:25:24 +01:00
gpios.enableTxData = gpioIds::RS485_EN_TX_DATA;
2023-03-18 14:34:09 +01:00
gpios.ptmeResetn = gpioIds::PTME_RESETN;
*args.ipCoreHandler =
new CcsdsIpCoreHandler(objects::CCSDS_HANDLER, objects::CCSDS_PACKET_DISTRIBUTOR, *ptmeConfig,
LINK_STATE, &args.gpioComIF, gpios, PTME_LOCKED);
2023-03-09 19:42:20 +01:00
// This VC will receive all live TM
2023-09-11 20:16:54 +02:00
auto* vcWithQueue = new VirtualChannel(objects::PTME_VC0_LIVE_TM, ccsds::VC0, "PTME VC0 LIVE TM",
*ptme, LINK_STATE);
auto* liveTask = new LiveTmTask(objects::LIVE_TM_TASK, args.pusFunnel, args.cfdpFunnel,
2023-09-11 20:16:54 +02:00
*vcWithQueue, PTME_LOCKED, config::LIVE_CHANNEL_NORMAL_QUEUE_SIZE,
config::LIVE_CHANNEL_CFDP_QUEUE_SIZE);
args.normalLiveTmDest = liveTask->getNormalLiveQueueId();
args.cfdpLiveTmDest = liveTask->getCfdpLiveQueueId();
2023-03-31 12:11:31 +02:00
liveTask->connectModeTreeParent(satsystem::com::SUBSYSTEM);
2023-03-09 19:42:20 +01:00
// Set up log store.
auto* vc = new VirtualChannel(objects::PTME_VC1_LOG_TM, ccsds::VC1, "PTME VC1 LOG TM", *ptme,
LINK_STATE);
LogStores logStores(args.stores);
// Core task which handles the LOG store and takes care of dumping it as TM using a VC directly
auto* logStore =
new PersistentLogTmStoreTask(objects::LOG_STORE_AND_TM_TASK, args.ipcStore, logStores, *vc,
*SdCardManager::instance(), PTME_LOCKED);
2023-03-31 12:11:31 +02:00
logStore->connectModeTreeParent(satsystem::com::SUBSYSTEM);
2023-03-09 17:44:05 +01:00
vc = new VirtualChannel(objects::PTME_VC2_HK_TM, ccsds::VC2, "PTME VC2 HK TM", *ptme, LINK_STATE);
2023-03-09 19:42:20 +01:00
// Core task which handles the HK store and takes care of dumping it as TM using a VC directly
2023-03-31 12:11:31 +02:00
auto* hkStore = new PersistentSingleTmStoreTask(
objects::HK_STORE_AND_TM_TASK, args.ipcStore, *args.stores.hkStore, *vc,
2023-05-23 19:12:35 +02:00
persTmStore::DUMP_HK_STORE_DONE, persTmStore::DUMP_HK_CANCELLED, *SdCardManager::instance(),
PTME_LOCKED);
2023-03-31 12:11:31 +02:00
hkStore->connectModeTreeParent(satsystem::com::SUBSYSTEM);
2023-03-09 19:42:20 +01:00
2023-03-09 17:44:05 +01:00
vc = new VirtualChannel(objects::PTME_VC3_CFDP_TM, ccsds::VC3, "PTME VC3 CFDP TM", *ptme,
LINK_STATE);
2023-03-09 19:42:20 +01:00
// Core task which handles the CFDP store and takes care of dumping it as TM using a VC directly
2023-03-31 12:11:31 +02:00
auto* cfdpTask = new PersistentSingleTmStoreTask(
objects::CFDP_STORE_AND_TM_TASK, args.ipcStore, *args.stores.cfdpStore, *vc,
persTmStore::DUMP_CFDP_STORE_DONE, persTmStore::DUMP_CFDP_CANCELLED,
*SdCardManager::instance(), PTME_LOCKED);
2023-03-31 12:11:31 +02:00
cfdpTask->connectModeTreeParent(satsystem::com::SUBSYSTEM);
2023-03-09 19:42:20 +01:00
ReturnValue_t result = (*args.ipCoreHandler)->connectModeTreeParent(satsystem::com::SUBSYSTEM);
2023-01-27 15:10:26 +01:00
if (result != returnvalue::OK) {
sif::error
<< "ObjectFactory::createCcsdsComponents: Connecting COM subsystem to CCSDS handler failed"
<< std::endl;
}
2022-01-17 13:48:55 +01:00
GpioCookie* gpioCookiePdec = new GpioCookie;
// GPIO also low after linux boot (specified by device-tree)
gpio = new GpiodRegularByLineName(q7s::gpioNames::PDEC_RESET, "PDEC Handler", Direction::OUT,
2022-02-28 15:47:34 +01:00
Levels::LOW);
2022-01-17 13:48:55 +01:00
gpioCookiePdec->addGpio(gpioIds::PDEC_RESET, gpio);
2023-03-09 19:42:20 +01:00
gpioChecker(args.gpioComIF.addGpios(gpioCookiePdec), "PDEC");
2022-10-27 10:49:52 +02:00
struct UioNames uioNames {};
uioNames.configMemory = q7s::UIO_PDEC_CONFIG_MEMORY;
uioNames.ramMemory = q7s::UIO_PDEC_RAM;
uioNames.registers = q7s::UIO_PDEC_REGISTERS;
uioNames.irq = q7s::UIO_PDEC_IRQ;
2023-03-09 19:42:20 +01:00
new PdecHandler(objects::PDEC_HANDLER, objects::CCSDS_HANDLER, &args.gpioComIF,
gpioIds::PDEC_RESET, uioNames);
2022-01-17 13:48:55 +01:00
GpioCookie* gpioRS485Chip = new GpioCookie;
gpio = new GpiodRegularByLineName(q7s::gpioNames::RS485_EN_TX_CLOCK, "RS485 Transceiver",
2022-02-28 15:47:34 +01:00
Direction::OUT, Levels::LOW);
2022-01-17 13:48:55 +01:00
gpioRS485Chip->addGpio(gpioIds::RS485_EN_TX_CLOCK, gpio);
gpio = new GpiodRegularByLineName(q7s::gpioNames::RS485_EN_TX_DATA, "RS485 Transceiver",
2022-02-28 15:47:34 +01:00
Direction::OUT, Levels::LOW);
2022-01-17 13:48:55 +01:00
gpioRS485Chip->addGpio(gpioIds::RS485_EN_TX_DATA, gpio);
// Default configuration enables RX channels (RXEN = LOW)
gpio = new GpiodRegularByLineName(q7s::gpioNames::RS485_EN_RX_CLOCK, "RS485 Transceiver",
2022-02-28 15:47:34 +01:00
Direction::OUT, Levels::LOW);
2022-01-17 13:48:55 +01:00
gpioRS485Chip->addGpio(gpioIds::RS485_EN_RX_CLOCK, gpio);
gpio = new GpiodRegularByLineName(q7s::gpioNames::RS485_EN_RX_DATA, "RS485 Transceiver",
2022-02-28 15:47:34 +01:00
Direction::OUT, Levels::LOW);
2022-01-17 13:48:55 +01:00
gpioRS485Chip->addGpio(gpioIds::RS485_EN_RX_DATA, gpio);
2023-03-09 19:42:20 +01:00
gpioChecker(args.gpioComIF.addGpios(gpioRS485Chip), "RS485 Transceiver");
2022-10-27 14:02:34 +02:00
return returnvalue::OK;
2021-09-26 08:29:30 +02:00
}
void ObjectFactory::createPlPcduComponents(LinuxLibgpioIF* gpioComIF, SpiComIF* spiComIF,
2022-12-22 11:10:55 +01:00
PowerSwitchIF* pwrSwitcher,
Stack5VHandler& stackHandler) {
2022-02-28 15:47:34 +01:00
using namespace gpio;
2022-02-23 19:26:02 +01:00
// Create all GPIO components first
GpioCookie* plPcduGpios = new GpioCookie;
GpiodRegularByLineName* gpio = nullptr;
std::string consumer;
// Switch pins are active high
consumer = "PLPCDU_ENB_VBAT_0";
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PL_PCDU_ENABLE_VBAT0, consumer, Direction::OUT,
2022-02-23 19:26:02 +01:00
gpio::Levels::LOW);
plPcduGpios->addGpio(gpioIds::PLPCDU_ENB_VBAT0, gpio);
consumer = "PLPCDU_ENB_VBAT_1";
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PL_PCDU_ENABLE_VBAT1, consumer, Direction::OUT,
2022-02-23 19:26:02 +01:00
gpio::Levels::LOW);
plPcduGpios->addGpio(gpioIds::PLPCDU_ENB_VBAT1, gpio);
consumer = "PLPCDU_ENB_DRO";
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PL_PCDU_ENABLE_DRO, consumer, Direction::OUT,
2022-02-23 19:26:02 +01:00
gpio::Levels::LOW);
plPcduGpios->addGpio(gpioIds::PLPCDU_ENB_DRO, gpio);
consumer = "PLPCDU_ENB_X8";
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PL_PCDU_ENABLE_X8, consumer, Direction::OUT,
2022-02-23 19:26:02 +01:00
gpio::Levels::LOW);
plPcduGpios->addGpio(gpioIds::PLPCDU_ENB_X8, gpio);
consumer = "PLPCDU_ENB_TX";
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PL_PCDU_ENABLE_TX, consumer, Direction::OUT,
2022-02-23 19:26:02 +01:00
gpio::Levels::LOW);
plPcduGpios->addGpio(gpioIds::PLPCDU_ENB_TX, gpio);
2022-03-04 15:26:36 +01:00
consumer = "PLPCDU_ENB_MPA";
gpio = new GpiodRegularByLineName(q7s::gpioNames::PL_PCDU_ENABLE_MPA, consumer, Direction::OUT,
gpio::Levels::LOW);
plPcduGpios->addGpio(gpioIds::PLPCDU_ENB_MPA, gpio);
consumer = "PLPCDU_ENB_HPA";
gpio = new GpiodRegularByLineName(q7s::gpioNames::PL_PCDU_ENABLE_HPA, consumer, Direction::OUT,
gpio::Levels::LOW);
plPcduGpios->addGpio(gpioIds::PLPCDU_ENB_HPA, gpio);
2022-02-23 19:26:02 +01:00
// Chip select pin is active low
consumer = "PLPCDU_ADC_CS";
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PL_PCDU_ADC_CS, consumer, Direction::OUT,
2022-02-23 19:26:02 +01:00
gpio::Levels::HIGH);
plPcduGpios->addGpio(gpioIds::PLPCDU_ADC_CS, gpio);
2022-04-28 18:38:38 +02:00
gpioChecker(gpioComIF->addGpios(plPcduGpios), "PL PCDU");
SpiCookie* spiCookie =
new SpiCookie(addresses::PLPCDU_ADC, gpioIds::PLPCDU_ADC_CS, plpcdu::MAX_ADC_REPLY_SIZE,
spi::DEFAULT_MAX_1227_MODE, spi::PL_PCDU_MAX_1227_SPEED);
2022-03-04 15:26:36 +01:00
// Create device handler components
2022-12-22 11:10:55 +01:00
auto plPcduHandler =
new PayloadPcduHandler(objects::PLPCDU_HANDLER, objects::SPI_MAIN_COM_IF, spiCookie,
gpioComIF, SdCardManager::instance(), stackHandler, false);
2022-03-04 15:26:36 +01:00
spiCookie->setCallbackMode(PayloadPcduHandler::extConvAsTwoCallback, plPcduHandler);
#if OBSW_TEST_PL_PCDU == 1
plPcduHandler->setStartUpImmediately();
#endif
2022-03-04 15:26:36 +01:00
#if OBSW_DEBUG_PL_PCDU == 1
plPcduHandler->setToGoToNormalModeImmediately(true);
2022-03-25 17:02:21 +01:00
plPcduHandler->enablePeriodicPrintout(true, 10);
2022-03-04 15:26:36 +01:00
#endif
2023-03-14 11:21:37 +01:00
plPcduHandler->connectModeTreeParent(satsystem::payload::SUBSYSTEM);
2022-02-23 19:26:02 +01:00
}
2021-09-13 18:07:07 +02:00
void ObjectFactory::createTestComponents(LinuxLibgpioIF* gpioComIF) {
2022-01-17 13:48:55 +01:00
new Q7STestTask(objects::TEST_TASK);
2021-09-15 17:38:26 +02:00
#if OBSW_ADD_SPI_TEST_CODE == 1
2022-01-17 13:48:55 +01:00
new SpiTestClass(objects::SPI_TEST, gpioComIF);
#endif
2022-02-03 13:37:48 +01:00
#if OBSW_ADD_I2C_TEST_CODE == 1
new I2cTestClass(objects::I2C_TEST, q7s::I2C_PL_EIVE);
2022-02-03 13:37:48 +01:00
#endif
2022-02-04 17:48:05 +01:00
#if OBSW_ADD_UART_TEST_CODE == 1
2022-09-27 18:54:48 +02:00
// auto* reader= new ScexUartReader(objects::SCEX_UART_READER);
2022-02-04 17:48:05 +01:00
new UartTestClass(objects::UART_TEST);
#endif
2020-09-30 17:17:01 +02:00
}
void ObjectFactory::createStrComponents(PowerSwitchIF* pwrSwitcher) {
2023-03-08 16:42:30 +01:00
auto* strAssy = new StrAssembly(objects::STR_ASSY);
2023-03-06 15:51:53 +01:00
strAssy->connectModeTreeParent(satsystem::acs::ACS_SUBSYSTEM);
2022-11-11 11:41:40 +01:00
auto* starTrackerCookie =
2023-03-22 02:20:14 +01:00
new SerialCookie(objects::STAR_TRACKER, q7s::UART_STAR_TRACKER_DEV, serial::STAR_TRACKER_BAUD,
2022-11-11 16:24:44 +01:00
startracker::MAX_FRAME_SIZE * 2 + 2, UartModes::NON_CANONICAL);
starTrackerCookie->setNoFixedSizeReply();
2023-03-22 02:20:14 +01:00
StrComHandler* strComIF = new StrComHandler(objects::STR_COM_IF);
2023-03-07 18:47:16 +01:00
2023-06-29 16:40:21 +02:00
const char* paramJsonFile = "/mnt/sd0/startracker/flight-config.json";
2023-03-07 18:47:16 +01:00
if (paramJsonFile == nullptr) {
sif::error << "No valid Star Tracker parameter JSON file" << std::endl;
}
2023-03-08 18:09:50 +01:00
auto strFdir = new StrFdir(objects::STAR_TRACKER);
auto starTracker =
2023-03-22 02:20:14 +01:00
new StarTrackerHandler(objects::STAR_TRACKER, objects::STR_COM_IF, starTrackerCookie,
2023-03-24 21:20:27 +01:00
paramJsonFile, strComIF, power::PDU1_CH2_STAR_TRACKER_5V);
starTracker->setPowerSwitcher(pwrSwitcher);
2023-03-06 15:51:53 +01:00
starTracker->connectModeTreeParent(*strAssy);
2023-03-08 18:09:50 +01:00
starTracker->setCustomFdir(strFdir);
}
2023-07-03 17:13:11 +02:00
void ObjectFactory::createImtqComponents(PowerSwitchIF* pwrSwitcher, bool enableHkSets,
const char* i2cDev) {
2023-03-02 16:08:31 +01:00
auto* imtqAssy = new ImtqAssembly(objects::IMTQ_ASSY);
imtqAssy->connectModeTreeParent(satsystem::acs::ACS_SUBSYSTEM);
2023-09-11 19:23:48 +02:00
new ImtqPollingTask(objects::IMTQ_POLLING, signals::I2C_FATAL_ERRORS);
2023-07-03 17:13:11 +02:00
I2cCookie* imtqI2cCookie = new I2cCookie(addresses::IMTQ, imtq::MAX_REPLY_SIZE, i2cDev);
2023-02-19 12:25:26 +01:00
auto imtqHandler = new ImtqHandler(objects::IMTQ_HANDLER, objects::IMTQ_POLLING, imtqI2cCookie,
2023-03-28 19:38:02 +02:00
power::Switches::PDU1_CH3_MGT_5V, enableHkSets);
2023-02-10 14:02:27 +01:00
imtqHandler->enableThermalModule(ThermalStateCfg());
imtqHandler->setPowerSwitcher(pwrSwitcher);
2023-03-02 16:08:31 +01:00
imtqHandler->connectModeTreeParent(*imtqAssy);
static_cast<void>(imtqHandler);
#if OBSW_TEST_IMTQ == 1
imtqHandler->setStartUpImmediately();
imtqHandler->setToGoToNormal(true);
#endif
#if OBSW_DEBUG_IMTQ == 1
imtqHandler->setDebugMode(true);
#endif
}
2023-07-03 17:13:11 +02:00
void ObjectFactory::createBpxBatteryComponent(bool enableHkSets, const char* i2cDev) {
I2cCookie* bpxI2cCookie = new I2cCookie(addresses::BPX_BATTERY, 100, i2cDev);
2023-03-26 15:28:00 +02:00
BpxBatteryHandler* bpxHandler = new BpxBatteryHandler(
objects::BPX_BATT_HANDLER, objects::I2C_COM_IF, bpxI2cCookie, enableHkSets);
bpxHandler->setStartUpImmediately();
bpxHandler->setToGoToNormalMode(true);
#if OBSW_DEBUG_BPX_BATT == 1
bpxHandler->setDebugMode(true);
#endif
}
2022-09-16 11:43:11 +02:00
void ObjectFactory::createMiscComponents() { new PlocMemoryDumper(objects::PLOC_MEMORY_DUMPER); }
void ObjectFactory::testAcsBrdAss(AcsBoardAssembly* acsAss) {
CommandMessage msg;
ModeMessage::setModeMessage(&msg, ModeMessage::CMD_MODE_COMMAND, DeviceHandlerIF::MODE_NORMAL,
duallane::A_SIDE);
ReturnValue_t result = MessageQueueSenderIF::sendMessage(acsAss->getCommandQueue(), &msg);
2022-08-24 17:27:47 +02:00
if (result != returnvalue::OK) {
sif::warning << "Sending mode command failed" << std::endl;
}
}
2023-05-11 15:05:44 +02:00
void ObjectFactory::createRadSensorChipSelect(LinuxLibgpioIF* gpioIF) {
using namespace gpio;
if (gpioIF == nullptr) {
return;
}
GpioCookie* gpioCookieRadSensor = new GpioCookie;
std::stringstream consumer;
consumer << "0x" << std::hex << objects::RAD_SENSOR;
GpiodRegularByLineName* gpio = new GpiodRegularByLineName(
q7s::gpioNames::RAD_SENSOR_CHIP_SELECT, consumer.str(), Direction::OUT, Levels::HIGH);
gpioCookieRadSensor->addGpio(gpioIds::CS_RAD_SENSOR, gpio);
gpio = new GpiodRegularByLineName(q7s::gpioNames::ENABLE_RADFET, consumer.str(), Direction::OUT,
Levels::LOW);
gpioCookieRadSensor->addGpio(gpioIds::ENABLE_RADFET, gpio);
gpioChecker(gpioIF->addGpios(gpioCookieRadSensor), "RAD sensor");
}
2023-06-15 08:39:06 +02:00
void ObjectFactory::createPlI2cResetGpio(LinuxLibgpioIF* gpioIF) {
using namespace gpio;
if (common::OBSW_VERSION_MAJOR >= 6 or common::OBSW_VERSION_MAJOR == 4) {
if (gpioIF == nullptr) {
return;
}
GpioCookie* gpioI2cResetnCookie = new GpioCookie;
GpiodRegularByLineName* gpioI2cResetn = new GpiodRegularByLineName(
q7s::gpioNames::PL_I2C_ARESETN, "PL_I2C_ARESETN", Direction::OUT, Levels::HIGH);
gpioI2cResetnCookie->addGpio(gpioIds::PL_I2C_ARESETN, gpioI2cResetn);
gpioChecker(gpioIF->addGpios(gpioI2cResetnCookie), "PL I2C ARESETN");
// Reset I2C explicitely again.
gpioIF->pullLow(gpioIds::PL_I2C_ARESETN);
TaskFactory::delayTask(1);
gpioIF->pullHigh(gpioIds::PL_I2C_ARESETN);
2023-06-15 08:39:06 +02:00
}
}
2023-07-03 16:55:45 +02:00
ReturnValue_t ObjectFactory::readFirmwareVersion() {
uint32_t* mappedSysRomAddr = nullptr;
// The SYS ROM FPGA block is only available in those versions.
if (not(common::OBSW_VERSION_MAJOR >= 6) or (common::OBSW_VERSION_MAJOR == 4)) {
return returnvalue::OK;
}
// This has to come before the version announce because it might be required for retrieving
// the firmware version.
UioMapper sysRomMapper(q7s::UIO_SYS_ROM);
ReturnValue_t result =
sysRomMapper.getMappedAdress(&mappedSysRomAddr, UioMapper::Permissions::READ_ONLY);
if (result != returnvalue::OK) {
sif::error << "Getting mapped SYS ROM UIO address failed" << std::endl;
return returnvalue::FAILED;
}
if (mappedSysRomAddr != nullptr) {
uint32_t firstEntry = *(reinterpret_cast<uint32_t*>(mappedSysRomAddr));
uint32_t secondEntry = *(reinterpret_cast<uint32_t*>(mappedSysRomAddr) + 1);
core::FW_VERSION_MAJOR = (firstEntry >> 24) & 0xff;
core::FW_VERSION_MINOR = (firstEntry >> 16) & 0xff;
core::FW_VERSION_REVISION = (firstEntry >> 8) & 0xff;
bool hasGitSha = (firstEntry & 0x0b1);
if (hasGitSha) {
std::memcpy(core::FW_VERSION_GIT_SHA, &secondEntry, 4);
}
}
return returnvalue::OK;
}
2023-09-12 14:27:14 +02:00
2023-09-12 14:29:42 +02:00
ReturnValue_t ObjectFactory::createCcsdsIpComponentsAddTmRouting(CcsdsComponentArgs& ccsdsArgs) {
2023-09-12 14:27:14 +02:00
ReturnValue_t result = createCcsdsComponents(ccsdsArgs);
#if OBSW_TM_TO_PTME == 1
if (ccsdsArgs.normalLiveTmDest != MessageQueueIF::NO_QUEUE) {
ccsdsArgs.pusFunnel.addLiveDestinationByRawId("VC0 NORMAL LIVE TM", ccsdsArgs.normalLiveTmDest,
0);
}
if (ccsdsArgs.cfdpLiveTmDest != MessageQueueIF::NO_QUEUE) {
ccsdsArgs.cfdpFunnel.addLiveDestinationByRawId("VC0 CFDP LIVE TM", ccsdsArgs.cfdpLiveTmDest, 0);
}
#endif
return result;
}