Hi jornte,
Sorry, I do not want to give the source code away at this time, maybe I'll change my mind later.
But I made a test version for you (for link see my PM). It allows to change the update rate of the camera data. Most (matrix/float) calculations and the process memory access are made in...