Change Matrix and Point management and add Vectors and Quaternions