diff options
author | Jonny Svärd <jonny.svaerd@arm.com> | 2020-10-06 14:18:28 +0200 |
---|---|---|
committer | Jonny Svärd <jonny.svaerd@arm.com> | 2020-10-09 14:23:21 +0200 |
commit | 44398c86f932b96911dd1558e2b66726943fcf46 (patch) | |
tree | c2ff3e24735c511f07dd902ebb7430602bec17d9 /drivers/mailbox/src/mailbox.cc | |
parent | dc28b13e8bf4e5e7a788f289739e6301494c43a1 (diff) | |
download | ethos-u-core-software-44398c86f932b96911dd1558e2b66726943fcf46.tar.gz |
Add a Mailbox interface
Change-Id: If68e70709c496849cb781af5f7288fa3f7ddcdb5
Diffstat (limited to 'drivers/mailbox/src/mailbox.cc')
-rw-r--r-- | drivers/mailbox/src/mailbox.cc | 65 |
1 files changed, 65 insertions, 0 deletions
diff --git a/drivers/mailbox/src/mailbox.cc b/drivers/mailbox/src/mailbox.cc new file mode 100644 index 0000000..0d3dfed --- /dev/null +++ b/drivers/mailbox/src/mailbox.cc @@ -0,0 +1,65 @@ +/* + * Copyright (c) 2020 Arm Limited. All rights reserved. + * + * SPDX-License-Identifier: Apache-2.0 + * + * Licensed under the Apache License, Version 2.0 (the License); you may + * not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an AS IS BASIS, WITHOUT + * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ + +#include <mailbox.hpp> + +#include <cstddef> +#include <cassert> + +namespace Mailbox { + +Mailbox::Mailbox() {} +Mailbox::~Mailbox() {} + +bool Mailbox::verifyHardware() { + return true; +} + +void Mailbox::registerCallback(CallbackFptr callback, void *userArg) { + callbacks.push_back({callback, userArg}); +} + +void Mailbox::deregisterCallback(CallbackFptr callback, void *userArg) { + callbacks.remove({callback, userArg}); +} + +void Mailbox::notify() { + for (auto &it : callbacks) { + it.callback(it.userArg); + } +} + +uint32_t Mailbox::read32(volatile uint32_t *baseAddr, const uint32_t offset) { + assert(offset % 4 == 0); + volatile uint32_t *addr = baseAddr + (offset / 4); + + return *addr; +} + +void Mailbox::write32(volatile uint32_t *baseAddr, const uint32_t offset, const uint32_t value) { + assert(offset % 4 == 0); + volatile uint32_t *addr = baseAddr + (offset / 4); + + *addr = value; +} + +bool Mailbox::Callback::operator==(const Callback &b) const { + return (callback == b.callback && userArg == b.userArg); +} + +} // namespace Mailbox |