Implemented the interrupt mechanism (using poll) and basic detection detection logics
Need to fine tune for real environments (on bikes)