Updated Arduino code for BLE testing