Refactored page alignment code in EDBG and RISC-V debug translator driver

src/DebugToolDrivers/Protocols/RiscVDebugSpec/DebugTranslator.cpp

@@ -5,6 +5,7 @@
 #include <chrono>
 #include <limits>
 #include <cassert>
+#include <algorithm>
 
 #include "Registers/CpuRegisterNumbers.hpp"
 #include "DebugModule/Registers/RegisterAddresses.hpp"
@@ -411,19 +412,31 @@ namespace DebugToolDrivers::Protocols::RiscVDebugSpec
                     addressSpaceDescriptor,
                     memorySegmentDescriptor,
                     alignedStartAddress,
-                    (startAddress - alignedStartAddress)
+                    (startAddress - alignedStartAddress),
+                    {}
                 )
                 : TargetMemoryBuffer{};
-            alignedBuffer.reserve(alignedBytes);
 
-            // Read the offset bytes required to align the buffer size
+            alignedBuffer.resize(alignedBytes);
+
+            std::copy(
+                buffer.begin(),
+                buffer.end(),
+                alignedBuffer.begin() + (startAddress - alignedStartAddress)
+            );
+
             const auto dataBack = this->readMemory(
                 addressSpaceDescriptor,
                 memorySegmentDescriptor,
                 startAddress + bytes,
-                alignedBytes - bytes - (startAddress - alignedStartAddress)
+                alignedBytes - bytes - (startAddress - alignedStartAddress),
+                {}
+            );
+            std::copy(
+                dataBack.begin(),
+                dataBack.end(),
+                alignedBuffer.begin() + (startAddress - alignedStartAddress) + bytes
             );
-            alignedBuffer.insert(alignedBuffer.end(), dataBack.begin(), dataBack.end());
 
             return this->writeMemory(
                 addressSpaceDescriptor,