Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 1 | /* |
Andrew Walbran | 692b325 | 2019-03-07 15:51:31 +0000 | [diff] [blame] | 2 | * Copyright 2019 The Hafnium Authors. |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 3 | * |
Andrew Walbran | e959ec1 | 2020-06-17 15:01:09 +0100 | [diff] [blame] | 4 | * Use of this source code is governed by a BSD-style |
| 5 | * license that can be found in the LICENSE file or at |
| 6 | * https://opensource.org/licenses/BSD-3-Clause. |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 7 | */ |
| 8 | |
| 9 | #include <stdint.h> |
| 10 | |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 11 | #include "hf/ffa.h" |
Andrew Scull | 8d9e121 | 2019-04-05 13:52:55 +0100 | [diff] [blame] | 12 | #include "hf/std.h" |
Jose Marinho | a1dfeda | 2019-02-27 16:46:03 +0000 | [diff] [blame] | 13 | |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 14 | #include "vmapi/hf/call.h" |
| 15 | |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 16 | #include "primary_with_secondary.h" |
Andrew Walbran | 1e7c774 | 2019-12-13 17:10:02 +0000 | [diff] [blame] | 17 | #include "test/hftest.h" |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 18 | #include "test/vmapi/ffa.h" |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 19 | |
| 20 | /** |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 21 | * Causes secondary VM to send two messages to primary VM. The second message |
| 22 | * will reach the mailbox while it's not writable. Checks that notifications are |
| 23 | * properly delivered when mailbox is cleared. |
| 24 | */ |
| 25 | TEST(mailbox, primary_to_secondary) |
| 26 | { |
| 27 | char message[] = "not ready echo"; |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 28 | struct ffa_value run_res; |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 29 | struct mailbox_buffers mb = set_up_mailbox(); |
| 30 | |
Fuad Tabba | 7bd1413 | 2019-11-07 14:18:52 +0000 | [diff] [blame] | 31 | SERVICE_SELECT(SERVICE_VM1, "echo_with_notification", mb.send); |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 32 | |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 33 | run_res = ffa_run(SERVICE_VM1, 0); |
| 34 | EXPECT_EQ(run_res.func, FFA_MSG_WAIT_32); |
| 35 | EXPECT_EQ(run_res.arg2, FFA_SLEEP_INDEFINITE); |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 36 | |
| 37 | /* Send a message to echo service, and get response back. */ |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 38 | memcpy_s(mb.send, FFA_MSG_PAYLOAD_MAX, message, sizeof(message)); |
Andrew Walbran | 70bc862 | 2019-10-07 14:15:58 +0100 | [diff] [blame] | 39 | EXPECT_EQ( |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 40 | ffa_msg_send(HF_PRIMARY_VM_ID, SERVICE_VM1, sizeof(message), 0) |
Andrew Walbran | 70bc862 | 2019-10-07 14:15:58 +0100 | [diff] [blame] | 41 | .func, |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 42 | FFA_SUCCESS_32); |
| 43 | run_res = ffa_run(SERVICE_VM1, 0); |
| 44 | EXPECT_EQ(run_res.func, FFA_MSG_SEND_32); |
| 45 | EXPECT_EQ(ffa_msg_send_size(run_res), sizeof(message)); |
Andrew Walbran | 70bc862 | 2019-10-07 14:15:58 +0100 | [diff] [blame] | 46 | EXPECT_EQ(memcmp(mb.recv, message, sizeof(message)), 0); |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 47 | |
| 48 | /* Let secondary VM continue running so that it will wait again. */ |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 49 | run_res = ffa_run(SERVICE_VM1, 0); |
| 50 | EXPECT_EQ(run_res.func, FFA_MSG_WAIT_32); |
| 51 | EXPECT_EQ(run_res.arg2, FFA_SLEEP_INDEFINITE); |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 52 | |
| 53 | /* Without clearing our mailbox, send message again. */ |
Andrew Scull | 55baca6 | 2019-04-05 14:56:20 +0100 | [diff] [blame] | 54 | reverse(message, strnlen_s(message, sizeof(message))); |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 55 | memcpy_s(mb.send, FFA_MSG_PAYLOAD_MAX, message, sizeof(message)); |
Jose Marinho | a1dfeda | 2019-02-27 16:46:03 +0000 | [diff] [blame] | 56 | |
| 57 | /* Message should be dropped since the mailbox was not cleared. */ |
Andrew Walbran | 70bc862 | 2019-10-07 14:15:58 +0100 | [diff] [blame] | 58 | EXPECT_EQ( |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 59 | ffa_msg_send(HF_PRIMARY_VM_ID, SERVICE_VM1, sizeof(message), 0) |
Andrew Walbran | 70bc862 | 2019-10-07 14:15:58 +0100 | [diff] [blame] | 60 | .func, |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 61 | FFA_SUCCESS_32); |
| 62 | run_res = ffa_run(SERVICE_VM1, 0); |
| 63 | EXPECT_EQ(run_res.func, HF_FFA_RUN_WAIT_FOR_INTERRUPT); |
| 64 | EXPECT_EQ(run_res.arg2, FFA_SLEEP_INDEFINITE); |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 65 | |
| 66 | /* Clear the mailbox. We expect to be told there are pending waiters. */ |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 67 | EXPECT_EQ(ffa_rx_release().func, FFA_RX_RELEASE_32); |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 68 | |
| 69 | /* Retrieve a single waiter. */ |
Fuad Tabba | 7bd1413 | 2019-11-07 14:18:52 +0000 | [diff] [blame] | 70 | EXPECT_EQ(hf_mailbox_waiter_get(HF_PRIMARY_VM_ID), SERVICE_VM1); |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 71 | EXPECT_EQ(hf_mailbox_waiter_get(HF_PRIMARY_VM_ID), -1); |
| 72 | |
| 73 | /* |
| 74 | * Inject interrupt into VM and let it run again. We should receive |
| 75 | * the echoed message. |
| 76 | */ |
| 77 | EXPECT_EQ( |
Fuad Tabba | 7bd1413 | 2019-11-07 14:18:52 +0000 | [diff] [blame] | 78 | hf_interrupt_inject(SERVICE_VM1, 0, HF_MAILBOX_WRITABLE_INTID), |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 79 | 1); |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 80 | run_res = ffa_run(SERVICE_VM1, 0); |
| 81 | EXPECT_EQ(run_res.func, FFA_MSG_SEND_32); |
| 82 | EXPECT_EQ(ffa_msg_send_size(run_res), sizeof(message)); |
Andrew Walbran | 70bc862 | 2019-10-07 14:15:58 +0100 | [diff] [blame] | 83 | EXPECT_EQ(memcmp(mb.recv, message, sizeof(message)), 0); |
Andrew Walbran | b5ab43c | 2020-04-30 11:32:54 +0100 | [diff] [blame] | 84 | EXPECT_EQ(ffa_rx_release().func, FFA_SUCCESS_32); |
Andrew Scull | 2e7a76d | 2019-01-24 11:47:26 +0000 | [diff] [blame] | 85 | } |