Temporary Commit
More temporary commits.

This one has some useful edge tracking stuff though.
Temporary commit

Added the camera pos stuff.
Temps.

Temporary commit.
Changes to make the LKT video
Temp Commits.

Random Changes.
Plotting RMS Stuff

RMS error plotting code.