diff --git a/library/ssl_cli.c b/library/ssl_cli.c
index e0ffbc6..9e2b0ad 100644
--- a/library/ssl_cli.c
+++ b/library/ssl_cli.c
@@ -2343,7 +2343,6 @@
         size_t sig_alg_len = ( ( buf[mbedtls_ssl_hs_hdr_len( ssl ) + 1 + n] <<  8 )
                              | ( buf[mbedtls_ssl_hs_hdr_len( ssl ) + 2 + n]       ) );
 
-        p = buf + mbedtls_ssl_hs_hdr_len( ssl ) + 3 + n;
         m += 2;
         n += sig_alg_len;
 
diff --git a/library/ssl_srv.c b/library/ssl_srv.c
index 02bc3db..0a61f48 100644
--- a/library/ssl_srv.c
+++ b/library/ssl_srv.c
@@ -1932,8 +1932,6 @@
         p += ssl->verify_data_len;
         memcpy( p, ssl->own_verify_data, ssl->verify_data_len );
         p += ssl->verify_data_len;
-
-        *olen = 5 + ssl->verify_data_len * 2;
     }
     else
 #endif /* MBEDTLS_SSL_RENEGOTIATION */
@@ -1941,9 +1939,9 @@
         *p++ = 0x00;
         *p++ = 0x01;
         *p++ = 0x00;
-
-        *olen = 5;
     }
+
+    *olen = p - buf;
 }
 
 #if defined(MBEDTLS_SSL_MAX_FRAGMENT_LENGTH)
@@ -2856,7 +2854,6 @@
 
         MBEDTLS_SSL_DEBUG_BUF( 3, "my signature", p, signature_len );
 
-        p += signature_len;
         n += signature_len;
     }
 #endif /* MBEDTLS_KEY_EXCHANGE_DHE_RSA_ENABLED) ||