Add code for reading distance to object

Required a foefel factor to get it accurate.
Add IR based shooting and scan
Add scan code in loop commented (to big in size)