GCC Code Coverage Report

Directory: Svc/DpWriter/
File: DpWriter.cpp
Date: 2026-11-03 21:18:45
Exec Total Coverage
Lines: 133 136 97.8%
Functions: 11 12 91.7%
Branches: 111 115 96.5%
Line Branch Exec Source
1 // ======================================================================
2 // \title DpWriter.cpp
3 // \author bocchino
4 // \brief cpp file for DpWriter component implementation class
5 // ======================================================================
6
7 #include "Svc/DpWriter/DpWriter.hpp"
8 #include "Fw/Com/ComPacket.hpp"
9 #include "Fw/FPrimeBasicTypes.hpp"
10 #include "Fw/Types/FileNameString.hpp"
11 #include "Fw/Types/Serializable.hpp"
12 #include "Os/File.hpp"
13 #include "Utils/Hash/Hash.hpp"
14 #include "config/DpCfg.hpp"
15
16 namespace Svc {
17
18 // ----------------------------------------------------------------------
19 // Construction, initialization, and destruction
20 // ----------------------------------------------------------------------
21
22
1/1
✓ Branch 36 taken 22 times.
 22 DpWriter::DpWriter(const char* const compName) : DpWriterComponentBase(compName), m_dpFileNamePrefix() {}
23
24 44 DpWriter::~DpWriter() {}
25
26 1 void DpWriter::configure(const Fw::ConstStringBase& dpFileNamePrefix) {
27 1 this->m_dpFileNamePrefix = dpFileNamePrefix;
28 1 }
29
30 // ----------------------------------------------------------------------
31 // Handler implementations for user-defined typed input ports
32 // ----------------------------------------------------------------------
33
34 6229 void DpWriter::bufferSendIn_handler(const FwIndexType portNum, Fw::Buffer& buffer) {
35 6229 Fw::Success::T status = Fw::Success::SUCCESS;
36 // Update num buffers received
37 6229 ++this->m_numBuffersReceived;
38 // Check that the buffer is valid
39
3/3
✓ Branch 4 taken 6229 times.
✓ Branch 6 taken 1032 times.
✓ Branch 7 taken 5197 times.
 6229 if (!buffer.isValid()) {
40
1/1
✓ Branch 5 taken 1032 times.
 1032 this->log_WARNING_HI_InvalidBuffer();
41 1032 status = Fw::Success::FAILURE;
42 }
43 // Check that the buffer is large enough to hold a data product packet
44
1/1
✓ Branch 4 taken 6229 times.
 6229 const FwSizeType bufferSize = buffer.getSize();
45
2/2
✓ Branch 0 taken 5197 times.
✓ Branch 1 taken 1032 times.
 6229 if (status == Fw::Success::SUCCESS) {
46
2/2
✓ Branch 0 taken 1011 times.
✓ Branch 1 taken 4186 times.
 5197 if (bufferSize < Fw::DpContainer::MIN_PACKET_SIZE) {
47
1/1
✓ Branch 5 taken 1011 times.
 1011 this->log_WARNING_HI_BufferTooSmallForPacket(static_cast<U32>(bufferSize),
48 Fw::DpContainer::MIN_PACKET_SIZE);
49
50 1011 status = Fw::Success::FAILURE;
51 }
52 }
53 // Set up the container and check that the header hash is valid
54
1/1
✓ Branch 2 taken 6229 times.
 6229 Fw::DpContainer container;
55
2/2
✓ Branch 0 taken 4186 times.
✓ Branch 1 taken 2043 times.
 6229 if (status == Fw::Success::SUCCESS) {
56
1/1
✓ Branch 3 taken 4186 times.
 4186 container.setBuffer(buffer);
57
1/1
✓ Branch 2 taken 4186 times.
 4186 Utils::HashBuffer storedHash;
58
1/1
✓ Branch 2 taken 4186 times.
 4186 Utils::HashBuffer computedHash;
59
1/1
✓ Branch 2 taken 4186 times.
 4186 status = container.checkHeaderHash(storedHash, computedHash);
60
2/2
✓ Branch 0 taken 911 times.
✓ Branch 1 taken 3275 times.
 4186 if (status != Fw::Success::SUCCESS) {
61
3/3
✓ Branch 5 taken 911 times.
✓ Branch 9 taken 911 times.
✓ Branch 12 taken 911 times.
 1822 this->log_WARNING_HI_InvalidHeaderHash(static_cast<U32>(bufferSize), storedHash.asBigEndianU32(),
62 911 computedHash.asBigEndianU32());
63 }
64 4186 }
65 // Deserialize the packet header
66
2/2
✓ Branch 0 taken 3275 times.
✓ Branch 1 taken 2954 times.
 6229 if (status == Fw::Success::SUCCESS) {
67
1/1
✓ Branch 4 taken 3275 times.
 3275 status = this->deserializePacketHeader(buffer, container);
68 }
69 // Check that the packet size fits in the buffer
70
2/2
✓ Branch 0 taken 2229 times.
✓ Branch 1 taken 4000 times.
 6229 if (status == Fw::Success::SUCCESS) {
71
1/1
✓ Branch 2 taken 2229 times.
 2229 const FwSizeType packetSize = container.getPacketSize();
72
2/2
✓ Branch 0 taken 941 times.
✓ Branch 1 taken 1288 times.
 2229 if (bufferSize < packetSize) {
73
1/1
✓ Branch 5 taken 941 times.
 941 this->log_WARNING_HI_BufferTooSmallForData(static_cast<U32>(bufferSize), static_cast<U32>(packetSize));
74 941 status = Fw::Success::FAILURE;
75 }
76 }
77 // Perform the requested processing
78
2/2
✓ Branch 0 taken 1288 times.
✓ Branch 1 taken 4941 times.
 6229 if (status == Fw::Success::SUCCESS) {
79
1/1
✓ Branch 4 taken 1288 times.
 1288 this->performProcessing(container);
80 }
81 // Construct the file name
82
1/1
✓ Branch 2 taken 6229 times.
 6229 Fw::FileNameString fileName;
83
2/2
✓ Branch 0 taken 1288 times.
✓ Branch 1 taken 4941 times.
 6229 if (status == Fw::Success::SUCCESS) {
84 1288 const FwDpIdType containerId = container.getId();
85
1/1
✓ Branch 2 taken 1288 times.
 1288 const Fw::Time timeTag = container.getTimeTag();
86
3/3
✓ Branch 2 taken 1288 times.
✓ Branch 5 taken 1288 times.
✓ Branch 14 taken 1288 times.
 3864 const Fw::FormatStatus formatStatus = fileName.format(DP_FILENAME_FORMAT, this->m_dpFileNamePrefix.toChar(),
87 2576 containerId, timeTag.getSeconds(), timeTag.getUSeconds());
88
2/2
✓ Branch 0 taken 11 times.
✓ Branch 1 taken 1277 times.
 1288 if (formatStatus != Fw::FormatStatus::SUCCESS) {
89
2/2
✓ Branch 6 taken 11 times.
✓ Branch 10 taken 11 times.
 11 this->log_WARNING_HI_FileNameFormatError(static_cast<Fw::StringFormatStatus::T>(formatStatus));
90 11 status = Fw::Success::FAILURE;
91 }
92 1288 }
93 // Calculate and populate the file data checksum
94
2/2
✓ Branch 0 taken 1277 times.
✓ Branch 1 taken 4952 times.
 6229 if (status == Fw::Success::SUCCESS) {
95
1/1
✓ Branch 2 taken 1277 times.
 1277 container.updateDataHash();
96 }
97 // Write the file
98 6229 FwSizeType fileSize = 0;
99
2/2
✓ Branch 0 taken 1277 times.
✓ Branch 1 taken 4952 times.
 6229 if (status == Fw::Success::SUCCESS) {
100
1/1
✓ Branch 4 taken 1277 times.
 1277 status = this->writeFile(container, fileName, fileSize);
101 }
102 // Send the DpWritten notification on the path matching the input port
103
2/2
✓ Branch 0 taken 512 times.
✓ Branch 1 taken 5717 times.
 6229 if (status == Fw::Success::SUCCESS) {
104
1/1
✓ Branch 4 taken 512 times.
 512 this->sendNotification(portNum, container, fileName, fileSize);
105 }
106 // Return the buffer on the path matching the input port
107
3/3
✓ Branch 4 taken 6229 times.
✓ Branch 6 taken 5197 times.
✓ Branch 7 taken 1032 times.
 6229 if (buffer.isValid()) {
108
1/1
✓ Branch 5 taken 5197 times.
 5197 this->deallocBufferSendOut_out(portNum, buffer);
109 }
110 // Update the error count
111
2/2
✓ Branch 0 taken 5717 times.
✓ Branch 1 taken 512 times.
 6229 if (status != Fw::Success::SUCCESS) {
112 5717 this->m_numErrors++;
113 }
114 12458 }
115
116 1023 void DpWriter::schedIn_handler(const FwIndexType portNum, U32 context) {
117 // portNum and context are not used
118 (void)portNum;
119 (void)context;
120 1023 bool expected = false;
121
1/2
✓ Branch 4 taken 1023 times.
✗ Branch 5 not taken.
 1023 if (this->m_schedInQueued.compare_exchange_strong(expected, true)) {
122
1/1
✓ Branch 5 taken 1023 times.
 1023 this->schedInInternal_internalInterfaceInvoke();
123 }
124 1023 }
125
126 ✗ void DpWriter::schedInInternal_overflowHook() {
127 ✗ this->m_schedInQueued = false;
128 ✗ }
129
130 1023 void DpWriter::schedInInternal_internalInterfaceHandler() {
131 1023 this->m_schedInQueued = false;
132 // Write telemetry
133
2/2
✓ Branch 6 taken 1023 times.
✓ Branch 13 taken 1023 times.
 1023 this->tlmWrite_NumBuffersReceived(this->m_numBuffersReceived);
134
2/2
✓ Branch 6 taken 1023 times.
✓ Branch 13 taken 1023 times.
 1023 this->tlmWrite_NumBytesWritten(this->m_numBytesWritten);
135
2/2
✓ Branch 6 taken 1023 times.
✓ Branch 13 taken 1023 times.
 1023 this->tlmWrite_NumSuccessfulWrites(this->m_numSuccessfulWrites);
136
2/2
✓ Branch 6 taken 1023 times.
✓ Branch 13 taken 1023 times.
 1023 this->tlmWrite_NumFailedWrites(this->m_numFailedWrites);
137
2/2
✓ Branch 6 taken 1023 times.
✓ Branch 13 taken 1023 times.
 1023 this->tlmWrite_NumErrors(this->m_numErrors);
138 1023 }
139
140 // ----------------------------------------------------------------------
141 // Handler implementations for commands
142 // ----------------------------------------------------------------------
143
144 932 void DpWriter::CLEAR_EVENT_THROTTLE_cmdHandler(FwOpcodeType opCode, U32 cmdSeq) {
145 // opCode and cmdSeq are not used
146 (void)opCode;
147 (void)cmdSeq;
148 // Clear throttling
149 932 this->log_WARNING_HI_BufferTooSmallForData_ThrottleClear();
150 932 this->log_WARNING_HI_BufferTooSmallForPacket_ThrottleClear();
151 932 this->log_WARNING_HI_FileOpenError_ThrottleClear();
152 932 this->log_WARNING_HI_FileWriteError_ThrottleClear();
153 932 this->log_WARNING_HI_InvalidBuffer_ThrottleClear();
154 932 this->log_WARNING_HI_InvalidHeaderHash_ThrottleClear();
155 932 this->log_WARNING_HI_InvalidHeader_ThrottleClear();
156 // Return command response
157
2/2
✓ Branch 6 taken 932 times.
✓ Branch 9 taken 932 times.
 932 this->cmdResponse_out(opCode, cmdSeq, Fw::CmdResponse::OK);
158 932 }
159
160 // ----------------------------------------------------------------------
161 // Private helper functions
162 // ----------------------------------------------------------------------
163
164 3275 Fw::Success::T DpWriter::deserializePacketHeader(Fw::Buffer& buffer, Fw::DpContainer& container) {
165 3275 Fw::Success::T status = Fw::Success::SUCCESS;
166 3275 container.setBuffer(buffer);
167 3275 const Fw::SerializeStatus serialStatus = container.deserializeHeader();
168
2/2
✓ Branch 0 taken 1046 times.
✓ Branch 1 taken 2229 times.
 3275 if (serialStatus != Fw::FW_SERIALIZE_OK) {
169 1046 this->log_WARNING_HI_InvalidHeader(static_cast<U32>(buffer.getSize()), static_cast<U32>(serialStatus));
170 1046 status = Fw::Success::FAILURE;
171 }
172 3275 return status;
173 }
174
175 1288 void DpWriter::performProcessing(Fw::DpContainer& container) {
176 // Get the buffer
177
1/1
✓ Branch 2 taken 1288 times.
 1288 Fw::Buffer buffer = container.getBuffer();
178 // Get the bit mask for the processing types
179 1288 const Fw::DpCfg::ProcType::SerialType procTypes = container.getProcTypes();
180 // Do the processing
181 1288 bool did_process = false;
182
2/2
✓ Branch 0 taken 6440 times.
✓ Branch 1 taken 1288 times.
 7728 for (FwIndexType portNum = 0; portNum < NUM_PROCBUFFERSENDOUT_OUTPUT_PORTS; ++portNum) {
183
3/4
✗ Branch 0 not taken.
✓ Branch 1 taken 6440 times.
✓ Branch 2 taken 2341 times.
✓ Branch 3 taken 4099 times.
 6440 if ((procTypes & (1 << portNum)) != 0) {
184
1/1
✓ Branch 5 taken 2341 times.
 2341 this->procBufferSendOut_out(portNum, buffer);
185 2341 did_process = true;
186 }
187 }
188
189
2/2
✓ Branch 0 taken 1214 times.
✓ Branch 1 taken 74 times.
 1288 if (did_process) {
190 // Updated DpContainer object state with the returned value in the
191 // container buffer
192
1/1
✓ Branch 4 taken 1214 times.
 1214 Fw::SerializeStatus stat = container.deserializeHeader();
193 1214 FW_ASSERT(stat == Fw::FW_SERIALIZE_OK, stat);
194
195 // Check that the buffer size is compatible with the packet size in
196 // the container header
197 1214 FW_ASSERT(container.getPacketSize() <= buffer.getSize(),
198 static_cast<FwAssertArgType>(container.getPacketSize()),
199 static_cast<FwAssertArgType>(buffer.getSize()));
200
201 // Re-compute and serialize the container header into the buffer
202
1/1
✓ Branch 4 taken 1214 times.
 1214 container.updateHeaderHash();
203
1/1
✓ Branch 4 taken 1214 times.
 1214 container.serializeHeader();
204
205 // Shrink internal Fw::Buffer
206
1/1
✓ Branch 4 taken 1214 times.
 1214 container.shrinkBufferSize();
207 }
208 2576 }
209
210 1277 Fw::Success::T DpWriter::writeFile(const Fw::DpContainer& container,
211 const Fw::FileNameString& fileName,
212 FwSizeType& fileSize) {
213 1277 Fw::Success::T status = Fw::Success::SUCCESS;
214 // Get the buffer
215
1/1
✓ Branch 2 taken 1277 times.
 1277 Fw::Buffer buffer = container.getBuffer();
216 // Get the file size
217
1/1
✓ Branch 4 taken 1277 times.
 1277 fileSize = container.getPacketSize();
218 // Open the file
219
1/1
✓ Branch 2 taken 1277 times.
 1277 Os::File file;
220
1/1
✓ Branch 6 taken 1277 times.
 1277 Os::File::Status fileStatus = file.open(fileName.toChar(), Os::File::OPEN_CREATE);
221
2/2
✓ Branch 0 taken 532 times.
✓ Branch 1 taken 745 times.
 1277 if (fileStatus != Os::File::OP_OK) {
222
1/1
✓ Branch 8 taken 532 times.
 532 this->log_WARNING_HI_FileOpenError(static_cast<U32>(fileStatus), fileName);
223 532 status = Fw::Success::FAILURE;
224 }
225 // Write the file
226
2/2
✓ Branch 0 taken 745 times.
✓ Branch 1 taken 532 times.
 1277 if (status == Fw::Success::SUCCESS) {
227 // Set write size to file size
228 // On entry to the write call, this is the number of bytes to write
229 // On return from the write call, this is the number of bytes written
230 745 FwSizeType writeSize = static_cast<FwSizeType>(fileSize);
231
2/2
✓ Branch 3 taken 745 times.
✓ Branch 6 taken 745 times.
 745 fileStatus = file.write(buffer.getData(), writeSize);
232 // If a successful write occurred, then update the number of bytes written
233
2/2
✓ Branch 0 taken 512 times.
✓ Branch 1 taken 233 times.
 745 if (fileStatus == Os::File::OP_OK) {
234 512 this->m_numBytesWritten += static_cast<U64>(writeSize);
235 }
236
3/4
✓ Branch 0 taken 512 times.
✓ Branch 1 taken 233 times.
✓ Branch 3 taken 512 times.
✗ Branch 4 not taken.
 745 if ((fileStatus == Os::File::OP_OK) and (writeSize == static_cast<FwSizeType>(fileSize))) {
237 // If the write status is success, and the number of bytes written
238 // is the expected number, then record the success
239
1/1
✓ Branch 8 taken 512 times.
 512 this->log_ACTIVITY_LO_FileWritten(static_cast<U32>(writeSize), fileName);
240 } else {
241 // Otherwise record the failure
242 233 this->log_WARNING_HI_FileWriteError(static_cast<U32>(fileStatus), static_cast<U32>(writeSize),
243
1/1
✓ Branch 2 taken 233 times.
 233 static_cast<U32>(fileSize), fileName);
244 233 status = Fw::Success::FAILURE;
245 }
246 }
247 // Update the count of successful or failed writes
248
2/2
✓ Branch 0 taken 512 times.
✓ Branch 1 taken 765 times.
 1277 if (status == Fw::Success::SUCCESS) {
249 512 this->m_numSuccessfulWrites++;
250 } else {
251 765 this->m_numFailedWrites++;
252 }
253 // Return the status
254 1277 return status;
255 1277 }
256
257 512 void DpWriter::sendNotification(FwIndexType portNum,
258 const Fw::DpContainer& container,
259 const Fw::FileNameString& fileName,
260 FwSizeType fileSize) {
261
1/2
✓ Branch 5 taken 512 times.
✗ Branch 6 not taken.
 512 if (isConnected_dpWrittenOut_OutputPort(portNum)) {
262 // Get the priority
263 512 const FwDpPriorityType priority = container.getPriority();
264 512 this->dpWrittenOut_out(portNum, fileName, priority, fileSize);
265 }
266 512 }
267
268 } // end namespace Svc
269