Too used to column-major had it backwards. Also forgot matrix mult!

Will add proper implementation haha
Testing and fixing up matrix, adding proper matrix mult hehe