Minor speed improvement.

Improved speed of computing the sigma points.