Added creation of homogenouse tranformation matrix