transform3DPointUsing4x4Matrix rewritten