|
@@ -157,6 +157,8 @@ export class PoseFilter
|
157
|
157
|
|
158
|
158
|
// average *nearby* rotations
|
159
|
159
|
// based on https://web.archive.org/web/20130514122622/http://wiki.unity3d.com/index.php/Averaging_Quaternions_and_Vectors
|
|
160
|
+ // reminder: a unit quaternion q may be expressed as
|
|
161
|
+ // cos t + u sin t, where 2t is a rotation angle and u is a rotation axis
|
160
|
162
|
for(let i = 0; i < R; i++) {
|
161
|
163
|
const qi = this._rotationSample[i];
|
162
|
164
|
const w = 1 / R; //(R - (i - i%2)) / R;
|