How to handle the second-ordered term in calculating the derivative term for state vector ?
Beanocean opened this issue · 0 comments
Beanocean commented
I have a question about using this fantastic library. The problem can be simplified as follows.
In the uniformly accelerated motion,
How to write the state derivative term for
using ProcessModelTestStateVector = UKF::StateVector<
UKF::Field<Position, real_t>,
UKF::Field<Velocity, real_t>,
UKF::Field<Acceleration, real_t>
>;
template <> template <>
ProcessModelTestStateVector ProcessModelTestStateVector::derivative<>() const {
ProcessModelTestStateVector temp;
/* Position derivative. */
temp.set_field<Position>(get_field<Velocity>()); // how to handle the acceleration term?
/* Velocity derivative. */
temp.set_field<Velocity>(get_field<Acceleration>());
/* Velocity derivative. */
temp.set_field<Acceleration>(0.);
return temp;
}