VirtualProtect platform abstraction.

src/xenia/base/memory.cc

@@ -0,0 +1,131 @@
+/**
+ ******************************************************************************
+ * Xenia : Xbox 360 Emulator Research Project                                 *
+ ******************************************************************************
+ * Copyright 2014 Ben Vanik. All rights reserved.                             *
+ * Released under the BSD license - see LICENSE in the root for more details. *
+ ******************************************************************************
+ */
+
+#include "xenia/base/memory.h"
+
+#include <algorithm>
+
+namespace xe {
+
+// TODO(benvanik): fancy AVX versions.
+// http://gnuradio.org/redmine/projects/gnuradio/repository/revisions/cb32b70b79f430456208a2cd521d028e0ece5d5b/entry/volk/kernels/volk/volk_16u_byteswap.h
+// http://gnuradio.org/redmine/projects/gnuradio/repository/revisions/f2bc76cc65ffba51a141950f98e75364e49df874/entry/volk/kernels/volk/volk_32u_byteswap.h
+// http://gnuradio.org/redmine/projects/gnuradio/repository/revisions/2c4c371885c31222362f70a1cd714415d1398021/entry/volk/kernels/volk/volk_64u_byteswap.h
+
+void copy_and_swap_16_aligned(uint16_t* dest, const uint16_t* src,
+                              size_t count) {
+  return copy_and_swap_16_unaligned(dest, src, count);
+}
+
+void copy_and_swap_16_unaligned(uint16_t* dest, const uint16_t* src,
+                                size_t count) {
+  size_t i;
+  __m128i input, output;
+
+  for (i = 0; i + 8 <= count; i += 8) {
+    input = _mm_loadu_si128((__m128i*)&src[i]);
+    output = _mm_or_si128(_mm_slli_epi16(input, 8), _mm_srli_epi16(input, 8));
+    _mm_storeu_si128((__m128i*)&dest[i], output);
+  }
+
+  for (; i < count; ++i) {  // handle residual elements
+    dest[i] = byte_swap(src[i]);
+  }
+}
+
+void copy_and_swap_32_aligned(uint32_t* dest, const uint32_t* src,
+                              size_t count) {
+  return copy_and_swap_32_unaligned(dest, src, count);
+}
+
+void copy_and_swap_32_unaligned(uint32_t* dest, const uint32_t* src,
+                                size_t count) {
+  size_t i;
+  __m128i input, byte1, byte2, byte3, byte4, output;
+  __m128i byte2mask = _mm_set1_epi32(0x00FF0000);
+  __m128i byte3mask = _mm_set1_epi32(0x0000FF00);
+
+  for (i = 0; i + 4 <= count; i += 4) {
+    input = _mm_loadu_si128((__m128i*)&src[i]);
+
+    // Do the four shifts
+    byte1 = _mm_slli_epi32(input, 24);
+    byte2 = _mm_slli_epi32(input, 8);
+    byte3 = _mm_srli_epi32(input, 8);
+    byte4 = _mm_srli_epi32(input, 24);
+
+    // Or bytes together
+    output = _mm_or_si128(byte1, byte4);
+    byte2 = _mm_and_si128(byte2, byte2mask);
+    output = _mm_or_si128(output, byte2);
+    byte3 = _mm_and_si128(byte3, byte3mask);
+    output = _mm_or_si128(output, byte3);
+
+    _mm_storeu_si128((__m128i*)&dest[i], output);
+  }
+
+  for (; i < count; ++i) {  // handle residual elements
+    dest[i] = byte_swap(src[i]);
+  }
+}
+
+void copy_and_swap_64_aligned(uint64_t* dest, const uint64_t* src,
+                              size_t count) {
+  return copy_and_swap_64_unaligned(dest, src, count);
+}
+
+void copy_and_swap_64_unaligned(uint64_t* dest, const uint64_t* src,
+                                size_t count) {
+  size_t i;
+  __m128i input, byte1, byte2, byte3, byte4, output;
+  __m128i byte2mask = _mm_set1_epi32(0x00FF0000);
+  __m128i byte3mask = _mm_set1_epi32(0x0000FF00);
+
+  for (i = 0; i + 2 <= count; i += 2) {
+    input = _mm_loadu_si128((__m128i*)&src[i]);
+
+    // Do the four shifts
+    byte1 = _mm_slli_epi32(input, 24);
+    byte2 = _mm_slli_epi32(input, 8);
+    byte3 = _mm_srli_epi32(input, 8);
+    byte4 = _mm_srli_epi32(input, 24);
+
+    // Or bytes together
+    output = _mm_or_si128(byte1, byte4);
+    byte2 = _mm_and_si128(byte2, byte2mask);
+    output = _mm_or_si128(output, byte2);
+    byte3 = _mm_and_si128(byte3, byte3mask);
+    output = _mm_or_si128(output, byte3);
+
+    // Reorder the two words
+    output = _mm_shuffle_epi32(output, _MM_SHUFFLE(2, 3, 0, 1));
+
+    _mm_storeu_si128((__m128i*)&dest[i], output);
+  }
+
+  for (; i < count; ++i) {  // handle residual elements
+    dest[i] = byte_swap(src[i]);
+  }
+}
+
+void copy_and_swap_16_in_32_aligned(uint32_t* dest, const uint32_t* src,
+                                    size_t count) {
+  size_t i;
+  __m128i input, output;
+  for (i = 0; i + 4 <= count; i += 4) {
+    input = _mm_loadu_si128((__m128i*)&src[i]);
+    output = _mm_or_si128(_mm_slli_epi32(input, 16), _mm_srli_epi32(input, 16));
+    _mm_storeu_si128((__m128i*)&dest[i], output);
+  }
+  for (; i < count; ++i) {  // handle residual elements
+    dest[i] = (src[i] >> 16) | (src[i] << 16);
+  }
+}
+
+}  // namespace xe