Code : Update data logging and use range finder selection
Code : tidy-up, improvements to optical flow use criteria and plotting