diff --git a/src/apdu.c b/src/apdu.c
index 6a32225..20ccde8 100644
--- a/src/apdu.c
+++ b/src/apdu.c
@@ -221,8 +221,7 @@ done:   ;
 }
 
 void apdu_finish() {
-    apdu.rdata[apdu.rlen] = apdu.sw >> 8;
-    apdu.rdata[apdu.rlen + 1] = apdu.sw & 0xff;
+    put_uint16_t_be(apdu.sw, apdu.rdata + apdu.rlen);
     // timeout_stop();
 #ifndef ENABLE_EMULATION
     if ((apdu.rlen + 2 + 10) % 64 == 0) {     // FIX for strange behaviour with PSCS and multiple of 64