added XYZ kinematics and user interface
Matrix4 added