Add senser init, inerrupt and check senser flag