WIP: SCEX Init #272
@ -229,14 +229,13 @@ void initmission::createTestTasks(TaskFactory& factory,
|
|||||||
initmission::printAddObjectError("UART_TEST", objects::UART_TEST);
|
initmission::printAddObjectError("UART_TEST", objects::UART_TEST);
|
||||||
}
|
}
|
||||||
PeriodicTaskIF* scexReaderTask = factory.createPeriodicTask(
|
PeriodicTaskIF* scexReaderTask = factory.createPeriodicTask(
|
||||||
"SCEX_UART_READER", 20, PeriodicTaskIF::MINIMUM_STACK_SIZE, 2.0, missedDeadlineFunc);
|
"SCEX_UART_READER", 20, PeriodicTaskIF::MINIMUM_STACK_SIZE, 2.0, missedDeadlineFunc);
|
||||||
result = scexReaderTask->addComponent(objects::SCEX_UART_READER);
|
result = scexReaderTask->addComponent(objects::SCEX_UART_READER);
|
||||||
if (result != HasReturnvaluesIF::RETURN_OK) {
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||||||
initmission::printAddObjectError("SCEX_UART_READER", objects::SCEX_UART_READER);
|
initmission::printAddObjectError("SCEX_UART_READER", objects::SCEX_UART_READER);
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif /* RPI_ADD_GPIO_TEST == 1 */
|
|
||||||
taskVec.push_back(scexReaderTask);
|
taskVec.push_back(scexReaderTask);
|
||||||
|
#endif /* RPI_ADD_GPIO_TEST == 1 */
|
||||||
taskVec.push_back(testTask);
|
taskVec.push_back(testTask);
|
||||||
|
|
||||||
bool startTestPst = true;
|
bool startTestPst = true;
|
||||||
|
@ -1,6 +1,7 @@
|
|||||||
#include <linux/devices/ScexUartReader.h>
|
|
||||||
#include "ObjectFactory.h"
|
#include "ObjectFactory.h"
|
||||||
|
|
||||||
|
#include <linux/devices/ScexUartReader.h>
|
||||||
|
|
||||||
#include "OBSWConfig.h"
|
#include "OBSWConfig.h"
|
||||||
#include "devConf.h"
|
#include "devConf.h"
|
||||||
#include "devices/addresses.h"
|
#include "devices/addresses.h"
|
||||||
@ -198,8 +199,8 @@ void ObjectFactory::createTestTasks() {
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if OBSW_ADD_UART_TEST_CODE == 1
|
#if OBSW_ADD_UART_TEST_CODE == 1
|
||||||
new ScexUartReader(objects::SCEX_UART_READER);
|
auto scexReader = new ScexUartReader(objects::SCEX_UART_READER);
|
||||||
new UartTestClass(objects::UART_TEST);
|
new UartTestClass(objects::UART_TEST, scexReader);
|
||||||
#else
|
#else
|
||||||
new UartComIF(objects::UART_COM_IF);
|
new UartComIF(objects::UART_COM_IF);
|
||||||
#endif
|
#endif
|
||||||
|
@ -3,6 +3,8 @@
|
|||||||
#include <errno.h> // Error integer and strerror() function
|
#include <errno.h> // Error integer and strerror() function
|
||||||
#include <fcntl.h> // Contains file controls like O_RDWR
|
#include <fcntl.h> // Contains file controls like O_RDWR
|
||||||
#include <fsfw/tasks/TaskFactory.h>
|
#include <fsfw/tasks/TaskFactory.h>
|
||||||
|
#include <fsfw_hal/linux/uart/UartCookie.h>
|
||||||
|
#include <linux/devices/ScexUartReader.h>
|
||||||
#include <unistd.h> // write(), read(), close()
|
#include <unistd.h> // write(), read(), close()
|
||||||
|
|
||||||
#include "OBSWConfig.h"
|
#include "OBSWConfig.h"
|
||||||
@ -18,7 +20,11 @@
|
|||||||
#define RPI_TEST_GPS_HANDLER 0
|
#define RPI_TEST_GPS_HANDLER 0
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
UartTestClass::UartTestClass(object_id_t objectId) : TestTask(objectId) { mode = TestModes::SCEX; }
|
UartTestClass::UartTestClass(object_id_t objectId, ScexUartReader* reader)
|
||||||
|
: TestTask(objectId), reader(reader) {
|
||||||
|
mode = TestModes::SCEX;
|
||||||
|
scexMode = ScexModes::READER_TASK;
|
||||||
|
}
|
||||||
|
|
||||||
ReturnValue_t UartTestClass::initialize() {
|
ReturnValue_t UartTestClass::initialize() {
|
||||||
if (mode == TestModes::GPS) {
|
if (mode == TestModes::GPS) {
|
||||||
@ -127,100 +133,129 @@ void UartTestClass::gpsPeriodic() {
|
|||||||
}
|
}
|
||||||
|
|
||||||
void UartTestClass::scexInit() {
|
void UartTestClass::scexInit() {
|
||||||
#if defined(RASPBERRY_PI)
|
if (reader == nullptr) {
|
||||||
std::string devname = "/dev/serial0";
|
sif::warning << "UartTestClass::scexInit: Reader invalid" << std::endl;
|
||||||
#else
|
|
||||||
std::string devname = "/dev/ul-scex";
|
|
||||||
#endif
|
|
||||||
/* Get file descriptor */
|
|
||||||
serialPort = open(devname.c_str(), O_RDWR);
|
|
||||||
if (serialPort < 0) {
|
|
||||||
sif::warning << "open call failed with error [" << errno << ", " << strerror(errno)
|
|
||||||
<< std::endl;
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
// Setting up UART parameters
|
if (scexMode == ScexModes::SIMPLE) {
|
||||||
tty.c_cflag &= ~PARENB; // Clear parity bit
|
#if defined(RASPBERRY_PI)
|
||||||
tty.c_cflag &= ~CSTOPB; // Clear stop field, only one stop bit used in communication
|
std::string devname = "/dev/serial0";
|
||||||
tty.c_cflag &= ~CSIZE; // Clear all the size bits
|
#else
|
||||||
tty.c_cflag |= CS8; // 8 bits per byte
|
std::string devname = "/dev/ul-scex";
|
||||||
tty.c_cflag &= ~CRTSCTS; // Disable RTS/CTS hardware flow control
|
#endif
|
||||||
tty.c_cflag |= CREAD | CLOCAL; // Turn on READ & ignore ctrl lines (CLOCAL = 1)
|
/* Get file descriptor */
|
||||||
|
serialPort = open(devname.c_str(), O_RDWR);
|
||||||
|
if (serialPort < 0) {
|
||||||
|
sif::warning << "open call failed with error [" << errno << ", " << strerror(errno)
|
||||||
|
<< std::endl;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
// Setting up UART parameters
|
||||||
|
tty.c_cflag &= ~PARENB; // Clear parity bit
|
||||||
|
tty.c_cflag &= ~CSTOPB; // Clear stop field, only one stop bit used in communication
|
||||||
|
tty.c_cflag &= ~CSIZE; // Clear all the size bits
|
||||||
|
tty.c_cflag |= CS8; // 8 bits per byte
|
||||||
|
tty.c_cflag &= ~CRTSCTS; // Disable RTS/CTS hardware flow control
|
||||||
|
tty.c_cflag |= CREAD | CLOCAL; // Turn on READ & ignore ctrl lines (CLOCAL = 1)
|
||||||
|
|
||||||
// Use non-canonical mode and clear echo flag
|
// Use non-canonical mode and clear echo flag
|
||||||
tty.c_lflag &= ~(ICANON | ECHO);
|
tty.c_lflag &= ~(ICANON | ECHO);
|
||||||
|
|
||||||
// Non-blocking mode, read until either line is 0.1 second idle or maximum of 255 bytes are
|
// Non-blocking mode, read until either line is 0.1 second idle or maximum of 255 bytes are
|
||||||
// received in one go
|
// received in one go
|
||||||
tty.c_cc[VTIME] = 1; // In units of 0.1 seconds
|
tty.c_cc[VTIME] = 1; // In units of 0.1 seconds
|
||||||
tty.c_cc[VMIN] = 255; // Read up to 255 bytes
|
tty.c_cc[VMIN] = 255; // Read up to 255 bytes
|
||||||
|
|
||||||
// Q7S UART Lite has fixed baud rate. For other linux systems, set baud rate here.
|
// Q7S UART Lite has fixed baud rate. For other linux systems, set baud rate here.
|
||||||
#if !defined(XIPHOS_Q7S)
|
#if !defined(XIPHOS_Q7S)
|
||||||
if (cfsetispeed(&tty, B57600) != 0) {
|
if (cfsetispeed(&tty, B57600) != 0) {
|
||||||
sif::warning << "UartTestClass::scexInit: Setting baud rate failed" << std::endl;
|
sif::warning << "UartTestClass::scexInit: Setting baud rate failed" << std::endl;
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
if (tcsetattr(serialPort, TCSANOW, &tty) != 0) {
|
if (tcsetattr(serialPort, TCSANOW, &tty) != 0) {
|
||||||
sif::warning << "tcsetattr call failed with error [" << errno << ", " << strerror(errno)
|
sif::warning << "tcsetattr call failed with error [" << errno << ", " << strerror(errno)
|
||||||
<< std::endl;
|
<< std::endl;
|
||||||
|
}
|
||||||
|
// Flush received and unread data
|
||||||
|
tcflush(serialPort, TCIFLUSH);
|
||||||
|
} else {
|
||||||
|
#if defined(RASPBERRY_PI)
|
||||||
|
std::string devname = "/dev/serial0";
|
||||||
|
#else
|
||||||
|
std::string devname = "/dev/ul-scex";
|
||||||
|
#endif
|
||||||
|
uartCookie =
|
||||||
|
new UartCookie(this->getObjectId(), devname, UartModes::NON_CANONICAL, 57600, 4096);
|
||||||
|
reader->setDebugMode(true);
|
||||||
|
ReturnValue_t result = reader->initializeInterface(uartCookie);
|
||||||
}
|
}
|
||||||
// Flush received and unread data
|
|
||||||
tcflush(serialPort, TCIFLUSH);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void UartTestClass::scexPeriodic() {
|
void UartTestClass::scexPeriodic() {
|
||||||
sif::info << "UartTestClass::scexInit: Sending ping command to SCEX" << std::endl;
|
if (reader == nullptr) {
|
||||||
int result = prepareScexPing();
|
|
||||||
if (result != 0) {
|
|
||||||
return;
|
return;
|
||||||
};
|
|
||||||
size_t bytesWritten = write(serialPort, cmdBuf.data(), encodedLen);
|
|
||||||
if (bytesWritten != encodedLen) {
|
|
||||||
sif::warning << "Sending ping command to solar experiment failed" << std::endl;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// Read back reply immediately
|
if (scexMode == ScexModes::SIMPLE) {
|
||||||
int bytesRead = 0;
|
sif::info << "UartTestClass::scexInit: Sending ping command to SCEX" << std::endl;
|
||||||
do {
|
// reader->sendMessage(nullptr, nullptr, 0);
|
||||||
bytesRead = read(serialPort, reinterpret_cast<void*>(recBuf.data()),
|
uint8_t tmpCmdBuf[32] = {};
|
||||||
static_cast<unsigned int>(recBuf.size()));
|
size_t len = 0;
|
||||||
if (bytesRead < 0) {
|
prepareScexPing(tmpCmdBuf, &len);
|
||||||
sif::warning << "UartTestClass::performPeriodicAction: read call failed with error [" << errno
|
ReturnValue_t result =
|
||||||
<< ", " << strerror(errno) << "]" << std::endl;
|
dleEncoder.encode(tmpCmdBuf, len, cmdBuf.data(), cmdBuf.size(), &encodedLen, true);
|
||||||
break;
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||||||
} else if (bytesRead >= static_cast<int>(recBuf.size())) {
|
sif::warning << "UartTestClass::scexInit: Encoding failed" << std::endl;
|
||||||
sif::debug << "UartTestClass::performPeriodicAction: recv buffer might not be large enough"
|
return;
|
||||||
<< std::endl;
|
|
||||||
} else if (bytesRead > 0) {
|
|
||||||
sif::info << "Received " << bytesRead
|
|
||||||
<< " bytes from the Solar Cell Experiment:" << std::endl;
|
|
||||||
arrayprinter::print(recBuf.data(), bytesRead, OutputType::HEX, false);
|
|
||||||
break;
|
|
||||||
}
|
}
|
||||||
} while (bytesRead > 0);
|
if (result != 0) {
|
||||||
|
return;
|
||||||
|
};
|
||||||
|
size_t bytesWritten = write(serialPort, cmdBuf.data(), encodedLen);
|
||||||
|
if (bytesWritten != encodedLen) {
|
||||||
|
sif::warning << "Sending ping command to solar experiment failed" << std::endl;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Read back reply immediately
|
||||||
|
int bytesRead = 0;
|
||||||
|
do {
|
||||||
|
bytesRead = read(serialPort, reinterpret_cast<void*>(recBuf.data()),
|
||||||
|
static_cast<unsigned int>(recBuf.size()));
|
||||||
|
if (bytesRead < 0) {
|
||||||
|
sif::warning << "UartTestClass::performPeriodicAction: read call failed with error ["
|
||||||
|
<< errno << ", " << strerror(errno) << "]" << std::endl;
|
||||||
|
break;
|
||||||
|
} else if (bytesRead >= static_cast<int>(recBuf.size())) {
|
||||||
|
sif::debug << "UartTestClass::performPeriodicAction: recv buffer might not be large enough"
|
||||||
|
<< std::endl;
|
||||||
|
} else if (bytesRead > 0) {
|
||||||
|
sif::info << "Received " << bytesRead
|
||||||
|
<< " bytes from the Solar Cell Experiment:" << std::endl;
|
||||||
|
arrayprinter::print(recBuf.data(), bytesRead, OutputType::HEX, false);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
} while (bytesRead > 0);
|
||||||
|
} else {
|
||||||
|
size_t len = 0;
|
||||||
|
prepareScexPing(cmdBuf.data(), &len);
|
||||||
|
reader->sendMessage(uartCookie, cmdBuf.data(), len);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
int UartTestClass::prepareScexPing() {
|
int UartTestClass::prepareScexPing(uint8_t* cmdBuf, size_t* len) {
|
||||||
std::array<uint8_t, 128> tmpCmdBuf = {};
|
|
||||||
// Send ping command
|
// Send ping command
|
||||||
tmpCmdBuf[0] = scex::CMD_PING;
|
cmdBuf[0] = scex::CMD_PING;
|
||||||
// These two fields are the packet counter and the total packet count. Those are 1 and 1 for each
|
// These two fields are the packet counter and the total packet count. Those are 1 and 1 for each
|
||||||
// telecommand so far
|
// telecommand so far
|
||||||
tmpCmdBuf[1] = 1;
|
cmdBuf[1] = 1;
|
||||||
tmpCmdBuf[2] = 1;
|
cmdBuf[2] = 1;
|
||||||
uint16_t userDataLen = 0;
|
uint16_t userDataLen = 0;
|
||||||
tmpCmdBuf[3] = (userDataLen >> 8) & 0xff;
|
cmdBuf[3] = (userDataLen >> 8) & 0xff;
|
||||||
tmpCmdBuf[4] = userDataLen & 0xff;
|
cmdBuf[4] = userDataLen & 0xff;
|
||||||
uint16_t crc = CRC::crc16ccitt(tmpCmdBuf.data(), 5);
|
uint16_t crc = CRC::crc16ccitt(cmdBuf, 5);
|
||||||
tmpCmdBuf[5] = (crc >> 8) & 0xff;
|
cmdBuf[5] = (crc >> 8) & 0xff;
|
||||||
tmpCmdBuf[6] = crc & 0xff;
|
cmdBuf[6] = crc & 0xff;
|
||||||
ReturnValue_t result =
|
*len = 7;
|
||||||
dleEncoder.encode(tmpCmdBuf.data(), 7, cmdBuf.data(), cmdBuf.size(), &encodedLen, true);
|
|
||||||
if (result != HasReturnvaluesIF::RETURN_OK) {
|
|
||||||
sif::warning << "UartTestClass::scexInit: Encoding failed" << std::endl;
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@ -2,6 +2,7 @@
|
|||||||
#define LINUX_BOARDTEST_UARTTESTCLASS_H_
|
#define LINUX_BOARDTEST_UARTTESTCLASS_H_
|
||||||
|
|
||||||
#include <fsfw/globalfunctions/DleEncoder.h>
|
#include <fsfw/globalfunctions/DleEncoder.h>
|
||||||
|
#include <fsfw_hal/linux/uart/UartCookie.h>
|
||||||
#include <termios.h> // Contains POSIX terminal control definitions
|
#include <termios.h> // Contains POSIX terminal control definitions
|
||||||
|
|
||||||
#include <array>
|
#include <array>
|
||||||
@ -9,9 +10,11 @@
|
|||||||
#include "lwgps/lwgps.h"
|
#include "lwgps/lwgps.h"
|
||||||
#include "test/testtasks/TestTask.h"
|
#include "test/testtasks/TestTask.h"
|
||||||
|
|
||||||
|
class ScexUartReader;
|
||||||
|
|
||||||
class UartTestClass : public TestTask {
|
class UartTestClass : public TestTask {
|
||||||
public:
|
public:
|
||||||
UartTestClass(object_id_t objectId);
|
UartTestClass(object_id_t objectId, ScexUartReader* reader);
|
||||||
|
|
||||||
ReturnValue_t initialize() override;
|
ReturnValue_t initialize() override;
|
||||||
ReturnValue_t performOneShotAction() override;
|
ReturnValue_t performOneShotAction() override;
|
||||||
@ -24,14 +27,17 @@ class UartTestClass : public TestTask {
|
|||||||
SCEX
|
SCEX
|
||||||
};
|
};
|
||||||
|
|
||||||
|
enum ScexModes { SIMPLE, READER_TASK } scexMode;
|
||||||
|
|
||||||
void gpsInit();
|
void gpsInit();
|
||||||
void gpsPeriodic();
|
void gpsPeriodic();
|
||||||
|
|
||||||
void scexInit();
|
void scexInit();
|
||||||
void scexPeriodic();
|
void scexPeriodic();
|
||||||
int prepareScexPing();
|
int prepareScexPing(uint8_t* cmdBuf, size_t* len);
|
||||||
TestModes mode = TestModes::GPS;
|
TestModes mode = TestModes::GPS;
|
||||||
DleEncoder dleEncoder = DleEncoder();
|
DleEncoder dleEncoder = DleEncoder();
|
||||||
|
UartCookie* uartCookie = nullptr;
|
||||||
size_t encodedLen = 0;
|
size_t encodedLen = 0;
|
||||||
lwgps_t gpsData = {};
|
lwgps_t gpsData = {};
|
||||||
struct termios tty = {};
|
struct termios tty = {};
|
||||||
@ -39,6 +45,7 @@ class UartTestClass : public TestTask {
|
|||||||
std::array<uint8_t, 64> cmdBuf = {};
|
std::array<uint8_t, 64> cmdBuf = {};
|
||||||
std::array<uint8_t, 4096> recBuf = {};
|
std::array<uint8_t, 4096> recBuf = {};
|
||||||
uint8_t recvCnt = 0;
|
uint8_t recvCnt = 0;
|
||||||
|
ScexUartReader* reader = nullptr;
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif /* LINUX_BOARDTEST_UARTTESTCLASS_H_ */
|
#endif /* LINUX_BOARDTEST_UARTTESTCLASS_H_ */
|
||||||
|
@ -1,18 +1,174 @@
|
|||||||
#include "ScexUartReader.h"
|
#include "ScexUartReader.h"
|
||||||
|
|
||||||
|
#include <fcntl.h> // Contains file controls like O_RDWR
|
||||||
|
#include <fsfw/globalfunctions/arrayprinter.h>
|
||||||
|
#include <fsfw/ipc/MutexFactory.h>
|
||||||
|
#include <fsfw/ipc/MutexGuard.h>
|
||||||
|
#include <fsfw/tasks/SemaphoreFactory.h>
|
||||||
|
#include <fsfw_hal/linux/uart/UartCookie.h>
|
||||||
|
#include <unistd.h> // write(), read(), close()
|
||||||
|
|
||||||
|
#include <cerrno> // Error integer and strerror() function
|
||||||
#include <iostream>
|
#include <iostream>
|
||||||
|
|
||||||
|
#include "OBSWConfig.h"
|
||||||
|
|
||||||
ScexUartReader::ScexUartReader(object_id_t objectId):SystemObject(objectId) {
|
ScexUartReader::ScexUartReader(object_id_t objectId)
|
||||||
|
: SystemObject(objectId), ringBuffer(200 * 2048, true), sizesQueue(200) {
|
||||||
|
semaphore = SemaphoreFactory::instance()->createBinarySemaphore();
|
||||||
|
semaphore->acquire();
|
||||||
|
lock = MutexFactory::instance()->createMutex();
|
||||||
}
|
}
|
||||||
|
|
||||||
void ScexUartRead::start() {
|
// void ScexUartRead::start() { /* semaphore->give(); */ }
|
||||||
semaphore->give();
|
|
||||||
}
|
|
||||||
ReturnValue_t ScexUartReader::performOperation(uint8_t operationCode) {
|
ReturnValue_t ScexUartReader::performOperation(uint8_t operationCode) {
|
||||||
std::cout<<"hallo welt"<<std::endl;
|
lock->lockMutex();
|
||||||
semaphore->take();
|
state = States::IDLE;
|
||||||
while(true) {
|
lock->unlockMutex();
|
||||||
semaphore->take();
|
while (true) {
|
||||||
}
|
semaphore->acquire();
|
||||||
return RETURN_OK;
|
std::cout << "task was started" << std::endl;
|
||||||
|
int bytesRead = 0;
|
||||||
|
do {
|
||||||
|
bytesRead = read(serialPort, reinterpret_cast<void *>(recBuf.data()),
|
||||||
|
static_cast<unsigned int>(recBuf.size()));
|
||||||
|
if (bytesRead == 0) {
|
||||||
|
MutexGuard mg(lock);
|
||||||
|
States currentState = state;
|
||||||
|
if (currentState == States::FINISH) {
|
||||||
|
state = States::IDLE;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
} else if (bytesRead < 0) {
|
||||||
|
sif::warning << "ScexUartReader::performOperation: read call failed with error [" << errno
|
||||||
|
<< ", " << strerror(errno) << "]" << std::endl;
|
||||||
|
break;
|
||||||
|
} else if (bytesRead >= static_cast<int>(recBuf.size())) {
|
||||||
|
sif::error << "ScexUartReader::performOperation: Receive buffer too small" << std::endl;
|
||||||
|
} else if (bytesRead > 0) {
|
||||||
|
MutexGuard mg(lock);
|
||||||
|
sizesQueue.insert(bytesRead);
|
||||||
|
ReturnValue_t result = ringBuffer.writeData(recBuf.data(), bytesRead);
|
||||||
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||||||
|
sif::warning << "ScexUartReader::performOperation: Writing into ring buffer failed"
|
||||||
|
<< std::endl;
|
||||||
|
}
|
||||||
|
if (debugMode) {
|
||||||
|
sif::info << "Received " << bytesRead
|
||||||
|
<< " bytes from the Solar Cell Experiment:" << std::endl;
|
||||||
|
arrayprinter::print(recBuf.data(), bytesRead, OutputType::HEX, false);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
} while (bytesRead > 0);
|
||||||
|
// task block comes here
|
||||||
|
std::cout << "done" << std::endl;
|
||||||
|
}
|
||||||
|
return RETURN_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
ReturnValue_t ScexUartReader::initializeInterface(CookieIF *cookie) {
|
||||||
|
UartCookie *uartCookie = dynamic_cast<UartCookie *>(cookie);
|
||||||
|
if (uartCookie) {
|
||||||
|
return RETURN_FAILED;
|
||||||
|
}
|
||||||
|
std::string devname = uartCookie->getDeviceFile();
|
||||||
|
/* Get file descriptor */
|
||||||
|
serialPort = open(devname.c_str(), O_RDWR);
|
||||||
|
if (serialPort < 0) {
|
||||||
|
sif::warning << "open call failed with error [" << errno << ", " << strerror(errno)
|
||||||
|
<< std::endl;
|
||||||
|
return HasReturnvaluesIF::RETURN_FAILED;
|
||||||
|
}
|
||||||
|
// Setting up UART parameters
|
||||||
|
tty.c_cflag &= ~PARENB; // Clear parity bit
|
||||||
|
tty.c_cflag &= ~CSTOPB; // Clear stop field, only one stop bit used in communication
|
||||||
|
tty.c_cflag &= ~CSIZE; // Clear all the size bits
|
||||||
|
tty.c_cflag |= CS8; // 8 bits per byte
|
||||||
|
tty.c_cflag &= ~CRTSCTS; // Disable RTS/CTS hardware flow control
|
||||||
|
tty.c_cflag |= CREAD | CLOCAL; // Turn on READ & ignore ctrl lines (CLOCAL = 1)
|
||||||
|
|
||||||
|
// Use non-canonical mode and clear echo flag
|
||||||
|
tty.c_lflag &= ~(ICANON | ECHO);
|
||||||
|
|
||||||
|
// Non-blocking mode, read until either line is 0.1 second idle or maximum of 255 bytes are
|
||||||
|
// received in one go
|
||||||
|
tty.c_cc[VTIME] = 20; // Read for up to 2 seconds
|
||||||
|
tty.c_cc[VMIN] = 0; // Read as much as there is available
|
||||||
|
|
||||||
|
// Q7S UART Lite has fixed baud rate. For other linux systems, set baud rate here.
|
||||||
|
#if !defined(XIPHOS_Q7S)
|
||||||
|
if (cfsetispeed(&tty, B57600) != 0) {
|
||||||
|
sif::warning << "ScexUartReader::initializeInterface: Setting baud rate failed" << std::endl;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
if (tcsetattr(serialPort, TCSANOW, &tty) != 0) {
|
||||||
|
sif::warning << "tcsetattr call failed with error [" << errno << ", " << strerror(errno)
|
||||||
|
<< std::endl;
|
||||||
|
}
|
||||||
|
// Flush received and unread data
|
||||||
|
tcflush(serialPort, TCIFLUSH);
|
||||||
|
return RETURN_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
ReturnValue_t ScexUartReader::sendMessage(CookieIF *cookie, const uint8_t *sendData,
|
||||||
|
size_t sendLen) {
|
||||||
|
lock->lockMutex();
|
||||||
|
if (state == States::NOT_READY or state == States::RUNNING) {
|
||||||
|
lock->unlockMutex();
|
||||||
|
return HasReturnvaluesIF::RETURN_FAILED;
|
||||||
|
}
|
||||||
|
state = States::RUNNING;
|
||||||
|
lock->unlockMutex();
|
||||||
|
size_t encodedLen = 0;
|
||||||
|
ReturnValue_t result =
|
||||||
|
dleEncoder.encode(sendData, sendLen, cmdbuf.data(), cmdbuf.size(), &encodedLen, true);
|
||||||
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||||||
|
sif::warning << "UartTestClass::scexInit: Encoding failed" << std::endl;
|
||||||
|
return RETURN_FAILED;
|
||||||
|
}
|
||||||
|
size_t bytesWritten = write(serialPort, cmdbuf.data(), encodedLen);
|
||||||
|
if (bytesWritten != encodedLen) {
|
||||||
|
sif::warning << "Sending ping command to solar experiment failed" << std::endl;
|
||||||
|
return RETURN_FAILED;
|
||||||
|
}
|
||||||
|
result = semaphore->release();
|
||||||
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||||||
|
std::cout << "ScexUartReader::sendMessag: Releasing semaphore failed" << std::endl;
|
||||||
|
}
|
||||||
|
return RETURN_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
ReturnValue_t ScexUartReader::getSendSuccess(CookieIF *cookie) { return RETURN_OK; }
|
||||||
|
|
||||||
|
ReturnValue_t ScexUartReader::requestReceiveMessage(CookieIF *cookie, size_t requestLen) {
|
||||||
|
return RETURN_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
void ScexUartReader::setDebugMode(bool enable) { this->debugMode = enable; }
|
||||||
|
|
||||||
|
ReturnValue_t ScexUartReader::finish() {
|
||||||
|
MutexGuard mg(lock);
|
||||||
|
if (state == States::IDLE) {
|
||||||
|
return HasReturnvaluesIF::RETURN_FAILED;
|
||||||
|
}
|
||||||
|
state = States::FINISH;
|
||||||
|
return RETURN_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
ReturnValue_t ScexUartReader::readReceivedMessage(CookieIF *cookie, uint8_t **buffer,
|
||||||
|
size_t *size) {
|
||||||
|
MutexGuard mg(lock);
|
||||||
|
if (sizesQueue.empty()) {
|
||||||
|
*size = 0;
|
||||||
|
return RETURN_OK;
|
||||||
|
}
|
||||||
|
*size = sizesQueue.pop();
|
||||||
|
*buffer = ipcBuffer.data();
|
||||||
|
ReturnValue_t result = ringBuffer.readData(ipcBuffer.data(), *size, true);
|
||||||
|
if (result != RETURN_OK) {
|
||||||
|
sif::warning << "ScexUartReader::readReceivedMessage: Reading RingBuffer failed" << std::endl;
|
||||||
|
}
|
||||||
|
return RETURN_OK;
|
||||||
}
|
}
|
||||||
|
@ -1,18 +1,55 @@
|
|||||||
#ifndef LINUX_DEVICES_SCEXUARTREADER_H_
|
#ifndef LINUX_DEVICES_SCEXUARTREADER_H_
|
||||||
#define LINUX_DEVICES_SCEXUARTREADER_H_
|
#define LINUX_DEVICES_SCEXUARTREADER_H_
|
||||||
|
|
||||||
|
#include <fsfw/container/DynamicFIFO.h>
|
||||||
|
#include <fsfw/container/SimpleRingBuffer.h>
|
||||||
|
#include <fsfw/devicehandlers/DeviceCommunicationIF.h>
|
||||||
|
#include <fsfw/globalfunctions/DleEncoder.h>
|
||||||
#include <fsfw/objectmanager/SystemObject.h>
|
#include <fsfw/objectmanager/SystemObject.h>
|
||||||
#include <fsfw/tasks/ExecutableObjectIF.h>
|
#include <fsfw/tasks/ExecutableObjectIF.h>
|
||||||
|
#include <fsfw/timemanager/Countdown.h>
|
||||||
|
#include <termios.h> // Contains POSIX terminal control definitions
|
||||||
|
|
||||||
|
class SemaphoreIF;
|
||||||
|
class MutexIF;
|
||||||
|
|
||||||
class ScexUartReader: public SystemObject, //strg+shift+n
|
class ScexUartReader : public SystemObject, // strg+shift+n
|
||||||
public ExecutableObjectIF,
|
public ExecutableObjectIF,
|
||||||
public HasReturnvaluesIF {
|
public DeviceCommunicationIF {
|
||||||
public:
|
friend class UartTestClass;
|
||||||
ScexUartReader(object_id_t objectId);
|
|
||||||
private:
|
|
||||||
ReturnValue_t performOperation(uint8_t operationCode = 0) override;
|
|
||||||
|
|
||||||
|
public:
|
||||||
|
enum class States { NOT_READY, IDLE, RUNNING, FINISH };
|
||||||
|
ScexUartReader(object_id_t objectId);
|
||||||
|
|
||||||
|
ReturnValue_t finish();
|
||||||
|
void setDebugMode(bool enable);
|
||||||
|
|
||||||
|
private:
|
||||||
|
SemaphoreIF *semaphore;
|
||||||
|
bool debugMode = false;
|
||||||
|
MutexIF *lock;
|
||||||
|
int serialPort = 0;
|
||||||
|
States state = States::IDLE;
|
||||||
|
struct termios tty = {};
|
||||||
|
bool doFinish = false;
|
||||||
|
DleEncoder dleEncoder = DleEncoder();
|
||||||
|
SimpleRingBuffer ringBuffer;
|
||||||
|
DynamicFIFO<size_t> sizesQueue;
|
||||||
|
Countdown finishCoutdown = Countdown(180 * 1000);
|
||||||
|
std::array<uint8_t, 256> cmdbuf = {};
|
||||||
|
std::array<uint8_t, 4096> recBuf = {};
|
||||||
|
|
||||||
|
std::array<uint8_t, 4096> ipcBuffer = {};
|
||||||
|
|
||||||
|
ReturnValue_t performOperation(uint8_t operationCode = 0) override;
|
||||||
|
|
||||||
|
// DeviceCommunicationIF implementation
|
||||||
|
ReturnValue_t initializeInterface(CookieIF *cookie) override;
|
||||||
|
ReturnValue_t sendMessage(CookieIF *cookie, const uint8_t *sendData, size_t sendLen) override;
|
||||||
|
ReturnValue_t getSendSuccess(CookieIF *cookie) override;
|
||||||
|
ReturnValue_t requestReceiveMessage(CookieIF *cookie, size_t requestLen) override;
|
||||||
|
ReturnValue_t readReceivedMessage(CookieIF *cookie, uint8_t **buffer, size_t *size) override;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
#endif /* LINUX_DEVICES_SCEXUARTREADER_H_ */
|
#endif /* LINUX_DEVICES_SCEXUARTREADER_H_ */
|
||||||
|
@ -58,7 +58,6 @@ enum sourceObjects : uint32_t {
|
|||||||
HEATER_HANDLER = 0x444100A4,
|
HEATER_HANDLER = 0x444100A4,
|
||||||
RAD_SENSOR = 0x443200A5,
|
RAD_SENSOR = 0x443200A5,
|
||||||
|
|
||||||
|
|
||||||
/* 0x54 ('T') for test handlers */
|
/* 0x54 ('T') for test handlers */
|
||||||
TEST_TASK = 0x54694269,
|
TEST_TASK = 0x54694269,
|
||||||
LIBGPIOD_TEST = 0x54123456,
|
LIBGPIOD_TEST = 0x54123456,
|
||||||
|
Loading…
Reference in New Issue
Block a user