blob: aa39ef2307a69324b2b435f8aa9670450935459b [file] [log] [blame]
Manish Pandey9ee6a8d2021-03-03 09:53:33 +00001/*
2 * Copyright (c) 2021, Arm Limited. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7#include <common/debug.h>
8#include <sp_helpers.h>
9#include <spm_helpers.h>
10
11#include "cactus_message_loop.h"
12#include "cactus_test_cmds.h"
13
14CACTUS_CMD_HANDLER(sleep_cmd, CACTUS_SLEEP_CMD)
15{
Madhukar Pappireddya09d5f72021-10-26 14:50:52 -050016 uint64_t time_lapsed;
Manish Pandey9ee6a8d2021-03-03 09:53:33 +000017 uint32_t sleep_time = cactus_get_sleep_time(*args);
18
Madhukar Pappireddya09d5f72021-10-26 14:50:52 -050019 VERBOSE("Request to sleep %x for %ums.\n", ffa_dir_msg_dest(*args),
20 sleep_time);
Manish Pandey9ee6a8d2021-03-03 09:53:33 +000021
Madhukar Pappireddya09d5f72021-10-26 14:50:52 -050022 time_lapsed = sp_sleep_elapsed_time(sleep_time);
Manish Pandey9ee6a8d2021-03-03 09:53:33 +000023
Madhukar Pappireddya09d5f72021-10-26 14:50:52 -050024 /* Lapsed time should be at least equal to sleep time. */
25 VERBOSE("Sleep complete: %llu\n", time_lapsed);
Manish Pandey9ee6a8d2021-03-03 09:53:33 +000026
27 return cactus_response(ffa_dir_msg_dest(*args),
28 ffa_dir_msg_source(*args),
29 time_lapsed);
30}
31
32CACTUS_CMD_HANDLER(interrupt_cmd, CACTUS_INTERRUPT_CMD)
33{
34 uint32_t int_id = cactus_get_interrupt_id(*args);
35 bool enable = cactus_get_interrupt_enable(*args);
36 enum interrupt_pin pin = cactus_get_interrupt_pin(*args);
37 int64_t ret;
38
39 ret = spm_interrupt_enable(int_id, enable, pin);
40 if (ret != 0) {
41 return cactus_error_resp(ffa_dir_msg_dest(*args),
42 ffa_dir_msg_source(*args),
43 CACTUS_ERROR_TEST);
44 }
45
46 return cactus_response(ffa_dir_msg_dest(*args),
47 ffa_dir_msg_source(*args),
48 CACTUS_SUCCESS);
49}