diff --git a/core/src/main/java/mc/core/utils/CompactedCoords.java b/core/src/main/java/mc/core/utils/CompactedCoords.java
index 8a33b41..43daef0 100644
--- a/core/src/main/java/mc/core/utils/CompactedCoords.java
+++ b/core/src/main/java/mc/core/utils/CompactedCoords.java
@@ -20,4 +20,23 @@ public class CompactedCoords {
                 (int)(short) (compactValue | 0xFFFF0000)
         };
     }
+
+    private static int floor_double(double value) {
+        int i = (int)value;
+        return value < (double)i ? i - 1 : i;
+    }
+
+    public static long compressXYZ(double x, double y, double z) {
+        return ((floor_double(x) & 0x3FFFFFF) << 38)
+                | ((floor_double(y) & 0xFFF) << 26)
+                | (floor_double(z) & 0x3FFFFFF);
+    }
+
+    public static double[] uncompressXYZ(long compactValue) {
+        return new double[]{
+                compactValue >> 38,
+                (compactValue >> 26) & 0x0FFF,
+                compactValue << 38 >> 38 // is normal?
+        };
+    }
 }
diff --git a/core/src/test/java/mc/core/utils/TestCompactedCoords.java b/core/src/test/java/mc/core/utils/TestCompactedCoords.java
index 4150c53..4d3da4e 100644
--- a/core/src/test/java/mc/core/utils/TestCompactedCoords.java
+++ b/core/src/test/java/mc/core/utils/TestCompactedCoords.java
@@ -8,7 +8,7 @@ import java.util.Random;
 
 public class TestCompactedCoords {
     @Test
-    public void testSimple() {
+    public void testXZSimple() {
         for (int z = -100; z <= 100; z++) {
             for (int x = -100; x <= 100; x++) {
                 int compressXZ = CompactedCoords.compressXZ(x, z);
@@ -21,7 +21,7 @@ public class TestCompactedCoords {
     }
 
     @Test
-    public void testRandom() {
+    public void testXZRandom() {
         Random random = new Random();
         int x,z;
 
@@ -42,4 +42,20 @@ public class TestCompactedCoords {
             Assert.assertEquals(z, xz[1]);
         }
     }
+
+//    @Test
+    public void testXYZSimple() {
+        for (int z = -100; z <= 100; z++) {
+            for (int x = -100; x <= 100; x++) {
+                for (int y = -100; y <= 100; y++) {
+                    long compressXYZ = CompactedCoords.compressXYZ(x, y, z);
+                    double[] xyz = CompactedCoords.uncompressXYZ(compressXYZ);
+
+                    Assert.assertEquals(x, xyz[0], 0.001d);
+                    Assert.assertEquals(y, xyz[1], 0.001d);
+                    Assert.assertEquals(z, xyz[2], 0.001d);
+                }
+            }
+        }
+    }
 }