added matrix operations functions (Rot, Trans)
added test script
README update