I8 kalman filter

[rebellojason7]

• Common Kalman filter function
• 3 examples based on slides
• Function that gives matrices for motion model
• Function that gives matrices for measurement model
• Modified to display each iteration for example 2
• Saves video for example 2
• Updated code to reflect comments by reviewers.

[ghost]

Went though all your work. Overall very nice. Look for specific comments on the files.

[nanwei1]

My comments are also in the files. Overall great job making the original code more modular and easier to follow.