diff --git a/preload/apps/ecg/__init__.py b/preload/apps/ecg/__init__.py
index 6a0dd08886f37173306c49bbf40eee792d105f89..fd20d8f39697ae6245d41e3c67f5673b83a710ee 100644
--- a/preload/apps/ecg/__init__.py
+++ b/preload/apps/ecg/__init__.py
@@ -384,4 +384,8 @@ def main():
 
 
 if __name__ == "__main__":
-    main()
+    try:
+        main()
+    except KeyboardInterrupt as e:
+        sensor.close()
+        raise e