wntrmute/wrmath
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Start Madwick filters.

Browse Source
This commit is contained in:
Kyle Isom
2019-08-06 22:49:20 -07:00
parent 7a932f422a
commit 971f324d7f
9 changed files with 286 additions and 69 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
tools/euler2quat.cc
View File

@@ -34,12 +34,12 @@ convertEulerToQuat(char **argv)
static void
convertQuatToEuler(char **argv)
{
double x = stod(string(argv[0]));
double y = stod(string(argv[1]));
double z = stod(string(argv[1]));
double w = stod(string(argv[1]));
double x = stod(string(argv[1]));
double y = stod(string(argv[2]));
double z = stod(string(argv[3]));
double w = stod(string(argv[0]));
geom::Quaterniond quaternion {x, y, z, w};
geom::Quaterniond quaternion {w, x, y, z};
auto euler = quaternion.euler() * (180.0 / M_PI);
cout << "Euler ZYX: " << euler << endl;