Fix bracket position

Signed-off-by: Crola1702 <cristobal.arroyo@ekumenlabs.com>
gazebosim · Jan 31, 2023 · b1346de · b1346de
1 parent 75daa0a
commit b1346de
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/src/systems/optical_tactile_plugin/OpticalTactilePlugin.cc b/src/systems/optical_tactile_plugin/OpticalTactilePlugin.cc
@@ -807,9 +807,9 @@ void OpticalTactilePluginPrivate::ComputeNormalForces(
       bufferIndex = j * (_msg.row_step() / 2) + i * (_msg.point_step() / 2);
       std::memcpy(&normalForcesBuffer.get()[bufferIndex],
                  &normalForce.X(), sizeof(float));
-      std::memcpy(&normalForcesBuffer.get()[bufferIndex] + sizeof(float),
+      std::memcpy(&normalForcesBuffer.get()[bufferIndex + sizeof(float)],
                  &normalForce.Y(), sizeof(float));
-      std::memcpy(&normalForcesBuffer.get()[bufferIndex] + 2 * sizeof(float),
+      std::memcpy(&normalForcesBuffer.get()[bufferIndex + 2 * sizeof(float)],
                  &normalForce.Z(), sizeof(float));
 
       if (!_visualizeForces)