Refactored code organization, got BLE to connect, write, but not subscribe :(