Highschooler implementing a Kalman Filter for sensor fusion