You are on page 1of 6

Location and Orientation

about the capsule


(without outer magnetic field)
:
:

P be the vector that represents a spatial point


p=(xl, yl, zl)T
the magnet position
(a, b, c)T

Two norm error

A good Algorithms
1) initial guess of the parameters, or their bounds of the initial
guess of the parameters.
2) The minimization algorithm should be fast enough to enable
real time implementation.
3)Robust to the noises in the sensor data.

Levenberg-Marquardt method
Gauss-Newton algorithms & gradient iterations
Matlab:
lsqnonlin least squares solution
Fsolve

roots of the nonlinear equations

Donald W. Marquardt, An Algorithm for Least-Squares Estimation of

Nonlinear Parameters, Journal of the Society for Industrial and Applie


d
Mathematics, Vol.11, No.2, 1963, pp.431~441.

You might also like