Cleaned Vision Code

[alantao5056]

• Added new Camera Enum, containing two cameras
• Removed repeated code and put it as methods in Camera Enum
• Changed multiple members and functions to static

Now there can be multiple cameras, without repeated code for each one. Build is successful but the simulation still crashes.
I have not implemented looping over the cameras yet.

[prensing]

Alan, you need to merge in the changes from "main". You also removed the code paths which use results when only 1 camera is seeing a tag.