blob: 96c80df0ea8f0f0a3f81b9b021a415f457122948 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
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 <cassert>
#include <cstddef>
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
|
