Matrices premuliplying

common/src/main/kotlin/com/lambda/graphics/buffer/vao/IRenderContext.kt

@@ -1,10 +1,16 @@
 package com.lambda.graphics.buffer.vao
 
+import com.lambda.graphics.gl.Matrices
+import org.joml.Matrix4f
 import java.awt.Color
 
 interface IRenderContext {
     fun vec3(x: Double, y: Double, z: Double): IRenderContext
     fun vec2(x: Double, y: Double): IRenderContext
+
+    fun vec3m(x: Double, y: Double, z: Double, matrix4f: Matrix4f = Matrices.peek()): IRenderContext
+    fun vec2m(x: Double, y: Double, matrix4f: Matrix4f = Matrices.peek()): IRenderContext
+
     fun float(v: Double): IRenderContext
     fun color(color: Color): IRenderContext
     fun end(): Int

common/src/main/kotlin/com/lambda/graphics/buffer/vao/VAO.kt

@@ -21,6 +21,7 @@ import com.lambda.graphics.gl.VaoUtils.unbindIndexBuffer
 import com.lambda.graphics.gl.VaoUtils.unbindVertexArray
 import com.lambda.graphics.gl.VaoUtils.unbindVertexBuffer
 import com.lambda.threading.runGameScheduled
+import org.joml.*
 import org.lwjgl.opengl.GL30C.*
 import java.awt.Color
 import java.nio.ByteBuffer
@@ -88,6 +89,19 @@ class VAO(
         return this
     }
 
+    override fun vec3m(x: Double, y: Double, z: Double, matrix4f: Matrix4f): IRenderContext {
+        // ToDo: optimize at runtime
+        val vec = Vector4d(x, y, z, 1.0).apply(Matrix4d(matrix4f)::transform)
+        verticesPosition += vec3(verticesPosition, vec.x, vec.y, vec.z)
+        return this
+    }
+
+    override fun vec2m(x: Double, y: Double, matrix4f: Matrix4f): IRenderContext {
+        val vec = Vector4d(x, y, 0.0, 1.0).apply(Matrix4d(matrix4f)::transform)
+        verticesPosition += vec2(verticesPosition, vec.x, vec.y)
+        return this
+    }
+
     override fun float(v: Double): VAO {
         verticesPosition += float(verticesPosition, v)
         return this