Added visualization for camera views and orthogonal projections.
Camera projection tested.
Added a function for computing a similarity score between state and measurement.
Got a working simulator? Fixed bugs in a number of places. Most importantly, scaled focal length by 200 to get rid of numerical errors.
Fixed Bugs. Three trackers running now - Cam1, Cam2, Multiplexer.
Parzen window computation of distribution from samples. Also computing entropy. Things wrong are that I assume the likelihood of the state vector as the same for the angle difference and no marginalization is performed. Might be underflow due to small likelihood values that later need to be switched to log-likelioods.
Manually corrected conflicts.