Updating the color filter values and adding trackbars for adjustment
Rewriting the measurament equations
Implementing a simple Kalman Filter