eive-obsw/bsp_q7s/core/ObjectFactory.cpp

1385 lines
65 KiB
C++
Raw Normal View History

2020-09-30 17:17:01 +02:00
#include "ObjectFactory.h"
2021-12-06 19:36:21 +01:00
2022-03-04 18:12:16 +01:00
#include <fsfw/ipc/QueueFactory.h>
2022-02-24 12:02:23 +01:00
#include <linux/obc/AxiPtmeConfig.h>
#include <linux/obc/PapbVcInterface.h>
#include <linux/obc/PdecHandler.h>
#include <linux/obc/Ptme.h>
#include <linux/obc/PtmeConfig.h>
#include <mission/system/AcsBoardFdir.h>
#include <mission/system/SusAssembly.h>
2022-03-17 19:59:47 +01:00
#include <mission/system/SusFdir.h>
2022-01-17 13:48:55 +01:00
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-02-23 19:26:02 +01:00
#include "bsp_q7s/callbacks/gpioCallbacks.h"
2022-01-19 18:11:35 +01:00
#include "bsp_q7s/callbacks/pcduSwitchCb.h"
2022-01-17 13:48:55 +01:00
#include "bsp_q7s/callbacks/rwSpiCallback.h"
#include "bsp_q7s/core/CoreController.h"
#include "bsp_q7s/devices/PlocMemoryDumper.h"
2021-08-09 16:30:59 +02:00
#include "bsp_q7s/devices/PlocSupervisorHandler.h"
#include "bsp_q7s/devices/PlocUpdater.h"
2022-01-17 13:48:55 +01:00
#include "bsp_q7s/memory/FileSystemHandler.h"
#include "busConf.h"
#include "ccsdsConfig.h"
#include "devConf.h"
#include "devices/addresses.h"
#include "devices/gpioIds.h"
#include "devices/powerSwitcherList.h"
2022-02-24 12:02:23 +01:00
#include "linux/boardtest/I2cTestClass.h"
#include "linux/boardtest/SpiTestClass.h"
#include "linux/boardtest/UartTestClass.h"
#include "linux/csp/CspComIF.h"
#include "linux/csp/CspCookie.h"
2022-03-04 15:26:36 +01:00
#include "linux/devices/GPSHyperionLinuxController.h"
#include "linux/devices/devicedefinitions/StarTrackerDefinitions.h"
#include "linux/devices/startracker/StarTrackerHandler.h"
#include "linux/devices/startracker/StrHelper.h"
2022-02-24 12:02:23 +01:00
#include "tmtc/apid.h"
#include "tmtc/pusIds.h"
2022-03-04 15:26:36 +01:00
2022-02-24 12:02:23 +01:00
#if OBSW_TEST_LIBGPIOD == 1
#include "linux/boardtest/LibgpiodTest.h"
#endif
#include <sstream>
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"
#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"
#include "fsfw_hal/linux/spi/SpiComIF.h"
#include "fsfw_hal/linux/spi/SpiCookie.h"
#include "fsfw_hal/linux/uart/UartComIF.h"
#include "fsfw_hal/linux/uart/UartCookie.h"
2021-07-19 12:44:43 +02:00
#include "mission/core/GenericFactory.h"
#include "mission/devices/ACUHandler.h"
2022-02-02 17:36:40 +01:00
#include "mission/devices/BpxBatteryHandler.h"
#include "mission/devices/GyroADIS1650XHandler.h"
2022-01-17 13:48:55 +01:00
#include "mission/devices/HeaterHandler.h"
2021-07-19 12:44:43 +02:00
#include "mission/devices/IMTQHandler.h"
2022-01-17 13:48:55 +01:00
#include "mission/devices/Max31865PT1000Handler.h"
#include "mission/devices/P60DockHandler.h"
#include "mission/devices/PCDUHandler.h"
#include "mission/devices/PDU1Handler.h"
#include "mission/devices/PDU2Handler.h"
2022-03-04 15:26:36 +01:00
#include "mission/devices/PayloadPcduHandler.h"
2021-07-23 17:48:11 +02:00
#include "mission/devices/PlocMPSoCHandler.h"
2021-07-19 12:44:43 +02:00
#include "mission/devices/RadiationSensorHandler.h"
#include "mission/devices/RwHandler.h"
2022-02-27 15:48:42 +01:00
#include "mission/devices/SolarArrayDeploymentHandler.h"
2022-02-23 19:26:02 +01:00
#include "mission/devices/SusHandler.h"
2022-01-17 13:48:55 +01:00
#include "mission/devices/SyrlinksHkHandler.h"
#include "mission/devices/Tmp1075Handler.h"
2021-07-19 12:44:43 +02:00
#include "mission/devices/devicedefinitions/GomspaceDefinitions.h"
2022-01-17 13:48:55 +01:00
#include "mission/devices/devicedefinitions/Max31865Definitions.h"
2021-07-23 17:48:11 +02:00
#include "mission/devices/devicedefinitions/PlocMPSoCDefinitions.h"
2021-07-19 12:44:43 +02:00
#include "mission/devices/devicedefinitions/RadSensorDefinitions.h"
#include "mission/devices/devicedefinitions/RwDefinitions.h"
2022-02-23 19:26:02 +01:00
#include "mission/devices/devicedefinitions/SusDefinitions.h"
2022-01-17 13:48:55 +01:00
#include "mission/devices/devicedefinitions/SyrlinksDefinitions.h"
2022-03-04 15:26:36 +01:00
#include "mission/devices/devicedefinitions/payloadPcduDefinitions.h"
2022-03-07 14:46:46 +01:00
#include "mission/system/AcsBoardAssembly.h"
2021-09-26 08:29:30 +02:00
#include "mission/tmtc/CCSDSHandler.h"
#include "mission/tmtc/VirtualChannel.h"
2021-07-19 12:44:43 +02:00
#include "mission/utility/TmFunnel.h"
2021-09-19 12:27:48 +02:00
2021-09-07 16:11:02 +02:00
ResetArgs resetArgsGnss0;
ResetArgs resetArgsGnss1;
2022-01-17 13:48:55 +01:00
void ObjectFactory::setStatics() { Factory::setStaticFrameworkObjectIds(); }
2021-07-19 12:44:43 +02:00
2020-11-20 18:27:07 +01:00
void Factory::setStaticFrameworkObjectIds() {
2022-01-17 13:48:55 +01:00
PusServiceBase::packetSource = objects::PUS_PACKET_DISTRIBUTOR;
PusServiceBase::packetDestination = objects::TM_FUNNEL;
2020-09-30 17:17:01 +02:00
2022-01-17 13:48:55 +01:00
CommandingServiceBase::defaultPacketSource = objects::PUS_PACKET_DISTRIBUTOR;
CommandingServiceBase::defaultPacketDestination = objects::TM_FUNNEL;
2020-09-30 17:17:01 +02:00
2022-01-17 13:48:55 +01:00
// DeviceHandlerBase::powerSwitcherId = objects::PCDU_HANDLER;
DeviceHandlerBase::powerSwitcherId = objects::NO_OBJECT;
2021-09-26 08:29:30 +02:00
#if OBSW_TM_TO_PTME == 1
2022-01-17 13:48:55 +01:00
TmFunnel::downlinkDestination = objects::CCSDS_HANDLER;
2021-09-26 08:29:30 +02:00
#else
2022-01-17 13:48:55 +01:00
TmFunnel::downlinkDestination = objects::TMTC_BRIDGE;
2021-09-26 08:29:30 +02:00
#endif /* OBSW_TM_TO_PTME == 1 */
2022-01-17 13:48:55 +01:00
// No storage object for now.
TmFunnel::storageDestination = objects::NO_OBJECT;
2020-09-30 17:17:01 +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-01-17 13:48:55 +01:00
VerificationReporter::messageReceiver = objects::PUS_SERVICE_1_VERIFICATION;
TmPacketBase::timeStamperId = objects::TIME_STAMPER;
2020-09-30 17:17:01 +02:00
}
2021-09-20 17:47:29 +02:00
void ObjectFactory::produce(void* args) {
2022-01-17 13:48:55 +01:00
ObjectFactory::setStatics();
ObjectFactory::produceGenericObjects();
LinuxLibgpioIF* gpioComIF = nullptr;
UartComIF* uartComIF = nullptr;
SpiComIF* spiComIF = nullptr;
2022-02-02 17:36:40 +01:00
I2cComIF* i2cComIF = nullptr;
2022-03-04 16:03:57 +01:00
PowerSwitchIF* pwrSwitcher = nullptr;
2022-02-02 17:36:40 +01:00
createCommunicationInterfaces(&gpioComIF, &uartComIF, &spiComIF, &i2cComIF);
2022-01-17 13:48:55 +01:00
createTmpComponents();
2021-07-19 12:44:43 +02:00
#if BOARD_TE0720 == 0
2022-01-17 13:48:55 +01:00
new CoreController(objects::CORE_CONTROLLER);
2021-07-19 12:44:43 +02:00
2022-02-23 19:26:02 +01:00
gpioCallbacks::disableAllDecoder();
2022-03-04 16:03:57 +01:00
createPcduComponents(gpioComIF, &pwrSwitcher);
2022-01-17 13:48:55 +01:00
createRadSensorComponent(gpioComIF);
2022-03-17 19:59:47 +01:00
createSunSensorComponents(gpioComIF, spiComIF, pwrSwitcher);
2021-09-13 18:07:07 +02:00
2021-07-19 12:44:43 +02:00
#if OBSW_ADD_ACS_BOARD == 1
2022-03-04 16:03:57 +01:00
createAcsBoardComponents(gpioComIF, uartComIF, pwrSwitcher);
2022-01-19 18:05:17 +01:00
#endif
2022-01-17 13:48:55 +01:00
createHeaterComponents();
createSolarArrayDeploymentComponents();
2022-02-23 19:26:02 +01:00
createPlPcduComponents(gpioComIF, spiComIF);
2021-09-22 11:45:25 +02:00
#if OBSW_ADD_SYRLINKS == 1
2022-01-17 13:48:55 +01:00
createSyrlinksComponents();
2021-09-22 11:45:25 +02:00
#endif /* OBSW_ADD_SYRLINKS == 1 */
2022-01-17 13:48:55 +01:00
createRtdComponents(gpioComIF);
2021-05-26 14:16:16 +02:00
2022-01-27 15:26:07 +01:00
#if OBSW_ADD_MGT == 1
2022-01-17 13:48:55 +01:00
I2cCookie* imtqI2cCookie =
new I2cCookie(addresses::IMTQ, IMTQ::MAX_REPLY_SIZE, q7s::I2C_DEFAULT_DEV);
2022-01-27 15:26:07 +01:00
auto imtqHandler = new IMTQHandler(objects::IMTQ_HANDLER, objects::I2C_COM_IF, imtqI2cCookie);
2022-01-27 17:30:28 +01:00
static_cast<void>(imtqHandler);
2022-01-27 15:26:07 +01:00
#if OBSW_DEBUG_IMTQ == 1
2022-01-27 16:04:45 +01:00
imtqHandler->setToGoToNormal(true);
2022-01-27 15:26:07 +01:00
imtqHandler->setStartUpImmediately();
2022-01-28 12:43:26 +01:00
#else
2022-02-05 18:08:54 +01:00
(void)imtqHandler;
2022-01-27 15:26:07 +01:00
#endif
#endif
2022-01-17 13:48:55 +01:00
createReactionWheelComponents(gpioComIF);
2020-09-30 17:17:01 +02:00
2022-02-02 17:36:40 +01:00
#if OBSW_ADD_BPX_BATTERY_HANDLER == 1
2022-01-17 15:35:46 +01:00
I2cCookie* bpxI2cCookie = new I2cCookie(addresses::BPX_BATTERY, 100, q7s::I2C_DEFAULT_DEV);
2022-02-02 17:36:40 +01:00
BpxBatteryHandler* bpxHandler =
new BpxBatteryHandler(objects::BPX_BATT_HANDLER, objects::I2C_COM_IF, bpxI2cCookie);
2022-02-03 15:03:35 +01:00
#if OBSW_TEST_BPX_BATT == 1
2022-02-02 17:36:40 +01:00
bpxHandler->setToGoToNormalMode(true);
2022-02-03 12:02:25 +01:00
bpxHandler->setStartUpImmediately();
#else
static_cast<void>(bpxHandler);
2022-02-02 17:36:40 +01:00
#endif
#endif
2021-08-17 17:48:51 +02:00
#if OBSW_ADD_PLOC_MPSOC == 1
2022-01-17 13:48:55 +01:00
UartCookie* plocMpsocCookie =
new UartCookie(objects::PLOC_MPSOC_HANDLER, q7s::UART_PLOC_MPSOC_DEV,
UartModes::NON_CANONICAL, uart::PLOC_MPSOC_BAUD, PLOC_MPSOC::MAX_REPLY_SIZE);
new PlocMPSoCHandler(objects::PLOC_MPSOC_HANDLER, objects::UART_COM_IF, plocMpsocCookie);
#endif /* OBSW_ADD_PLOC_MPSOC == 1 */
2021-07-23 17:48:11 +02:00
2021-08-17 17:48:51 +02:00
#if OBSW_ADD_PLOC_SUPERVISOR == 1
2022-01-17 13:48:55 +01:00
UartCookie* plocSupervisorCookie = new UartCookie(
objects::PLOC_SUPERVISOR_HANDLER, q7s::UART_PLOC_SUPERVSIOR_DEV, UartModes::NON_CANONICAL,
uart::PLOC_SUPERVISOR_BAUD, PLOC_SPV::MAX_PACKET_SIZE * 20);
plocSupervisorCookie->setNoFixedSizeReply();
PlocSupervisorHandler* plocSupervisor = new PlocSupervisorHandler(
objects::PLOC_SUPERVISOR_HANDLER, objects::UART_COM_IF, plocSupervisorCookie);
plocSupervisor->setStartUpImmediately();
#endif /* OBSW_ADD_PLOC_SUPERVISOR == 1 */
2021-07-23 17:48:11 +02:00
2022-01-17 13:48:55 +01:00
new FileSystemHandler(objects::FILE_SYSTEM_HANDLER);
2021-07-23 17:48:11 +02:00
2021-08-17 19:50:48 +02:00
#if OBSW_ADD_STAR_TRACKER == 1
2022-01-17 13:48:55 +01:00
UartCookie* starTrackerCookie =
new UartCookie(objects::STAR_TRACKER, q7s::UART_STAR_TRACKER_DEV, UartModes::NON_CANONICAL,
uart::STAR_TRACKER_BAUD, StarTracker::MAX_FRAME_SIZE * 2 + 2);
starTrackerCookie->setNoFixedSizeReply();
StrHelper* strHelper = new StrHelper(objects::STR_HELPER);
StarTrackerHandler* starTrackerHandler = new StarTrackerHandler(
objects::STAR_TRACKER, objects::UART_COM_IF, starTrackerCookie, strHelper);
starTrackerHandler->setStartUpImmediately();
2021-12-06 19:36:21 +01:00
#endif /* OBSW_ADD_STAR_TRACKER == 1 */
2021-11-01 12:41:20 +01:00
#endif /* TE7020 == 0 */
2021-09-22 16:54:55 +02:00
#if OBSW_USE_CCSDS_IP_CORE == 1
2022-01-17 13:48:55 +01:00
createCcsdsComponents(gpioComIF);
2021-09-22 16:54:55 +02:00
#endif /* OBSW_USE_CCSDS_IP_CORE == 1 */
2021-09-19 12:27:48 +02:00
2022-01-17 13:48:55 +01:00
/* Test Task */
#if OBSW_ADD_TEST_CODE == 1
2022-01-17 13:48:55 +01:00
createTestComponents(gpioComIF);
#endif /* OBSW_ADD_TEST_CODE == 1 */
2021-07-23 17:48:11 +02:00
2022-01-17 13:48:55 +01:00
new PlocUpdater(objects::PLOC_UPDATER);
new PlocMemoryDumper(objects::PLOC_MEMORY_DUMPER);
2021-07-19 12:44:43 +02:00
}
void ObjectFactory::createTmpComponents() {
#if BOARD_TE0720 == 1
2022-01-17 13:48:55 +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
2022-01-17 13:48:55 +01:00
I2cCookie* i2cCookieTmp1075tcs1 =
new I2cCookie(addresses::TMP1075_TCS_1, TMP1075::MAX_REPLY_LENGTH, q7s::I2C_DEFAULT_DEV);
I2cCookie* i2cCookieTmp1075tcs2 =
new I2cCookie(addresses::TMP1075_TCS_2, TMP1075::MAX_REPLY_LENGTH, q7s::I2C_DEFAULT_DEV);
2021-01-28 14:55:21 +01:00
#endif
2020-12-29 13:59:31 +01:00
2022-01-17 13:48:55 +01:00
/* Temperature sensors */
Tmp1075Handler* tmp1075Handler_1 =
new Tmp1075Handler(objects::TMP1075_HANDLER_1, objects::I2C_COM_IF, i2cCookieTmp1075tcs1);
(void)tmp1075Handler_1;
Tmp1075Handler* tmp1075Handler_2 =
new Tmp1075Handler(objects::TMP1075_HANDLER_2, objects::I2C_COM_IF, i2cCookieTmp1075tcs2);
(void)tmp1075Handler_2;
2021-07-19 12:44:43 +02:00
}
2020-12-29 13:59:31 +01:00
2022-01-17 13:48:55 +01:00
void ObjectFactory::createCommunicationInterfaces(LinuxLibgpioIF** gpioComIF, UartComIF** uartComIF,
2022-02-02 17:36:40 +01:00
SpiComIF** spiComIF, I2cComIF** i2cComIF) {
2022-01-17 13:48:55 +01:00
if (gpioComIF == nullptr or uartComIF == nullptr or spiComIF == nullptr) {
sif::error << "ObjectFactory::createCommunicationInterfaces: Invalid passed ComIF pointer"
<< std::endl;
}
*gpioComIF = new LinuxLibgpioIF(objects::GPIO_IF);
/* Communication interfaces */
new CspComIF(objects::CSP_COM_IF);
2022-02-02 17:36:40 +01:00
*i2cComIF = new I2cComIF(objects::I2C_COM_IF);
2022-01-17 13:48:55 +01:00
*uartComIF = new UartComIF(objects::UART_COM_IF);
*spiComIF = new SpiComIF(objects::SPI_COM_IF, *gpioComIF);
#if BOARD_TE0720 == 0
2022-01-17 13:48:55 +01:00
/* Adding gpios for chip select decoding to the gpioComIf */
gpioCallbacks::initSpiCsDecoder(*gpioComIF);
#endif
2021-07-19 12:44:43 +02:00
}
2020-12-29 13:59:31 +01:00
2022-03-04 16:03:57 +01:00
void ObjectFactory::createPcduComponents(LinuxLibgpioIF* gpioComIF, PowerSwitchIF** pwrSwitcher) {
2022-01-17 13:48:55 +01:00
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);
2022-01-19 18:05:17 +01:00
pdu1handler->assignChannelHookFunction(&pcdu::switchCallback, gpioComIF);
2022-01-17 13:48:55 +01:00
PDU2Handler* pdu2handler =
new PDU2Handler(objects::PDU2_HANDLER, objects::CSP_COM_IF, pdu2CspCookie);
2022-01-19 18:05:17 +01:00
pdu2handler->assignChannelHookFunction(&pcdu::switchCallback, gpioComIF);
2022-01-17 13:48:55 +01:00
ACUHandler* acuhandler = new ACUHandler(objects::ACU_HANDLER, objects::CSP_COM_IF, acuCspCookie);
2022-03-04 16:03:57 +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();
acuhandler->setModeNormal();
2022-03-04 16:03:57 +01:00
if (pwrSwitcher != nullptr) {
*pwrSwitcher = pcduHandler;
}
2021-07-19 12:44:43 +02:00
}
2021-04-01 14:06:56 +02:00
2021-07-19 12:44:43 +02:00
void ObjectFactory::createRadSensorComponent(LinuxLibgpioIF* gpioComIF) {
2022-02-28 15:47:34 +01:00
using namespace gpio;
2022-01-17 13:48:55 +01:00
GpioCookie* gpioCookieRadSensor = new GpioCookie;
std::stringstream consumer;
consumer << "0x" << std::hex << objects::RAD_SENSOR;
GpiodRegularByLineName* gpio = new GpiodRegularByLineName(
2022-02-28 15:47:34 +01:00
q7s::gpioNames::RAD_SENSOR_CHIP_SELECT, consumer.str(), Direction::OUT, Levels::HIGH);
2022-01-17 13:48:55 +01:00
gpioCookieRadSensor->addGpio(gpioIds::CS_RAD_SENSOR, gpio);
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::ENABLE_RADFET, consumer.str(), Direction::OUT,
Levels::LOW);
2022-02-24 11:47:32 +01:00
gpioCookieRadSensor->addGpio(gpioIds::ENABLE_RADFET, gpio);
2022-01-17 13:48:55 +01:00
gpioComIF->addGpios(gpioCookieRadSensor);
SpiCookie* spiCookieRadSensor = new SpiCookie(
addresses::RAD_SENSOR, gpioIds::CS_RAD_SENSOR, std::string(q7s::SPI_DEFAULT_DEV),
RAD_SENSOR::READ_SIZE, spi::DEFAULT_MAX_1227_MODE, spi::DEFAULT_MAX_1227_SPEED);
2022-02-24 11:47:32 +01:00
auto radSensor = new RadiationSensorHandler(objects::RAD_SENSOR, objects::SPI_COM_IF,
spiCookieRadSensor, gpioComIF);
static_cast<void>(radSensor);
2022-03-17 10:48:35 +01:00
// The radiation sensor ADC is powered by the 5V stack connector which should always be on
2022-02-24 11:47:32 +01:00
radSensor->setStartUpImmediately();
2022-03-17 10:48:35 +01:00
// It's a simple sensor, so just to to normal mode immediately
2022-02-24 11:47:32 +01:00
radSensor->setToGoToNormalModeImmediately();
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
2021-07-19 12:44:43 +02:00
}
2021-07-01 17:27:51 +02:00
2022-03-22 15:49:22 +01:00
void ObjectFactory::createSunSensorComponents(LinuxLibgpioIF* gpioComIF, SpiComIF* spiComIF,
PowerSwitchIF* pwrSwitcher) {
2022-02-28 15:47:34 +01:00
using namespace gpio;
2022-01-17 13:48:55 +01:00
GpioCookie* gpioCookieSus = new GpioCookie();
GpioCallback* susgpio = nullptr;
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 0", Direction::OUT, Levels::HIGH,
2022-02-23 19:26:02 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_0, susgpio);
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 1", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_1, susgpio);
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 2", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_2, susgpio);
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 3", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_3, susgpio);
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 4", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_4, susgpio);
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 5", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_5, susgpio);
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 6", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_6, susgpio);
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 7", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_7, susgpio);
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 8", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_8, susgpio);
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 9", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_9, susgpio);
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 10", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_10, susgpio);
2022-02-28 15:47:34 +01:00
susgpio = new GpioCallback("Chip select SUS 11", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
gpioCookieSus->addGpio(gpioIds::CS_SUS_11, susgpio);
gpioComIF->addGpios(gpioCookieSus);
2022-03-17 19:59:47 +01:00
SusFdir* fdir = nullptr;
std::array<SusHandler*, 12> susHandlers = {};
2022-02-23 19:26:02 +01:00
#if OBSW_ADD_SUN_SENSORS == 1
SpiCookie* spiCookie =
new SpiCookie(addresses::SUS_0, gpioIds::CS_SUS_0, q7s::SPI_DEFAULT_DEV, SUS::MAX_CMD_SIZE,
2022-03-22 11:57:48 +01:00
spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
2022-03-17 19:59:47 +01:00
susHandlers[0] = new SusHandler(objects::SUS_0, 0, objects::SPI_COM_IF, spiCookie);
fdir = new SusFdir(objects::SUS_0);
susHandlers[0]->setParent(objects::SUS_BOARD_ASS);
susHandlers[0]->setCustomFdir(fdir);
2022-02-23 19:26:02 +01:00
2022-03-22 15:49:22 +01:00
spiCookie = new SpiCookie(addresses::SUS_1, gpioIds::CS_SUS_1, q7s::SPI_DEFAULT_DEV,
SUS::MAX_CMD_SIZE, spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
2022-03-17 19:59:47 +01:00
susHandlers[1] = new SusHandler(objects::SUS_1, 1, objects::SPI_COM_IF, spiCookie);
fdir = new SusFdir(objects::SUS_1);
susHandlers[1]->setParent(objects::SUS_BOARD_ASS);
susHandlers[1]->setCustomFdir(fdir);
2022-02-23 19:26:02 +01:00
2022-03-22 15:49:22 +01:00
spiCookie = new SpiCookie(addresses::SUS_2, gpioIds::CS_SUS_2, q7s::SPI_DEFAULT_DEV,
SUS::MAX_CMD_SIZE, spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
2022-03-17 19:59:47 +01:00
susHandlers[2] = new SusHandler(objects::SUS_2, 2, objects::SPI_COM_IF, spiCookie);
fdir = new SusFdir(objects::SUS_2);
susHandlers[2]->setParent(objects::SUS_BOARD_ASS);
susHandlers[2]->setCustomFdir(fdir);
2022-02-23 19:26:02 +01:00
2022-03-22 15:49:22 +01:00
spiCookie = new SpiCookie(addresses::SUS_3, gpioIds::CS_SUS_3, std::string(q7s::SPI_DEFAULT_DEV),
SUS::MAX_CMD_SIZE, spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
2022-03-17 19:59:47 +01:00
susHandlers[3] = new SusHandler(objects::SUS_3, 3, objects::SPI_COM_IF, spiCookie);
fdir = new SusFdir(objects::SUS_3);
susHandlers[3]->setParent(objects::SUS_BOARD_ASS);
susHandlers[3]->setCustomFdir(fdir);
2022-02-23 19:26:02 +01:00
2022-03-22 15:49:22 +01:00
spiCookie = new SpiCookie(addresses::SUS_4, gpioIds::CS_SUS_4, std::string(q7s::SPI_DEFAULT_DEV),
SUS::MAX_CMD_SIZE, spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
2022-03-17 19:59:47 +01:00
susHandlers[4] = new SusHandler(objects::SUS_4, 4, objects::SPI_COM_IF, spiCookie);
fdir = new SusFdir(objects::SUS_4);
susHandlers[4]->setParent(objects::SUS_BOARD_ASS);
susHandlers[4]->setCustomFdir(fdir);
2022-02-23 19:26:02 +01:00
2022-03-22 15:49:22 +01:00
spiCookie = new SpiCookie(addresses::SUS_5, gpioIds::CS_SUS_5, std::string(q7s::SPI_DEFAULT_DEV),
SUS::MAX_CMD_SIZE, spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
2022-03-17 19:59:47 +01:00
susHandlers[5] = new SusHandler(objects::SUS_5, 5, objects::SPI_COM_IF, spiCookie);
fdir = new SusFdir(objects::SUS_5);
susHandlers[5]->setParent(objects::SUS_BOARD_ASS);
susHandlers[5]->setCustomFdir(fdir);
2022-02-23 19:26:02 +01:00
2022-03-22 15:49:22 +01:00
spiCookie = new SpiCookie(addresses::SUS_6, gpioIds::CS_SUS_6, q7s::SPI_DEFAULT_DEV,
SUS::MAX_CMD_SIZE, spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
2022-03-17 19:59:47 +01:00
susHandlers[6] = new SusHandler(objects::SUS_6, 6, objects::SPI_COM_IF, spiCookie);
fdir = new SusFdir(objects::SUS_6);
susHandlers[6]->setParent(objects::SUS_BOARD_ASS);
susHandlers[6]->setCustomFdir(fdir);
2022-02-22 20:47:09 +01:00
2022-03-22 15:49:22 +01:00
spiCookie = new SpiCookie(addresses::SUS_7, gpioIds::CS_SUS_7, q7s::SPI_DEFAULT_DEV,
SUS::MAX_CMD_SIZE, spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
susHandlers[7] = new SusHandler(objects::SUS_7, 7, objects::SPI_COM_IF, spiCookie);
2022-03-17 19:59:47 +01:00
fdir = new SusFdir(objects::SUS_7);
susHandlers[7]->setParent(objects::SUS_BOARD_ASS);
susHandlers[7]->setCustomFdir(fdir);
2022-02-23 19:26:02 +01:00
2022-03-22 15:49:22 +01:00
spiCookie = new SpiCookie(addresses::SUS_8, gpioIds::CS_SUS_8, q7s::SPI_DEFAULT_DEV,
SUS::MAX_CMD_SIZE, spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
2022-03-17 19:59:47 +01:00
susHandlers[8] = new SusHandler(objects::SUS_8, 8, objects::SPI_COM_IF, spiCookie);
fdir = new SusFdir(objects::SUS_8);
susHandlers[8]->setParent(objects::SUS_BOARD_ASS);
susHandlers[8]->setCustomFdir(fdir);
2022-02-23 19:26:02 +01:00
2022-03-22 15:49:22 +01:00
spiCookie = new SpiCookie(addresses::SUS_9, gpioIds::CS_SUS_9, q7s::SPI_DEFAULT_DEV,
SUS::MAX_CMD_SIZE, spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
susHandlers[9] = new SusHandler(objects::SUS_9, 9, objects::SPI_COM_IF, spiCookie);
2022-03-17 19:59:47 +01:00
fdir = new SusFdir(objects::SUS_9);
susHandlers[9]->setParent(objects::SUS_BOARD_ASS);
susHandlers[9]->setCustomFdir(fdir);
2022-02-23 19:26:02 +01:00
2022-03-22 15:49:22 +01:00
spiCookie = new SpiCookie(addresses::SUS_10, gpioIds::CS_SUS_10, q7s::SPI_DEFAULT_DEV,
SUS::MAX_CMD_SIZE, spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
susHandlers[10] = new SusHandler(objects::SUS_10, 10, objects::SPI_COM_IF, spiCookie);
2022-03-17 19:59:47 +01:00
fdir = new SusFdir(objects::SUS_10);
susHandlers[10]->setParent(objects::SUS_BOARD_ASS);
susHandlers[10]->setCustomFdir(fdir);
2022-02-23 19:26:02 +01:00
2022-03-22 15:49:22 +01:00
spiCookie = new SpiCookie(addresses::SUS_11, gpioIds::CS_SUS_11, q7s::SPI_DEFAULT_DEV,
SUS::MAX_CMD_SIZE, spi::SUS_MAX_1227_MODE, spi::SUS_MAX1227_SPI_FREQ);
2022-03-17 19:59:47 +01:00
susHandlers[11] = new SusHandler(objects::SUS_11, 11, objects::SPI_COM_IF, spiCookie);
fdir = new SusFdir(objects::SUS_11);
susHandlers[11]->setParent(objects::SUS_BOARD_ASS);
susHandlers[11]->setCustomFdir(fdir);
2022-03-22 15:49:22 +01:00
for (auto& sus : susHandlers) {
if (sus != nullptr) {
2022-02-23 19:26:02 +01:00
#if OBSW_TEST_SUS == 1
2022-03-17 19:59:47 +01:00
sus->setStartUpImmediately();
sus->setToGoToNormalMode(true);
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_SUS == 1
2022-03-17 19:59:47 +01:00
sus->enablePeriodicPrintout(true, 3);
2022-02-23 19:26:02 +01:00
#endif
2022-03-17 19:59:47 +01:00
}
}
std::array<object_id_t, 12> susIds = {objects::SUS_0, objects::SUS_1, objects::SUS_2,
objects::SUS_3, objects::SUS_4, objects::SUS_5,
objects::SUS_6, objects::SUS_7, objects::SUS_8,
objects::SUS_9, objects::SUS_10, objects::SUS_11};
SusAssHelper susAssHelper = SusAssHelper(susIds);
auto susAss =
new SusAssembly(objects::SUS_BOARD_ASS, objects::NO_OBJECT, pwrSwitcher, susAssHelper);
2022-03-22 15:49:22 +01:00
static_cast<void>(susAss);
2022-02-23 19:26:02 +01:00
#endif /* OBSW_ADD_SUN_SENSORS == 1 */
2021-07-19 12:44:43 +02:00
}
2021-05-03 11:59:33 +02:00
2022-03-04 16:03:57 +01:00
void ObjectFactory::createAcsBoardComponents(LinuxLibgpioIF* gpioComIF, UartComIF* uartComIF,
PowerSwitchIF* pwrSwitcher) {
2022-02-28 15:47:34 +01:00
using namespace gpio;
2022-01-17 13:48:55 +01:00
GpioCookie* gpioCookieAcsBoard = new GpioCookie();
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::GYRO_0_ADIS_CS, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::GYRO_1_L3G_CS, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::GYRO_2_ADIS_CS, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::GYRO_3_L3G_CS, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::MGM_0_LIS3_CS, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::MGM_1_RM3100_CS, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::MGM_2_LIS3_CS, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::MGM_3_RM3100_CS, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::GNSS_0_NRESET, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::GNSS_1_NRESET, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::GYRO_0_ENABLE, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::GYRO_2_ENABLE, gpio);
// 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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::GNSS_0_ENABLE, gpio);
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);
2022-01-17 13:48:55 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::GNSS_1_ENABLE, gpio);
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);
2022-02-01 11:17:00 +01:00
gpioCookieAcsBoard->addGpio(gpioIds::GNSS_SELECT, gpio);
2022-01-17 13:48:55 +01:00
gpioComIF->addGpios(gpioCookieAcsBoard);
AcsBoardFdir* fdir = nullptr;
2022-03-17 19:59:47 +01:00
static_cast<void>(fdir);
2022-01-17 13:48:55 +01:00
2022-01-19 18:05:17 +01:00
#if OBSW_ADD_ACS_HANDLERS == 1
2022-01-17 13:48:55 +01:00
std::string spiDev = q7s::SPI_DEFAULT_DEV;
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 MgmLIS3MDLHandler(objects::MGM_0_LIS3_HANDLER, objects::SPI_COM_IF,
spiCookie, spi::LIS3_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::MGM_0_LIS3_HANDLER);
mgmLis3Handler->setCustomFdir(fdir);
2022-03-04 16:03:57 +01:00
static_cast<void>(mgmLis3Handler);
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-04 18:12:16 +01:00
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_ACS == 1
mgmLis3Handler->enablePeriodicPrintouts(true, 10);
#endif
2021-04-01 14:06:56 +02:00
2022-01-17 13:48:55 +01:00
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 MgmRM3100Handler(objects::MGM_1_RM3100_HANDLER, objects::SPI_COM_IF,
spiCookie, spi::RM3100_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::MGM_1_RM3100_HANDLER);
mgmRm3100Handler->setCustomFdir(fdir);
mgmRm3100Handler->setParent(objects::ACS_BOARD_ASS);
2022-03-04 16:03:57 +01:00
static_cast<void>(mgmRm3100Handler);
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-04 18:12:16 +01:00
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_ACS == 1
mgmRm3100Handler->enablePeriodicPrintouts(true, 10);
#endif
2021-04-01 14:06:56 +02:00
2022-01-17 13:48:55 +01:00
spiCookie =
new SpiCookie(addresses::MGM_2_LIS3, gpioIds::MGM_2_LIS3_CS, spiDev,
MGMLIS3MDL::MAX_BUFFER_SIZE, spi::DEFAULT_LIS3_MODE, spi::DEFAULT_LIS3_SPEED);
2022-03-04 16:03:57 +01:00
mgmLis3Handler = new MgmLIS3MDLHandler(objects::MGM_2_LIS3_HANDLER, objects::SPI_COM_IF,
spiCookie, spi::LIS3_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::MGM_2_LIS3_HANDLER);
mgmLis3Handler->setCustomFdir(fdir);
mgmLis3Handler->setParent(objects::ACS_BOARD_ASS);
2022-03-04 16:03:57 +01:00
static_cast<void>(mgmLis3Handler);
2022-02-23 19:26:02 +01:00
#if OBSW_TEST_ACS == 1
2022-03-04 16:03:57 +01:00
mgmLis3Handler->setStartUpImmediately();
mgmLis3Handler->setToGoToNormalMode(true);
2022-03-04 18:12:16 +01:00
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_ACS == 1
2022-03-04 16:03:57 +01:00
mgmLis3Handler->enablePeriodicPrintouts(true, 10);
2022-02-23 19:26:02 +01:00
#endif
2022-01-17 13:48:55 +01:00
spiCookie =
new SpiCookie(addresses::MGM_3_RM3100, gpioIds::MGM_3_RM3100_CS, spiDev,
RM3100::MAX_BUFFER_SIZE, spi::DEFAULT_RM3100_MODE, spi::DEFAULT_RM3100_SPEED);
mgmRm3100Handler = new MgmRM3100Handler(objects::MGM_3_RM3100_HANDLER, objects::SPI_COM_IF,
spiCookie, spi::RM3100_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::MGM_3_RM3100_HANDLER);
mgmRm3100Handler->setCustomFdir(fdir);
mgmRm3100Handler->setParent(objects::ACS_BOARD_ASS);
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-04 18:12:16 +01:00
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_ACS == 1
mgmRm3100Handler->enablePeriodicPrintouts(true, 10);
#endif
2021-04-29 17:45:19 +02:00
2022-01-17 13:48:55 +01:00
// Commented until ACS board V2 in in clean room again
// Gyro 0 Side A
spiCookie = new SpiCookie(addresses::GYRO_0_ADIS, gpioIds::GYRO_0_ADIS_CS, spiDev,
ADIS1650X::MAXIMUM_REPLY_SIZE, spi::DEFAULT_ADIS16507_MODE,
spi::DEFAULT_ADIS16507_SPEED);
auto adisHandler = new GyroADIS1650XHandler(objects::GYRO_0_ADIS_HANDLER, objects::SPI_COM_IF,
spiCookie, ADIS1650X::Type::ADIS16505);
fdir = new AcsBoardFdir(objects::GYRO_0_ADIS_HANDLER);
adisHandler->setCustomFdir(fdir);
adisHandler->setParent(objects::ACS_BOARD_ASS);
2022-03-04 16:03:57 +01:00
static_cast<void>(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-04 18:12:16 +01:00
#endif
2022-02-23 19:26:02 +01:00
#if OBSW_DEBUG_ACS == 1
adisHandler->enablePeriodicPrintouts(true, 10);
2022-01-19 14:08:30 +01:00
#endif
2022-01-17 13:48:55 +01:00
// Gyro 1 Side A
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, spi::L3G_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::GYRO_1_L3G_HANDLER);
gyroL3gHandler->setCustomFdir(fdir);
gyroL3gHandler->setParent(objects::ACS_BOARD_ASS);
2022-03-04 16:03:57 +01:00
static_cast<void>(gyroL3gHandler);
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-03-17 10:04:51 +01:00
2022-01-17 13:48:55 +01:00
// Gyro 2 Side B
spiCookie = new SpiCookie(addresses::GYRO_2_ADIS, gpioIds::GYRO_2_ADIS_CS, spiDev,
ADIS1650X::MAXIMUM_REPLY_SIZE, spi::DEFAULT_ADIS16507_MODE,
spi::DEFAULT_ADIS16507_SPEED);
adisHandler = new GyroADIS1650XHandler(objects::GYRO_2_ADIS_HANDLER, objects::SPI_COM_IF,
spiCookie, ADIS1650X::Type::ADIS16505);
fdir = new AcsBoardFdir(objects::GYRO_2_ADIS_HANDLER);
adisHandler->setCustomFdir(fdir);
adisHandler->setParent(objects::ACS_BOARD_ASS);
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
spiCookie =
new SpiCookie(addresses::GYRO_3_L3G, gpioIds::GYRO_3_L3G_CS, spiDev, L3GD20H::MAX_BUFFER_SIZE,
spi::DEFAULT_L3G_MODE, spi::DEFAULT_L3G_SPEED);
gyroL3gHandler = new GyroHandlerL3GD20H(objects::GYRO_3_L3G_HANDLER, objects::SPI_COM_IF,
spiCookie, spi::L3G_TRANSITION_DELAY);
fdir = new AcsBoardFdir(objects::GYRO_3_L3G_HANDLER);
gyroL3gHandler->setCustomFdir(fdir);
gyroL3gHandler->setParent(objects::ACS_BOARD_ASS);
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
2021-08-17 17:11:59 +02:00
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-01-17 13:48:55 +01:00
resetArgsGnss1.gnss1 = true;
resetArgsGnss1.gpioComIF = gpioComIF;
resetArgsGnss1.waitPeriodMs = 100;
resetArgsGnss0.gnss1 = false;
resetArgsGnss0.gpioComIF = gpioComIF;
resetArgsGnss0.waitPeriodMs = 100;
2022-02-01 11:17:00 +01:00
auto gpsHandler0 =
new GPSHyperionLinuxController(objects::GPS_CONTROLLER, objects::NO_OBJECT, debugGps);
2022-01-17 13:48:55 +01:00
gpsHandler0->setResetPinTriggerFunction(gps::triggerGpioResetPin, &resetArgsGnss0);
2022-03-04 16:03:57 +01:00
AcsBoardHelper acsBoardHelper = AcsBoardHelper(
objects::MGM_0_LIS3_HANDLER, objects::MGM_1_RM3100_HANDLER, objects::MGM_2_LIS3_HANDLER,
objects::MGM_3_RM3100_HANDLER, objects::GYRO_0_ADIS_HANDLER, objects::GYRO_1_L3G_HANDLER,
objects::GYRO_2_ADIS_HANDLER, objects::GYRO_3_L3G_HANDLER, objects::GPS_CONTROLLER);
auto acsAss = new AcsBoardAssembly(objects::ACS_BOARD_ASS, objects::NO_OBJECT, pwrSwitcher,
acsBoardHelper, gpioComIF);
static_cast<void>(acsAss);
#if OBSW_TEST_ACS_BOARD_ASS == 1
2022-03-04 18:12:16 +01:00
CommandMessage msg;
ModeMessage::setModeMessage(&msg, ModeMessage::CMD_MODE_COMMAND, DeviceHandlerIF::MODE_NORMAL,
duallane::A_SIDE);
2022-03-04 18:12:16 +01:00
ReturnValue_t result = MessageQueueSenderIF::sendMessage(acsAss->getCommandQueue(), &msg);
if (result != HasReturnvaluesIF::RETURN_OK) {
sif::warning << "Sending mode command failed" << std::endl;
}
#endif
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() {
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);
new HeaterHandler(objects::HEATER_HANDLER, objects::GPIO_IF, heaterGpiosCookie,
objects::PCDU_HANDLER, pcduSwitches::Switches::PDU2_CH3_TCS_BOARD_HEATER_IN_8V);
2021-07-19 12:44:43 +02:00
}
2021-02-16 15:32:24 +01:00
2021-07-19 12:44:43 +02:00
void ObjectFactory::createSolarArrayDeploymentComponents() {
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);
// 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::Switches::PDU2_CH5_DEPLOYMENT_MECHANISM_8V,
gpioIds::DEPLSA1, gpioIds::DEPLSA2, 1000);
2021-07-19 12:44:43 +02:00
}
2021-02-22 09:24:42 +01:00
2021-07-19 12:44:43 +02:00
void ObjectFactory::createSyrlinksComponents() {
2022-01-17 13:48:55 +01:00
UartCookie* syrlinksUartCookie =
new UartCookie(objects::SYRLINKS_HK_HANDLER, q7s::UART_SYRLINKS_DEV, UartModes::NON_CANONICAL,
uart::SYRLINKS_BAUD, SYRLINKS::MAX_REPLY_SIZE);
syrlinksUartCookie->setParityEven();
2021-02-22 09:24:42 +01:00
2022-01-17 13:48:55 +01:00
new SyrlinksHkHandler(objects::SYRLINKS_HK_HANDLER, objects::UART_COM_IF, syrlinksUartCookie);
2021-07-19 12:44:43 +02:00
}
2021-02-22 09:24:42 +01:00
2022-01-17 13:48:55 +01:00
void ObjectFactory::createRtdComponents(LinuxLibgpioIF* gpioComIF) {
2022-02-28 15:47:34 +01:00
using namespace gpio;
2022-01-17 13:48:55 +01:00
GpioCookie* rtdGpioCookie = new GpioCookie;
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc0 = new GpioCallback("Chip select RTD IC0", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_3, gpioRtdIc0);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc1 = new GpioCallback("Chip select RTD IC1", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_4, gpioRtdIc1);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc2 = new GpioCallback("Chip select RTD IC2", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_5, gpioRtdIc2);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc3 = new GpioCallback("Chip select RTD IC3", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_6, gpioRtdIc3);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc4 = new GpioCallback("Chip select RTD IC4", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_7, gpioRtdIc4);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc5 = new GpioCallback("Chip select RTD IC5", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_8, gpioRtdIc5);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc6 = new GpioCallback("Chip select RTD IC6", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_9, gpioRtdIc6);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc7 = new GpioCallback("Chip select RTD IC7", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_10, gpioRtdIc7);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc8 = new GpioCallback("Chip select RTD IC8", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_11, gpioRtdIc8);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc9 = new GpioCallback("Chip select RTD IC9", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_12, gpioRtdIc9);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc10 = new GpioCallback("Chip select RTD IC10", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_13, gpioRtdIc10);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc11 = new GpioCallback("Chip select RTD IC11", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_14, gpioRtdIc11);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc12 = new GpioCallback("Chip select RTD IC12", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_15, gpioRtdIc12);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc13 = new GpioCallback("Chip select RTD IC13", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_16, gpioRtdIc13);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc14 = new GpioCallback("Chip select RTD IC14", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_17, gpioRtdIc14);
2022-02-28 15:47:34 +01:00
GpioCallback* gpioRtdIc15 = new GpioCallback("Chip select RTD IC15", Direction::OUT, Levels::HIGH,
2022-01-17 13:48:55 +01:00
&gpioCallbacks::spiCsDecoderCallback, gpioComIF);
rtdGpioCookie->addGpio(gpioIds::RTD_IC_18, gpioRtdIc15);
gpioComIF->addGpios(rtdGpioCookie);
2022-02-23 19:26:02 +01:00
#if OBSW_ADD_RTD_DEVICES == 1
2022-01-17 13:48:55 +01:00
SpiCookie* spiRtdIc0 =
new SpiCookie(addresses::RTD_IC_3, gpioIds::RTD_IC_3, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc1 =
new SpiCookie(addresses::RTD_IC_4, gpioIds::RTD_IC_4, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc2 =
new SpiCookie(addresses::RTD_IC_5, gpioIds::RTD_IC_5, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc3 =
new SpiCookie(addresses::RTD_IC_6, gpioIds::RTD_IC_6, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc4 =
new SpiCookie(addresses::RTD_IC_7, gpioIds::RTD_IC_7, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc5 =
new SpiCookie(addresses::RTD_IC_8, gpioIds::RTD_IC_8, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc6 =
new SpiCookie(addresses::RTD_IC_9, gpioIds::RTD_IC_9, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc7 =
new SpiCookie(addresses::RTD_IC_10, gpioIds::RTD_IC_10, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc8 =
new SpiCookie(addresses::RTD_IC_11, gpioIds::RTD_IC_11, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc9 =
new SpiCookie(addresses::RTD_IC_12, gpioIds::RTD_IC_12, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc10 =
new SpiCookie(addresses::RTD_IC_13, gpioIds::RTD_IC_13, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc11 =
new SpiCookie(addresses::RTD_IC_14, gpioIds::RTD_IC_14, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc12 =
new SpiCookie(addresses::RTD_IC_15, gpioIds::RTD_IC_15, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc13 =
new SpiCookie(addresses::RTD_IC_16, gpioIds::RTD_IC_16, std::string(q7s::SPI_DEFAULT_DEV),
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc14 =
new SpiCookie(addresses::RTD_IC_17, gpioIds::RTD_IC_17, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
SpiCookie* spiRtdIc15 =
new SpiCookie(addresses::RTD_IC_18, gpioIds::RTD_IC_18, q7s::SPI_DEFAULT_DEV,
Max31865Definitions::MAX_REPLY_SIZE, spi::RTD_MODE, spi::RTD_SPEED);
Max31865PT1000Handler* rtdIc0 =
new Max31865PT1000Handler(objects::RTD_IC_3, objects::SPI_COM_IF, spiRtdIc0);
Max31865PT1000Handler* rtdIc1 =
new Max31865PT1000Handler(objects::RTD_IC_4, objects::SPI_COM_IF, spiRtdIc1);
Max31865PT1000Handler* rtdIc2 =
new Max31865PT1000Handler(objects::RTD_IC_5, objects::SPI_COM_IF, spiRtdIc2);
Max31865PT1000Handler* rtdIc3 =
new Max31865PT1000Handler(objects::RTD_IC_6, objects::SPI_COM_IF, spiRtdIc3);
Max31865PT1000Handler* rtdIc4 =
new Max31865PT1000Handler(objects::RTD_IC_7, objects::SPI_COM_IF, spiRtdIc4);
Max31865PT1000Handler* rtdIc5 =
new Max31865PT1000Handler(objects::RTD_IC_8, objects::SPI_COM_IF, spiRtdIc5);
Max31865PT1000Handler* rtdIc6 =
new Max31865PT1000Handler(objects::RTD_IC_9, objects::SPI_COM_IF, spiRtdIc6);
Max31865PT1000Handler* rtdIc7 =
new Max31865PT1000Handler(objects::RTD_IC_10, objects::SPI_COM_IF, spiRtdIc7);
Max31865PT1000Handler* rtdIc8 =
new Max31865PT1000Handler(objects::RTD_IC_11, objects::SPI_COM_IF, spiRtdIc8);
Max31865PT1000Handler* rtdIc9 =
new Max31865PT1000Handler(objects::RTD_IC_12, objects::SPI_COM_IF, spiRtdIc9);
Max31865PT1000Handler* rtdIc10 =
new Max31865PT1000Handler(objects::RTD_IC_13, objects::SPI_COM_IF, spiRtdIc10);
Max31865PT1000Handler* rtdIc11 =
new Max31865PT1000Handler(objects::RTD_IC_14, objects::SPI_COM_IF, spiRtdIc11);
Max31865PT1000Handler* rtdIc12 =
new Max31865PT1000Handler(objects::RTD_IC_15, objects::SPI_COM_IF, spiRtdIc12);
Max31865PT1000Handler* rtdIc13 =
new Max31865PT1000Handler(objects::RTD_IC_16, objects::SPI_COM_IF, spiRtdIc13);
Max31865PT1000Handler* rtdIc14 =
new Max31865PT1000Handler(objects::RTD_IC_17, objects::SPI_COM_IF, spiRtdIc14);
Max31865PT1000Handler* rtdIc15 =
new Max31865PT1000Handler(objects::RTD_IC_18, objects::SPI_COM_IF, spiRtdIc15);
2022-02-23 19:26:02 +01:00
#if OBSW_TEST_RTD == 1
2022-01-17 13:48:55 +01:00
rtdIc0->setStartUpImmediately();
rtdIc1->setStartUpImmediately();
rtdIc2->setStartUpImmediately();
2022-02-23 19:26:02 +01:00
rtdIc3->setStartUpImmediately();
rtdIc4->setStartUpImmediately();
rtdIc5->setStartUpImmediately();
rtdIc6->setStartUpImmediately();
rtdIc7->setStartUpImmediately();
rtdIc8->setStartUpImmediately();
rtdIc9->setStartUpImmediately();
rtdIc10->setStartUpImmediately();
rtdIc11->setStartUpImmediately();
rtdIc12->setStartUpImmediately();
rtdIc13->setStartUpImmediately();
rtdIc14->setStartUpImmediately();
rtdIc15->setStartUpImmediately();
2022-01-17 13:48:55 +01:00
rtdIc0->setInstantNormal(true);
rtdIc1->setInstantNormal(true);
rtdIc2->setInstantNormal(true);
2022-02-23 19:26:02 +01:00
rtdIc3->setInstantNormal(true);
rtdIc4->setInstantNormal(true);
rtdIc5->setInstantNormal(true);
rtdIc6->setInstantNormal(true);
rtdIc7->setInstantNormal(true);
rtdIc8->setInstantNormal(true);
rtdIc9->setInstantNormal(true);
rtdIc10->setInstantNormal(true);
rtdIc11->setInstantNormal(true);
rtdIc12->setInstantNormal(true);
rtdIc13->setInstantNormal(true);
rtdIc14->setInstantNormal(true);
rtdIc15->setInstantNormal(true);
2021-12-17 14:20:22 +01:00
#endif
2021-10-12 17:55:36 +02:00
2022-01-17 13:48:55 +01:00
static_cast<void>(rtdIc0);
static_cast<void>(rtdIc1);
static_cast<void>(rtdIc2);
static_cast<void>(rtdIc3);
static_cast<void>(rtdIc4);
static_cast<void>(rtdIc5);
static_cast<void>(rtdIc6);
static_cast<void>(rtdIc7);
static_cast<void>(rtdIc8);
static_cast<void>(rtdIc9);
static_cast<void>(rtdIc10);
static_cast<void>(rtdIc11);
static_cast<void>(rtdIc12);
static_cast<void>(rtdIc13);
static_cast<void>(rtdIc14);
static_cast<void>(rtdIc15);
2022-02-23 19:26:02 +01:00
#endif
2021-07-19 12:44:43 +02:00
}
2021-04-24 23:41:27 +02:00
2021-07-19 12:44:43 +02:00
void ObjectFactory::createReactionWheelComponents(LinuxLibgpioIF* gpioComIF) {
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);
gpioComIF->addGpios(gpioCookieRw);
2022-02-23 19:26:02 +01:00
#if OBSW_ADD_RW == 1
2022-01-17 13:48:55 +01:00
auto rw1SpiCookie =
new SpiCookie(addresses::RW1, gpioIds::CS_RW1, q7s::SPI_RW_DEV, RwDefinitions::MAX_REPLY_SIZE,
spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback::spiCallback, nullptr);
auto rw2SpiCookie =
new SpiCookie(addresses::RW2, gpioIds::CS_RW2, q7s::SPI_RW_DEV, RwDefinitions::MAX_REPLY_SIZE,
spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback::spiCallback, nullptr);
auto rw3SpiCookie =
new SpiCookie(addresses::RW3, gpioIds::CS_RW3, q7s::SPI_RW_DEV, RwDefinitions::MAX_REPLY_SIZE,
spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback::spiCallback, nullptr);
auto rw4SpiCookie =
new SpiCookie(addresses::RW4, gpioIds::CS_RW4, q7s::SPI_RW_DEV, RwDefinitions::MAX_REPLY_SIZE,
spi::RW_MODE, spi::RW_SPEED, &rwSpiCallback::spiCallback, nullptr);
auto rwHandler1 =
new RwHandler(objects::RW1, objects::SPI_COM_IF, rw1SpiCookie, gpioComIF, gpioIds::EN_RW1);
2021-09-23 15:35:33 +02:00
#if OBSW_DEBUG_RW == 1
2022-01-17 13:48:55 +01:00
rwHandler1->setStartUpImmediately();
2021-09-23 15:35:33 +02:00
#endif
2022-01-17 13:48:55 +01:00
rw1SpiCookie->setCallbackArgs(rwHandler1);
rwHandler1->setStartUpImmediately();
2021-05-02 13:48:39 +02:00
2022-01-17 13:48:55 +01:00
auto rwHandler2 =
new RwHandler(objects::RW2, objects::SPI_COM_IF, rw2SpiCookie, gpioComIF, gpioIds::EN_RW2);
2021-09-23 15:35:33 +02:00
#if OBSW_DEBUG_RW == 1
2022-01-17 13:48:55 +01:00
rwHandler2->setStartUpImmediately();
2021-09-23 15:35:33 +02:00
#endif
2022-01-17 13:48:55 +01:00
rw2SpiCookie->setCallbackArgs(rwHandler2);
2021-06-28 14:07:37 +02:00
2022-01-17 13:48:55 +01:00
auto rwHandler3 =
new RwHandler(objects::RW3, objects::SPI_COM_IF, rw3SpiCookie, gpioComIF, gpioIds::EN_RW3);
2021-09-23 15:35:33 +02:00
#if OBSW_DEBUG_RW == 1
2022-01-17 13:48:55 +01:00
rwHandler3->setStartUpImmediately();
2021-09-23 15:35:33 +02:00
#endif
2022-01-17 13:48:55 +01:00
rw3SpiCookie->setCallbackArgs(rwHandler3);
2021-06-29 09:50:50 +02:00
2022-01-17 13:48:55 +01:00
auto rwHandler4 =
new RwHandler(objects::RW4, objects::SPI_COM_IF, rw4SpiCookie, gpioComIF, gpioIds::EN_RW4);
2021-09-23 15:35:33 +02:00
#if OBSW_DEBUG_RW == 1
2022-01-17 13:48:55 +01:00
rwHandler4->setStartUpImmediately();
2021-09-23 15:35:33 +02:00
#endif
2022-01-17 13:48:55 +01:00
rw4SpiCookie->setCallbackArgs(rwHandler4);
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
2022-01-17 13:48:55 +01:00
void ObjectFactory::createCcsdsComponents(LinuxLibgpioIF* gpioComIF) {
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;
std::stringstream consumer;
consumer.str("PAPB VC0");
2022-01-17 13:48:55 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PAPB_BUSY_SIGNAL_VC0, consumer.str());
gpioCookiePtmeIp->addGpio(gpioIds::VC0_PAPB_BUSY, gpio);
consumer.str("PAPB VC0");
2022-01-17 13:48:55 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PAPB_EMPTY_SIGNAL_VC0, consumer.str());
gpioCookiePtmeIp->addGpio(gpioIds::VC0_PAPB_EMPTY, gpio);
consumer.str("PAPB VC 1");
2022-01-17 13:48:55 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PAPB_BUSY_SIGNAL_VC1, consumer.str());
gpioCookiePtmeIp->addGpio(gpioIds::VC1_PAPB_BUSY, gpio);
consumer.str("");
consumer.str("PAPB VC 1");
2022-01-17 13:48:55 +01:00
gpioCookiePtmeIp->addGpio(gpioIds::VC1_PAPB_EMPTY, gpio);
consumer.str("");
consumer.str("PAPB VC 2");
2022-01-17 13:48:55 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PAPB_BUSY_SIGNAL_VC2, consumer.str());
gpioCookiePtmeIp->addGpio(gpioIds::VC2_PAPB_BUSY, gpio);
consumer.str("");
consumer.str("PAPB VC 2");
2022-01-17 13:48:55 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PAPB_EMPTY_SIGNAL_VC2, consumer.str());
gpioCookiePtmeIp->addGpio(gpioIds::VC2_PAPB_EMPTY, gpio);
consumer.str("");
consumer.str("PAPB VC 3");
2022-01-17 13:48:55 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PAPB_BUSY_SIGNAL_VC3, consumer.str());
gpioCookiePtmeIp->addGpio(gpioIds::VC3_PAPB_BUSY, gpio);
consumer.str("");
consumer.str("PAPB VC 3");
2022-01-17 13:48:55 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PAPB_EMPTY_SIGNAL_VC3, consumer.str());
gpioCookiePtmeIp->addGpio(gpioIds::VC3_PAPB_EMPTY, gpio);
gpioComIF->addGpios(gpioCookiePtmeIp);
// Creating virtual channel interfaces
2022-01-24 16:33:22 +01:00
VcInterfaceIF* vc0 =
new PapbVcInterface(gpioComIF, gpioIds::VC0_PAPB_BUSY, gpioIds::VC0_PAPB_EMPTY, q7s::UIO_PTME,
q7s::uiomapids::PTME_VC0);
2022-01-24 16:33:22 +01:00
VcInterfaceIF* vc1 =
new PapbVcInterface(gpioComIF, gpioIds::VC1_PAPB_BUSY, gpioIds::VC1_PAPB_EMPTY, q7s::UIO_PTME,
q7s::uiomapids::PTME_VC1);
2022-01-24 16:33:22 +01:00
VcInterfaceIF* vc2 =
new PapbVcInterface(gpioComIF, gpioIds::VC2_PAPB_BUSY, gpioIds::VC2_PAPB_EMPTY, q7s::UIO_PTME,
q7s::uiomapids::PTME_VC2);
2022-01-24 16:33:22 +01:00
VcInterfaceIF* vc3 =
new PapbVcInterface(gpioComIF, gpioIds::VC3_PAPB_BUSY, 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);
2022-01-17 13:48:55 +01:00
CCSDSHandler* ccsdsHandler = new CCSDSHandler(
objects::CCSDS_HANDLER, objects::PTME, objects::CCSDS_PACKET_DISTRIBUTOR, ptmeConfig,
2022-01-17 13:48:55 +01:00
gpioComIF, gpioIds::RS485_EN_TX_CLOCK, gpioIds::RS485_EN_TX_DATA);
VirtualChannel* vc = nullptr;
2022-02-22 20:50:56 +01:00
vc = new VirtualChannel(ccsds::VC0, common::VC0_QUEUE_SIZE, objects::CCSDS_HANDLER);
2022-01-17 13:48:55 +01:00
ccsdsHandler->addVirtualChannel(ccsds::VC0, vc);
2022-02-22 20:50:56 +01:00
vc = new VirtualChannel(ccsds::VC1, common::VC1_QUEUE_SIZE, objects::CCSDS_HANDLER);
2022-01-17 13:48:55 +01:00
ccsdsHandler->addVirtualChannel(ccsds::VC1, vc);
2022-02-22 20:50:56 +01:00
vc = new VirtualChannel(ccsds::VC2, common::VC2_QUEUE_SIZE, objects::CCSDS_HANDLER);
2022-01-17 13:48:55 +01:00
ccsdsHandler->addVirtualChannel(ccsds::VC2, vc);
2022-02-22 20:50:56 +01:00
vc = new VirtualChannel(ccsds::VC3, common::VC3_QUEUE_SIZE, objects::CCSDS_HANDLER);
2022-01-17 13:48:55 +01:00
ccsdsHandler->addVirtualChannel(ccsds::VC3, vc);
GpioCookie* gpioCookiePdec = new GpioCookie;
consumer.str("");
consumer << "0x" << std::hex << objects::PDEC_HANDLER;
// GPIO also low after linux boot (specified by device-tree)
2022-02-28 15:47:34 +01:00
gpio = new GpiodRegularByLineName(q7s::gpioNames::PDEC_RESET, consumer.str(), Direction::OUT,
Levels::LOW);
2022-01-17 13:48:55 +01:00
gpioCookiePdec->addGpio(gpioIds::PDEC_RESET, gpio);
gpioComIF->addGpios(gpioCookiePdec);
new PdecHandler(objects::PDEC_HANDLER, objects::CCSDS_HANDLER, gpioComIF, gpioIds::PDEC_RESET,
q7s::UIO_PDEC_CONFIG_MEMORY, q7s::UIO_PDEC_RAM, q7s::UIO_PDEC_REGISTERS);
2021-11-01 12:41:20 +01:00
#if BOARD_TE0720 == 0
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);
gpioComIF->addGpios(gpioRS485Chip);
2021-11-01 12:41:20 +01:00
#endif /* BOARD_TE0720 == 0 */
2021-09-26 08:29:30 +02:00
}
2022-02-23 19:26:02 +01:00
void ObjectFactory::createPlPcduComponents(LinuxLibgpioIF* gpioComIF, SpiComIF* spiComIF) {
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);
gpioComIF->addGpios(plPcduGpios);
2022-03-04 15:26:36 +01:00
SpiCookie* spiCookie = new SpiCookie(addresses::PLPCDU_ADC, gpioIds::PLPCDU_ADC_CS,
q7s::SPI_DEFAULT_DEV, plpcdu::MAX_ADC_REPLY_SIZE,
spi::DEFAULT_MAX_1227_MODE, spi::PL_PCDU_MAX_1227_SPEED);
// Create device handler components
auto plPcduHandler =
new PayloadPcduHandler(objects::PLPCDU_HANDLER, objects::SPI_COM_IF, spiCookie, gpioComIF,
SdCardManager::instance(), false);
spiCookie->setCallbackMode(PayloadPcduHandler::extConvAsTwoCallback, plPcduHandler);
static_cast<void>(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);
plPcduHandler->enablePeriodicPrintout(true, 5);
#endif
2022-02-23 19:26:02 +01:00
}
2021-09-13 18:07:07 +02:00
void ObjectFactory::createTestComponents(LinuxLibgpioIF* gpioComIF) {
#if BOARD_TE0720 == 0
2022-01-17 13:48:55 +01:00
new Q7STestTask(objects::TEST_TASK);
#endif
2021-07-05 12:09:31 +02:00
2021-08-17 17:48:51 +02:00
#if BOARD_TE0720 == 1 && OBSW_TEST_LIBGPIOD == 1
2021-09-23 10:51:47 +02:00
#if OBSW_TEST_GPIO_OPEN_BYLABEL == 1
2022-01-17 13:48:55 +01:00
/* Configure MIO0 as input */
2022-02-28 15:47:34 +01:00
GpiodRegular* testGpio = new GpiodRegular("MIO0", Direction::OUT, 0, "/amba_pl/gpio@41200000", 0);
2021-09-23 10:51:47 +02:00
#elif OBSW_TEST_GPIO_OPEN_BY_LINE_NAME
2022-01-17 13:48:55 +01:00
GpiodRegularByLineName* testGpio =
2022-02-28 15:47:34 +01:00
new GpiodRegularByLineName("test-name", "gpio-test", Direction::OUT, 0);
2021-09-20 16:30:50 +02:00
#else
2022-01-17 13:48:55 +01:00
/* Configure MIO0 as input */
GpiodRegular* testGpio = new GpiodRegular("gpiochip0", 0, "MIO0", gpio::IN, 0);
2021-09-20 16:30:50 +02:00
#endif /* OBSW_TEST_GPIO_LABEL == 1 */
2022-01-17 13:48:55 +01:00
GpioCookie* gpioCookie = new GpioCookie;
gpioCookie->addGpio(gpioIds::TEST_ID_0, testGpio);
new LibgpiodTest(objects::LIBGPIOD_TEST, objects::GPIO_IF, gpioCookie);
#endif
2022-02-23 19:26:02 +01:00
#if BOARD_TE0720 == 1 && OBSW_TEST_SUS == 1
2022-01-17 13:48:55 +01:00
GpioCookie* gpioCookieSus = new GpioCookie;
GpiodRegular* chipSelectSus = new GpiodRegular(
2022-02-28 15:47:34 +01:00
std::string("gpiochip1"), 9, std::string("Chip Select Sus Sensor"), Direction::OUT, 1);
2022-02-23 19:26:02 +01:00
gpioCookieSus->addGpio(gpioIds::CS_SUS_0, chipSelectSus);
2022-01-17 13:48:55 +01:00
gpioComIF->addGpios(gpioCookieSus);
2022-01-17 13:48:55 +01:00
SpiCookie* spiCookieSus =
2022-02-23 19:26:02 +01:00
new SpiCookie(addresses::SUS_0, std::string("/dev/spidev1.0"), SUS::MAX_CMD_SIZE,
2022-01-17 13:48:55 +01:00
spi::DEFAULT_MAX_1227_MODE, spi::DEFAULT_MAX_1227_SPEED);
2022-02-23 19:26:02 +01:00
new SusHandler(objects::SUS_0, objects::SPI_COM_IF, spiCookieSus, gpioComIF, gpioIds::CS_SUS_0);
2021-05-16 19:22:04 +02:00
#endif
2021-08-17 17:48:51 +02:00
#if BOARD_TE0720 == 1 && OBSW_TEST_CCSDS_BRIDGE == 1
2022-01-17 13:48:55 +01:00
GpioCookie* gpioCookieCcsdsIp = new GpioCookie;
GpiodRegular* papbBusyN =
new GpiodRegular(std::string("gpiochip0"), 0, std::string("PAPBBusy_VC0"));
gpioCookieCcsdsIp->addGpio(gpioIds::PAPB_BUSY_N, papbBusyN);
GpiodRegular* papbEmpty =
new GpiodRegular(std::string("gpiochip0"), 1, std::string("PAPBEmpty_VC0"));
gpioCookieCcsdsIp->addGpio(gpioIds::PAPB_EMPTY, papbEmpty);
gpioComIF->addGpios(gpioCookieCcsdsIp);
new CCSDSIPCoreBridge(objects::CCSDS_IP_CORE_BRIDGE, objects::CCSDS_PACKET_DISTRIBUTOR,
objects::TM_STORE, objects::TC_STORE, gpioComIF, std::string("/dev/uio0"),
gpioIds::PAPB_BUSY_N, gpioIds::PAPB_EMPTY);
#endif
2022-02-23 19:26:02 +01:00
#if BOARD_TE0720 == 1 && OBSW_TEST_RAD_SENSOR == 1
2022-01-17 13:48:55 +01:00
GpioCookie* gpioCookieRadSensor = new GpioCookie;
GpiodRegular* chipSelectRadSensor = new GpiodRegular(
2022-02-28 15:47:34 +01:00
std::string("gpiochip1"), 0, std::string("Chip select radiation sensor"), Direction::OUT, 1);
2022-01-17 13:48:55 +01:00
gpioCookieRadSensor->addGpio(gpioIds::CS_RAD_SENSOR, chipSelectRadSensor);
gpioComIF->addGpios(gpioCookieRadSensor);
SpiCookie* spiCookieRadSensor =
new SpiCookie(addresses::RAD_SENSOR, gpioIds::CS_RAD_SENSOR, std::string("/dev/spidev1.0"),
SUS::MAX_CMD_SIZE, spi::DEFAULT_MAX_1227_MODE, spi::DEFAULT_MAX_1227_SPEED);
RadiationSensorHandler* radSensor =
new RadiationSensorHandler(objects::RAD_SENSOR, objects::SPI_COM_IF, spiCookieRadSensor);
radSensor->setStartUpImmediately();
#endif
2021-04-11 12:04:13 +02:00
2021-08-17 17:48:51 +02:00
#if BOARD_TE0720 == 1 && OBSW_ADD_PLOC_MPSOC == 1
2022-01-17 13:48:55 +01:00
UartCookie* plocUartCookie =
new UartCookie(std::string("/dev/ttyPS1"), 115200, PLOC_MPSOC::MAX_REPLY_SIZE);
/* Testing PlocMPSoCHandler on TE0720-03-1CFA */
PlocMPSoCHandler* mpsocPlocHandler =
new PlocMPSoCHandler(objects::PLOC_MPSOC_HANDLER, objects::UART_COM_IF, plocUartCookie);
mpsocPlocHandler->setStartUpImmediately();
2021-02-14 09:25:40 +01:00
#endif
2021-08-17 17:48:51 +02:00
#if BOARD_TE0720 == 1 && OBSW_TEST_TE7020_HEATER == 1
2022-01-17 13:48:55 +01:00
/* Configuration for MIO0 on TE0720-03-1CFA */
GpiodRegular* heaterGpio =
new GpiodRegular(std::string("gpiochip0"), 0, std::string("MIO0"), gpio::IN, 0);
GpioCookie* gpioCookie = new GpioCookie;
gpioCookie->addGpio(gpioIds::HEATER_0, heaterGpio);
new HeaterHandler(objects::HEATER_HANDLER, objects::GPIO_IF, gpioCookie, objects::PCDU_HANDLER,
pcduSwitches::TCS_BOARD_8V_HEATER_IN);
2021-04-27 17:34:50 +02:00
#endif
2021-08-17 17:48:51 +02:00
#if BOARD_TE0720 == 1 && OBSW_ADD_PLOC_SUPERVISOR == 1
2022-01-17 13:48:55 +01:00
/* Configuration for MIO0 on TE0720-03-1CFA */
UartCookie* plocSupervisorCookie =
new UartCookie(objects::PLOC_SUPERVISOR_HANDLER, std::string("/dev/ttyPS1"),
UartModes::NON_CANONICAL, 115200, PLOC_SPV::MAX_PACKET_SIZE * 20);
plocSupervisorCookie->setNoFixedSizeReply();
PlocSupervisorHandler* plocSupervisor = new PlocSupervisorHandler(
objects::PLOC_SUPERVISOR_HANDLER, objects::UART_COM_IF, plocSupervisorCookie);
plocSupervisor->setStartUpImmediately();
#endif
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_DEFAULT_DEV);
#endif
2022-02-04 17:48:05 +01:00
#if OBSW_ADD_UART_TEST_CODE == 1
new UartTestClass(objects::UART_TEST);
#endif
2020-09-30 17:17:01 +02:00
}