added new helper class for 3x3 matrices and vec3 added magnetometer data added compass detection refactored pose-estimation (single class) refactored debug plots (move to own class) minor changes
added new sanity checks fixed minor errors added corresponding test-cases added moving-median