Add hftest macros to fail with a message.

Fail if secondary gets unexpected message.

Change-Id: I410e48b67e0dbe33daaf744c7408a99a031a78ac
diff --git a/test/hftest/inc/hftest_impl.h b/test/hftest/inc/hftest_impl.h
index 7a7be34..3d4a44a 100644
--- a/test/hftest/inc/hftest_impl.h
+++ b/test/hftest/inc/hftest_impl.h
@@ -228,6 +228,17 @@
 		}                                                          \
 	} while (0)
 
+#define HFTEST_FAIL(message, fatal)                                        \
+	do {                                                               \
+		struct hftest_context *ctx = hftest_get_context();         \
+		++ctx->failures;                                           \
+		HFTEST_LOG_FAILURE();                                      \
+		dlog(HFTEST_LOG_PREFIX HFTEST_LOG_INDENT "%s\n", message); \
+		if (fatal) {                                               \
+			ctx->abort();                                      \
+		}                                                          \
+	} while (0)
+
 /**
  * Select the service to run in a service VM.
  */