Trajectory Optimization for Well-Conditioned Parameter Estimation

When attempting to estimate parameters in a dynamical system, it is often beneficial to strategically design experimental trajectories that facilitate the estimation process. This paper presents an optimization algorithm which improves conditioning of estimation problems by modifying the experimental trajectory. An objective function which minimizes the condition number of the Hessian of the least-squares identification method is derived and a least-squares method is used to estimate parameters of the nonlinear system. A software-simulated example demonstrates that an arbitrarily designed trajectory can lead to an ill-conditioned least-squares estimation problem, which in turn leads to slower convergence to the best estimate and, in the presence of experimental uncertainties, may lead to no convergence at all. A physical experiment with a robot-controlled suspended mass also shows improved estimation results in practice in the presence of noise and uncertainty using the optimized trajectory.