Work on kalman filter interface.

This commit is contained in:
jgoppert
2015-11-12 16:41:07 -05:00
parent 0a110a1b02
commit b9924820e1
3 changed files with 11 additions and 15 deletions
+6
View File
@@ -98,6 +98,12 @@ public:
return r;
}
void operator*=(const Quaternion & other)
{
Quaternion &self = *this;
self = self * other;
}
Matrix41 derivative(const Matrix31 & w) const {
const Quaternion &q = *this;
Type dataQ[] = {