Updated transformation matrix to support multiply by vector