PB - sepparated linagl into Matrix3 and Vector3, added controltest