more robust lightbarrier detection code and more debuging outputs
more robust lightbarrier detection code and more debuging outputs

Octanis3/Octanis3-Firmware,Octanis3/Octanis3-Firmware,Octanis3/Octanis3-Firmware