Add coordinate solvers for cornersh48-corner-estimate

1 files changed, 13 insertions, 0 deletions

diff --git a/src/arch/portable.h b/src/arch/portable.h
index c7f2de0..4b66fb6 100644
--- a/src/arch/portable.h
+++ b/src/arch/portable.h
@@ -154,6 +154,19 @@ inverse(cube_t cube)
         return ret;
 }
 
+STATIC_INLINE void
+copy_co(cube_t cube[static 1], cube_t co)
+{
+        uint8_t c;
+        size_t i;
+
+        for (i = 0; i < 8; i++) {
+                c = cube->corner[i] & COBITS;
+                cube->corner[i] ^= c;
+                cube->corner[i] |= co.corner[i] & COBITS;
+        }
+}
+
 STATIC_INLINE uint64_t
 coord_co(cube_t c)
 {