Tracking objects in 3D using Stereo Vision by Kai Hugo Hustoft Endresen