Impact detection working, define DEBUG_IMPACT to enable debug mode