Code: Corrected bugs in optical flow fusion

X flow innovations now look correct, however there is still an error
in Y flow innovations, that looks like a combined sign error in both
the prediction and measurement