magcoordinatealignfilter.h

Go to the documentation of this file.

 
#ifndef MAGCOORDINATEALIGNFILTER_H
#define MAGCOORDINATEALIGNFILTER_H
 
#include "datatypes/orientationdata.h"
#include "filter.h"
 
class TMagMatrix {
private:
    static const int DIM = 3;
 
public:
    TMagMatrix() {
        setMatrix((const double[DIM][DIM]){{1,0,0},{0,1,0},{0,0,1}});
    }
    TMagMatrix(const TMagMatrix& other) {
        setMatrix(other.data_);
    }
    TMagMatrix(double m[][DIM]) {
        setMatrix(m);
    }
 
    double get(int i, int j) const {
        if (i >= DIM || j >= DIM || i < 0 || j < 0) {
            qWarning("Index out of bounds");
            return 0;
        }
        return data_[i][j];
    };
 
    void setMatrix(const double m[DIM][DIM]) {
        memcpy(data_, m, sizeof(double[DIM][DIM]));
    }
 
    double data_[DIM][DIM];
};
Q_DECLARE_METATYPE(TMagMatrix)
 
 
class MagCoordinateAlignFilter : public QObject, public Filter<CalibratedMagneticFieldData, MagCoordinateAlignFilter, CalibratedMagneticFieldData>
{
    Q_OBJECT
    Q_PROPERTY(TMagMatrix transMatrix READ matrix WRITE setMatrix)
public:
 
    static FilterBase* factoryMethod() {
        return new MagCoordinateAlignFilter;
    }
 
    const TMagMatrix& matrix() const { return matrix_; }
 
    void setMatrix(const TMagMatrix& matrix) { matrix_ = matrix; }
 
protected:
    MagCoordinateAlignFilter();
 
private:
    void filter(unsigned, const CalibratedMagneticFieldData*);
 
    TMagMatrix matrix_;
};
 
#endif // MagCoordinateAlignFilter_H