basic matrix library that should only be used for the kalman lib.
incl. a example prog that calls most of the functions once.
it can handle all sizes of matrices except for the inversion (only works
with 3x3).