Finished incorporating cboulay's matlab srukf filter into KalmanPoseFilter. Untested. Needs review.
Finished incorporating cboulay's matlab srukf filter into KalmanPoseFilter. Untested. Needs review.

cboulay/PSMoveService,zelmon64/PSMoveService,cboulay/PSMoveService,cboulay/PSMoveService,zelmon64/PSMoveService,gb2111/PSMoveService,zelmon64/PSMoveService,gb2111/PSMoveService,gb2111/PSMoveService,zelmon64/PSMoveService,cboulay/PSMoveService,cboulay/PSMoveService,gb2111/PSMoveService,zelmon64/PSMoveService,gb2111/PSMoveService