Real Time Stereo Vision algorithm. Code developed on Vivado in order to run on an FPGA