Task for this project was to implement filtering algorithms from scratch for angular position and velocity estimation for a pendulum system with varying measurement noise and data query frequency.
Implemented Extended Kalman Filter for a first order linearization of the nonlinear system, UKF with 5 points to perform quadrature integration at the Unscented points with associated weights, 3rd and 5th order Gauss Hermite to perform quadrature integration.
For the particle filter, implemented the bootstrap proposal, which is the dynamics of the system of the proposal for the Importance Sampling step and the optimal proposal, which is the proposal that aims to minimize the variance of the weights of the particles.