Implement firmware update
Bugfixes
Add ant firmware update
Cleanup
Remove new thread
Disable interrtupts after reti
Improve ble spi