GetStartPos and GetNewPos methods both now use Vector3 rather then matrix