Deadline: June 2
Please complete the following two parts for this homework.
- Please finish the update function in kalman.cpp (you can check out page 20 of the ppt. from week_12)
- Please set parameters in the kf_test.cpp by using the following dynamic model.
Dynamic model:
Suppose that the car is equipped with a position sensor that measures its output y with an additive noise v, please find the state estimate (i.e., position, velocity, acceleration) and compare it with the true state.
The initial condition of the true state is x0=[0; 0; 0].
roscore
rosrun hw11 kf_test