doAlarmLogic

- Used a filter to filter out the gravitational force
- implemented doAlarm but its UNTESTED yet