eive/eive-obsw
eive/eive-obsw
13
4
Fork 0
Code Issues 4 Pull Requests 1 Releases 121 Wiki Activity

ACS Ctrl Action Cmds #401

Merged
muellerr merged 26 commits from eggert/acs-ctrl-action-cmds into develop 2023-02-24 15:51:08 +01:00
Conversation 2 Commits 26 Files Changed 31 +8 -3
1 changed files with 8 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files
Showing only changes of commit 22bac9e7c0 - Show all commits

11
mission/controller/acs/util/MathOperations.h
View File

@ -10,6 +10,8 @@
#include <iostream>
#include "fsfw/timemanager/Stopwatch.h"
using namespace Math;
template <typename T1, typename T2 = T1>
@ -300,6 +302,7 @@ class MathOperations {
}
static float matrixDeterminant(const T1 *inputMatrix, uint8_t size) {
/* do not use this. takes 300ms */
float det = 0;
T1 matrix[size][size], submatrix[size - 1][size - 1];
for (uint8_t row = 0; row < size; row++) {
@ -329,9 +332,11 @@ class MathOperations {
}
static int inverseMatrix(const T1 *inputMatrix, T1 *inverse, uint8_t size) {
if (MathOperations<T1>::matrixDeterminant(inputMatrix, size) == 0) {
return 1; // Matrix is singular and not invertible
}
// Stopwatch stopwatch;
// if (MathOperations<T1>::matrixDeterminant(inputMatrix, size) == 0) {
// return 1; // Matrix is singular and not invertible
// }
// stopwatch.stop(true);
T1 matrix[size][size], identity[size][size];
// reformat array to matrix
for (uint8_t row = 0; row < size; row++) {