20#ifndef AHRS_FLOAT_DCM_ALGEBRA_H
21#define AHRS_FLOAT_DCM_ALGEBRA_H
67 for (
int x = 0; x < 3; x++) {
68 for (
int y = 0; y < 3; y++) {
69 for (
int w = 0; w < 3; w++) {
70 op[w] = a[x][w] *
b[w][y];
static void Vector_Add(float vectorOut[3], float vectorIn1[3], float vectorIn2[3])
static void Matrix_Multiply(float a[3][3], float b[3][3], float mat[3][3])
static void Vector_Scale(float vectorOut[3], float vectorIn[3], float scale2)
static float Vector_Dot_Product(float vector1[3], float vector2[3])
static void Vector_Cross_Product(float vectorOut[3], float v1[3], float v2[3])