Implement pose-estimation algorithm into program as failsafe for odometry #73
Description
- Document and discuss method to add the algorithm developed in Flowchart (and test) algorithm to estimate pose in field by integrating various sensor inputs #71 to the autonomous program, mainly as a backup to odometry
- Program the algorithm and ensure that it works with the program.
Note: the algorithm itself should already be working, as found in #71, this is about actually implementing it.