Master interrupt slave

- Added in debug info to serial
- Moved gps disable and enable calls to ensure timings are correct