ACS Ctrl Action Cmds #401
@ -10,8 +10,6 @@
|
||||
|
||||
#include <iostream>
|
||||
|
||||
#include "fsfw/timemanager/Stopwatch.h"
|
||||
|
||||
using namespace Math;
|
||||
|
||||
template <typename T1, typename T2 = T1>
|
||||
@ -333,10 +331,6 @@ class MathOperations {
|
||||
|
||||
static int inverseMatrix(const T1 *inputMatrix, T1 *inverse, uint8_t size) {
|
||||
// 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++) {
|
||||
@ -351,7 +345,6 @@ class MathOperations {
|
||||
}
|
||||
// gauss-jordan algo
|
||||
// sort matrix such as no diag entry shall be 0
|
||||
// should not be needed as such a matrix has a det=0
|
||||
for (uint8_t row = 0; row < size; row++) {
|
||||
if (matrix[row][row] == 0.0) {
|
||||
bool swaped = false;
|
||||
|
Loading…
Reference in New Issue
Block a user