stupid matrix4x4 works, next step NxN matrix

Signed-off-by: fabio <fbi.gritti@gmail.com>