Optical flow module

The optical-flow module is enabled by a STM32F407 with OV9655 camera. The height is compensated with an ultrasonic sensor or a infrared sensor. The estimated velocity has an error of 0.02m/s. And with the sensor, position estimation will have drift.