matrixsqf.h

#ifndef _AVRIO_MATRIXSQF_H_
#define _AVRIO_MATRIXSQF_H_

#include <avrio/defs.h>

__BEGIN_C_DECLS
/* ========================================================================== */

#define MSQ(_mat) _mat[0]

/* internal public functions ================================================ */

void vMatrixSqfAdd (float * xOut, const float * xIn1, const float * xIn2,  uint8_t ucOrder);

void vMatrixSqfSub (float * xOut, const float * xIn1, const float * xIn2,  uint8_t ucOrder);

void vMatrixSqfMul (float * xOut, const float * xIn1, const float * xIn2,  uint8_t ucOrder);

void vMatrixSqfScale (float * xOut, const float * xIn, float fConst, uint8_t ucOrder);

void vMatrixSqfMulK (float * xMat, float fConst, uint8_t ucOrder);

void vMatrixSqfDivK (float * xMat, float fConst, uint8_t ucOrder);

void vMatrixSqfClear (float * xIn1, uint8_t ucOrder);

bool bMatrixSqfIsCleared (const float * xIn1, uint8_t ucOrder);

bool bMatrixSqfEq (const float * xIn1, const float * xIn2, uint8_t ucOrder);

void vMatrixSqfCopy (float * xDst, const float * xSrc, uint8_t ucOrder);

__END_C_DECLS
/* ========================================================================== */
#endif  /* _AVRIO_MATRIXSQF_H_ not defined */