1 files changed, 24 insertions, 0 deletions

diff --git a/firmware/general.c b/firmware/general.c
index 7f4348046c..cc3710c8f3 100644
--- a/firmware/general.c
+++ b/firmware/general.c
@@ -17,6 +17,7 @@
  *
  ****************************************************************************/
 #include <limits.h>
+#include "system.h"
 #include "config.h"
 #include "general.h"
 
@@ -75,3 +76,26 @@ int make_list_from_caps32(unsigned long src_mask,
 
     return count;
 } /* make_list_from_caps32 */
+
+/* Only needed for cache aligning atm */
+#ifdef PROC_NEEDS_CACHEALIGN
+/* Align a buffer and size to a size boundary while remaining within
+ * the original boundaries */
+size_t align_buffer(void **start, size_t size, size_t align)
+{
+    void *newstart = *start;
+    void *newend = newstart + size;
+
+    /* Align the end down and the start up */
+    newend = (void *)ALIGN_DOWN((intptr_t)newend, align);
+    newstart = (void *)ALIGN_UP((intptr_t)newstart, align);
+
+    /* Hmmm - too small for this */
+    if (newend <= newstart)
+        return 0;
+
+    /* Return adjusted pointer and size */
+    *start = newstart;
+    return newend - newstart;
+}
+#endif /* PROC_NEEDS_CACHEALIGN */