Kmat: updated from the NAOKinematics git

Signed-off-by: eldrad <nikofinas@gmail.com>