diff --git a/programs/test/benchmark.c b/programs/test/benchmark.c
index dd4303b..ff1f4d1 100644
--- a/programs/test/benchmark.c
+++ b/programs/test/benchmark.c
@@ -254,6 +254,14 @@
          rsa, dhm, ecdsa, ecdh;
 } todo_list;
 
+#if defined( MBEDTLS_CHECK_PARAMS ) && defined(MBEDTLS_PLATFORM_C)
+void mbedtls_param_failed( char* failure_condition, char* file, int line )
+{
+    mbedtls_printf("%s:%i: Input param failed - %sn", file, line,                           failure_condition );
+    mbedtls_exit( MBEDTLS_EXIT_FAILURE );
+}
+#endif
+
 int main( int argc, char *argv[] )
 {
     int i;