matrix: Add point3d transformation

Issue: #18
Merge pull request #19 from ebassi/issues/18

matrix: Add point3d transformation