#0004 Add transformation matrix creation but we need more accurate algorithm