Adding a small time delay (5 seconds) between toggling safety. Fixed bug in controller code to not say 'System Armed' when disarming.