ptme handling wip

linux/obc/PapbVcInterface.cpp

@@ -0,0 +1,104 @@
+#include <linux/obc/PapbVcInterface.h>
+#include "fsfw/serviceinterface/ServiceInterface.h"
+
+PapbVcInterface::PapbVcInterface(object_id_t objectId, LinuxLibgpioIF* gpioComIF,
+        gpioId_t papbBusyId, gpioId_t papbEmptyId, uint32_t vcOffset) :
+        SystemObject(objectId), gpioComIF(gpioComIF), uioVcInterface(uioVcInterface), papbBusyId(
+                papbBusyId), papbEmptyId(papbEmptyId), vcOffset(vcOffset) {
+}
+
+PapbVcInterface::~PapbVcInterface() {
+}
+
+
+void PapbVcInterface::setRegisterAddress(uint32_t* ptmeBaseAddress) {
+    vcBaseReg = ptmeBaseAddress + vcOffset;
+}
+
+ReturnValue_t PapbVcInterface::write(const uint8_t * data, size_t dataLen) {
+
+    if(pollPapbBusySignal() == RETURN_OK) {
+        startPacketTransfer();
+    }
+
+    for(size_t idx = 0; idx < dataLen; idx++) {
+        if(pollPapbBusySignal() == RETURN_OK) {
+            *(vcBaseReg + DATA_REG_OFFSET) = static_cast<uint32_t>(*(data + idx));
+        }
+        else {
+            sif::warning << "PapbVcInterface::sendTm: Only written " << idx - 1 << " of "
+                    << dataLen << " data" << std::endl;
+            return RETURN_FAILED;
+        }
+    }
+
+    if(pollPapbBusySignal() == RETURN_OK) {
+        endPacketTransfer();
+    }
+    return RETURN_OK;
+}
+
+void PapbVcInterface::startPacketTransfer() {
+    *vcBaseReg = CONFIG_START;
+}
+
+void PapbVcInterface::endPacketTransfer() {
+    *vcBaseReg = CONFIG_END;
+}
+
+ReturnValue_t PapbVcInterface::pollPapbBusySignal() {
+    int papbBusyState = 0;
+    ReturnValue_t result = RETURN_OK;
+
+    /** Check if PAPB interface is ready to receive data */
+    result = gpioComIF->readGpio(papbBusyId, &papbBusyState);
+    if (result != RETURN_OK) {
+        sif::debug << "PapbVcInterface::pollPapbBusySignal: Failed to read papb busy signal"
+                << std::endl;
+        return RETURN_FAILED;
+    }
+    if (!papbBusyState) {
+        sif::debug << "PapbVcInterface::pollPapbBusySignal: PAPB busy" << std::endl;
+        return PAPB_BUSY;
+    }
+
+    return RETURN_OK;
+}
+
+void PapbVcInterface::isVcInterfaceBufferEmpty() {
+    ReturnValue_t result = RETURN_OK;
+    int papbEmptyState = 1;
+
+    result = gpioComIF->readGpio(papbEmptyId, &papbEmptyState);
+
+    if (result != RETURN_OK) {
+        sif::debug << "PapbVcInterface::isVcInterfaceBufferEmpty: Failed to read papb empty signal"
+                << std::endl;
+        return;
+    }
+
+    if (papbEmptyState == 1) {
+        sif::debug << "PapbVcInterface::isVcInterfaceBufferEmpty: Buffer is empty" << std::endl;
+    }
+    else {
+        sif::debug << "PapbVcInterface::isVcInterfaceBufferEmpty: Buffer is not empty" << std::endl;
+    }
+    return;
+}
+
+ReturnValue_t PapbVcInterface::sendTestFrame() {
+    /** Size of one complete transfer frame data field amounts to 1105 bytes */
+    uint8_t testPacket[1105];
+
+    /** Fill one test packet */
+    for(int idx = 0; idx < 1105; idx++) {
+            testPacket[idx] = static_cast<uint8_t>(idx & 0xFF);
+    }
+
+    ReturnValue_t result = sendTm(testPacket, 1105);
+    if(result != RETURN_OK) {
+        return result;
+    }
+
+    return RETURN_OK;
+}