Draw frame with OpenCV.
Added basic synchronization between the draw and kalman filter threads.