Spin-axis estimation sensors cost function lagrange multiplier method brute force incremental-vector incremental-angle