KMat

Added loopbackhandle definition for Vector 3x1
Added EulerAngle Decomposition
NaoKinematics Refactor
NaoKinematics testing
KMat  Add shortcut for Double vectors
KinematicDefines

All to doubles
NaoKinematics

Typedef types duh
changed to double precision math
Kinematics Testing