Better exit handling

- Fixes ROS not shutting down on Ctrl+c
- Fixes GUI not shutting down on rosnode kill