| @@ -1,717 +1,719 @@ | | | @@ -1,717 +1,719 @@ |
1 | /** | | 1 | /** |
2 | * Copyright (c) 2010-2012 Broadcom. All rights reserved. | | 2 | * Copyright (c) 2010-2012 Broadcom. All rights reserved. |
3 | * | | 3 | * |
4 | * Redistribution and use in source and binary forms, with or without | | 4 | * Redistribution and use in source and binary forms, with or without |
5 | * modification, are permitted provided that the following conditions | | 5 | * modification, are permitted provided that the following conditions |
6 | * are met: | | 6 | * are met: |
7 | * 1. Redistributions of source code must retain the above copyright | | 7 | * 1. Redistributions of source code must retain the above copyright |
8 | * notice, this list of conditions, and the following disclaimer, | | 8 | * notice, this list of conditions, and the following disclaimer, |
9 | * without modification. | | 9 | * without modification. |
10 | * 2. Redistributions in binary form must reproduce the above copyright | | 10 | * 2. Redistributions in binary form must reproduce the above copyright |
11 | * notice, this list of conditions and the following disclaimer in the | | 11 | * notice, this list of conditions and the following disclaimer in the |
12 | * documentation and/or other materials provided with the distribution. | | 12 | * documentation and/or other materials provided with the distribution. |
13 | * 3. The names of the above-listed copyright holders may not be used | | 13 | * 3. The names of the above-listed copyright holders may not be used |
14 | * to endorse or promote products derived from this software without | | 14 | * to endorse or promote products derived from this software without |
15 | * specific prior written permission. | | 15 | * specific prior written permission. |
16 | * | | 16 | * |
17 | * ALTERNATIVELY, this software may be distributed under the terms of the | | 17 | * ALTERNATIVELY, this software may be distributed under the terms of the |
18 | * GNU General Public License ("GPL") version 2, as published by the Free | | 18 | * GNU General Public License ("GPL") version 2, as published by the Free |
19 | * Software Foundation. | | 19 | * Software Foundation. |
20 | * | | 20 | * |
21 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS | | 21 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS |
22 | * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, | | 22 | * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, |
23 | * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR | | 23 | * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR |
24 | * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR | | 24 | * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR |
25 | * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, | | 25 | * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, |
26 | * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, | | 26 | * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, |
27 | * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR | | 27 | * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR |
28 | * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF | | 28 | * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF |
29 | * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING | | 29 | * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING |
30 | * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS | | 30 | * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
31 | * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | | 31 | * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
32 | */ | | 32 | */ |
33 | | | 33 | |
34 | #ifndef VCHIQ_CORE_H | | 34 | #ifndef VCHIQ_CORE_H |
35 | #define VCHIQ_CORE_H | | 35 | #define VCHIQ_CORE_H |
36 | | | 36 | |
37 | #include <interface/compat/vchi_bsd.h> | | 37 | #include <interface/compat/vchi_bsd.h> |
38 | #include <linux/list.h> | | 38 | #include <linux/list.h> |
39 | | | 39 | |
| | | 40 | #include <arm/cpufunc.h> |
| | | 41 | |
40 | #include "vchiq_cfg.h" | | 42 | #include "vchiq_cfg.h" |
41 | | | 43 | |
42 | #include "vchiq.h" | | 44 | #include "vchiq.h" |
43 | | | 45 | |
44 | /* Run time control of log level, based on KERN_XXX level. */ | | 46 | /* Run time control of log level, based on KERN_XXX level. */ |
45 | #ifndef VCHIQ_LOG_DEFAULT | | 47 | #ifndef VCHIQ_LOG_DEFAULT |
46 | #define VCHIQ_LOG_DEFAULT 7 | | 48 | #define VCHIQ_LOG_DEFAULT 7 |
47 | #endif | | 49 | #endif |
48 | #define VCHIQ_LOG_ERROR 3 | | 50 | #define VCHIQ_LOG_ERROR 3 |
49 | #define VCHIQ_LOG_WARNING 4 | | 51 | #define VCHIQ_LOG_WARNING 4 |
50 | #define VCHIQ_LOG_INFO 6 | | 52 | #define VCHIQ_LOG_INFO 6 |
51 | #define VCHIQ_LOG_TRACE 7 | | 53 | #define VCHIQ_LOG_TRACE 7 |
52 | | | 54 | |
53 | #define VCHIQ_LOG_PREFIX "vchiq: " | | 55 | #define VCHIQ_LOG_PREFIX "vchiq: " |
54 | | | 56 | |
55 | #ifndef vchiq_log_error | | 57 | #ifndef vchiq_log_error |
56 | #define vchiq_log_error(cat, fmt, ...) \ | | 58 | #define vchiq_log_error(cat, fmt, ...) \ |
57 | do { if (cat >= VCHIQ_LOG_ERROR) \ | | 59 | do { if (cat >= VCHIQ_LOG_ERROR) \ |
58 | printf_tolog(VCHIQ_LOG_PREFIX fmt "\n", ##__VA_ARGS__); } while (0) | | 60 | printf_tolog(VCHIQ_LOG_PREFIX fmt "\n", ##__VA_ARGS__); } while (0) |
59 | #endif | | 61 | #endif |
60 | #ifndef vchiq_log_warning | | 62 | #ifndef vchiq_log_warning |
61 | #define vchiq_log_warning(cat, fmt, ...) \ | | 63 | #define vchiq_log_warning(cat, fmt, ...) \ |
62 | do { if (cat >= VCHIQ_LOG_WARNING) \ | | 64 | do { if (cat >= VCHIQ_LOG_WARNING) \ |
63 | printf_tolog(VCHIQ_LOG_PREFIX fmt "\n", ##__VA_ARGS__); } while (0) | | 65 | printf_tolog(VCHIQ_LOG_PREFIX fmt "\n", ##__VA_ARGS__); } while (0) |
64 | #endif | | 66 | #endif |
65 | #ifndef vchiq_log_info | | 67 | #ifndef vchiq_log_info |
66 | #define vchiq_log_info(cat, fmt, ...) \ | | 68 | #define vchiq_log_info(cat, fmt, ...) \ |
67 | do { if (cat >= VCHIQ_LOG_INFO) \ | | 69 | do { if (cat >= VCHIQ_LOG_INFO) \ |
68 | printf_tolog(VCHIQ_LOG_PREFIX fmt "\n", ##__VA_ARGS__); } while (0) | | 70 | printf_tolog(VCHIQ_LOG_PREFIX fmt "\n", ##__VA_ARGS__); } while (0) |
69 | #endif | | 71 | #endif |
70 | #ifndef vchiq_log_trace | | 72 | #ifndef vchiq_log_trace |
71 | #define vchiq_log_trace(cat, fmt, ...) \ | | 73 | #define vchiq_log_trace(cat, fmt, ...) \ |
72 | do { if (cat >= VCHIQ_LOG_TRACE) \ | | 74 | do { if (cat >= VCHIQ_LOG_TRACE) \ |
73 | printf_tolog(VCHIQ_LOG_PREFIX fmt "\n", ##__VA_ARGS__); } while (0) | | 75 | printf_tolog(VCHIQ_LOG_PREFIX fmt "\n", ##__VA_ARGS__); } while (0) |
74 | #endif | | 76 | #endif |
75 | | | 77 | |
76 | #define vchiq_loud_error(...) \ | | 78 | #define vchiq_loud_error(...) \ |
77 | vchiq_log_error(vchiq_core_log_level, "===== " __VA_ARGS__) | | 79 | vchiq_log_error(vchiq_core_log_level, "===== " __VA_ARGS__) |
78 | | | 80 | |
79 | #ifndef vchiq_static_assert | | 81 | #ifndef vchiq_static_assert |
80 | #define vchiq_static_assert(cond) __attribute__((unused)) \ | | 82 | #define vchiq_static_assert(cond) __attribute__((unused)) \ |
81 | extern int vchiq_static_assert[(cond) ? 1 : -1] | | 83 | extern int vchiq_static_assert[(cond) ? 1 : -1] |
82 | #endif | | 84 | #endif |
83 | | | 85 | |
84 | #define IS_POW2(x) (x && ((x & (x - 1)) == 0)) | | 86 | #define IS_POW2(x) (x && ((x & (x - 1)) == 0)) |
85 | | | 87 | |
86 | /* Ensure that the slot size and maximum number of slots are powers of 2 */ | | 88 | /* Ensure that the slot size and maximum number of slots are powers of 2 */ |
87 | vchiq_static_assert(IS_POW2(VCHIQ_SLOT_SIZE)); | | 89 | vchiq_static_assert(IS_POW2(VCHIQ_SLOT_SIZE)); |
88 | vchiq_static_assert(IS_POW2(VCHIQ_MAX_SLOTS)); | | 90 | vchiq_static_assert(IS_POW2(VCHIQ_MAX_SLOTS)); |
89 | vchiq_static_assert(IS_POW2(VCHIQ_MAX_SLOTS_PER_SIDE)); | | 91 | vchiq_static_assert(IS_POW2(VCHIQ_MAX_SLOTS_PER_SIDE)); |
90 | | | 92 | |
91 | #define VCHIQ_SLOT_MASK (VCHIQ_SLOT_SIZE - 1) | | 93 | #define VCHIQ_SLOT_MASK (VCHIQ_SLOT_SIZE - 1) |
92 | #define VCHIQ_SLOT_QUEUE_MASK (VCHIQ_MAX_SLOTS_PER_SIDE - 1) | | 94 | #define VCHIQ_SLOT_QUEUE_MASK (VCHIQ_MAX_SLOTS_PER_SIDE - 1) |
93 | #define VCHIQ_SLOT_ZERO_SLOTS ((sizeof(VCHIQ_SLOT_ZERO_T) + \ | | 95 | #define VCHIQ_SLOT_ZERO_SLOTS ((sizeof(VCHIQ_SLOT_ZERO_T) + \ |
94 | VCHIQ_SLOT_SIZE - 1) / VCHIQ_SLOT_SIZE) | | 96 | VCHIQ_SLOT_SIZE - 1) / VCHIQ_SLOT_SIZE) |
95 | | | 97 | |
96 | #define VCHIQ_MSG_PADDING 0 /* - */ | | 98 | #define VCHIQ_MSG_PADDING 0 /* - */ |
97 | #define VCHIQ_MSG_CONNECT 1 /* - */ | | 99 | #define VCHIQ_MSG_CONNECT 1 /* - */ |
98 | #define VCHIQ_MSG_OPEN 2 /* + (srcport, -), fourcc, client_id */ | | 100 | #define VCHIQ_MSG_OPEN 2 /* + (srcport, -), fourcc, client_id */ |
99 | #define VCHIQ_MSG_OPENACK 3 /* + (srcport, dstport) */ | | 101 | #define VCHIQ_MSG_OPENACK 3 /* + (srcport, dstport) */ |
100 | #define VCHIQ_MSG_CLOSE 4 /* + (srcport, dstport) */ | | 102 | #define VCHIQ_MSG_CLOSE 4 /* + (srcport, dstport) */ |
101 | #define VCHIQ_MSG_DATA 5 /* + (srcport, dstport) */ | | 103 | #define VCHIQ_MSG_DATA 5 /* + (srcport, dstport) */ |
102 | #define VCHIQ_MSG_BULK_RX 6 /* + (srcport, dstport), data, size */ | | 104 | #define VCHIQ_MSG_BULK_RX 6 /* + (srcport, dstport), data, size */ |
103 | #define VCHIQ_MSG_BULK_TX 7 /* + (srcport, dstport), data, size */ | | 105 | #define VCHIQ_MSG_BULK_TX 7 /* + (srcport, dstport), data, size */ |
104 | #define VCHIQ_MSG_BULK_RX_DONE 8 /* + (srcport, dstport), actual */ | | 106 | #define VCHIQ_MSG_BULK_RX_DONE 8 /* + (srcport, dstport), actual */ |
105 | #define VCHIQ_MSG_BULK_TX_DONE 9 /* + (srcport, dstport), actual */ | | 107 | #define VCHIQ_MSG_BULK_TX_DONE 9 /* + (srcport, dstport), actual */ |
106 | #define VCHIQ_MSG_PAUSE 10 /* - */ | | 108 | #define VCHIQ_MSG_PAUSE 10 /* - */ |
107 | #define VCHIQ_MSG_RESUME 11 /* - */ | | 109 | #define VCHIQ_MSG_RESUME 11 /* - */ |
108 | #define VCHIQ_MSG_REMOTE_USE 12 /* - */ | | 110 | #define VCHIQ_MSG_REMOTE_USE 12 /* - */ |
109 | #define VCHIQ_MSG_REMOTE_RELEASE 13 /* - */ | | 111 | #define VCHIQ_MSG_REMOTE_RELEASE 13 /* - */ |
110 | #define VCHIQ_MSG_REMOTE_USE_ACTIVE 14 /* - */ | | 112 | #define VCHIQ_MSG_REMOTE_USE_ACTIVE 14 /* - */ |
111 | | | 113 | |
112 | #define VCHIQ_PORT_MAX (VCHIQ_MAX_SERVICES - 1) | | 114 | #define VCHIQ_PORT_MAX (VCHIQ_MAX_SERVICES - 1) |
113 | #define VCHIQ_PORT_FREE 0x1000 | | 115 | #define VCHIQ_PORT_FREE 0x1000 |
114 | #define VCHIQ_PORT_IS_VALID(port) (port < VCHIQ_PORT_FREE) | | 116 | #define VCHIQ_PORT_IS_VALID(port) (port < VCHIQ_PORT_FREE) |
115 | #define VCHIQ_MAKE_MSG(type, srcport, dstport) \ | | 117 | #define VCHIQ_MAKE_MSG(type, srcport, dstport) \ |
116 | ((type<<24) | (srcport<<12) | (dstport<<0)) | | 118 | ((type<<24) | (srcport<<12) | (dstport<<0)) |
117 | #define VCHIQ_MSG_TYPE(msgid) ((unsigned int)msgid >> 24) | | 119 | #define VCHIQ_MSG_TYPE(msgid) ((unsigned int)msgid >> 24) |
118 | #define VCHIQ_MSG_SRCPORT(msgid) \ | | 120 | #define VCHIQ_MSG_SRCPORT(msgid) \ |
119 | (unsigned short)(((unsigned int)msgid >> 12) & 0xfff) | | 121 | (unsigned short)(((unsigned int)msgid >> 12) & 0xfff) |
120 | #define VCHIQ_MSG_DSTPORT(msgid) \ | | 122 | #define VCHIQ_MSG_DSTPORT(msgid) \ |
121 | ((unsigned short)msgid & 0xfff) | | 123 | ((unsigned short)msgid & 0xfff) |
122 | | | 124 | |
123 | #define VCHIQ_FOURCC_AS_4CHARS(fourcc) \ | | 125 | #define VCHIQ_FOURCC_AS_4CHARS(fourcc) \ |
124 | ((fourcc) >> 24) & 0xff, \ | | 126 | ((fourcc) >> 24) & 0xff, \ |
125 | ((fourcc) >> 16) & 0xff, \ | | 127 | ((fourcc) >> 16) & 0xff, \ |
126 | ((fourcc) >> 8) & 0xff, \ | | 128 | ((fourcc) >> 8) & 0xff, \ |
127 | (fourcc) & 0xff | | 129 | (fourcc) & 0xff |
128 | | | 130 | |
129 | /* Ensure the fields are wide enough */ | | 131 | /* Ensure the fields are wide enough */ |
130 | vchiq_static_assert(VCHIQ_MSG_SRCPORT(VCHIQ_MAKE_MSG(0, 0, VCHIQ_PORT_MAX)) | | 132 | vchiq_static_assert(VCHIQ_MSG_SRCPORT(VCHIQ_MAKE_MSG(0, 0, VCHIQ_PORT_MAX)) |
131 | == 0); | | 133 | == 0); |
132 | vchiq_static_assert(VCHIQ_MSG_TYPE(VCHIQ_MAKE_MSG(0, VCHIQ_PORT_MAX, 0)) == 0); | | 134 | vchiq_static_assert(VCHIQ_MSG_TYPE(VCHIQ_MAKE_MSG(0, VCHIQ_PORT_MAX, 0)) == 0); |
133 | vchiq_static_assert((unsigned int)VCHIQ_PORT_MAX < | | 135 | vchiq_static_assert((unsigned int)VCHIQ_PORT_MAX < |
134 | (unsigned int)VCHIQ_PORT_FREE); | | 136 | (unsigned int)VCHIQ_PORT_FREE); |
135 | | | 137 | |
136 | #define VCHIQ_MSGID_PADDING VCHIQ_MAKE_MSG(VCHIQ_MSG_PADDING, 0, 0) | | 138 | #define VCHIQ_MSGID_PADDING VCHIQ_MAKE_MSG(VCHIQ_MSG_PADDING, 0, 0) |
137 | #define VCHIQ_MSGID_CLAIMED 0x40000000 | | 139 | #define VCHIQ_MSGID_CLAIMED 0x40000000 |
138 | | | 140 | |
139 | #define VCHIQ_FOURCC_INVALID 0x00000000 | | 141 | #define VCHIQ_FOURCC_INVALID 0x00000000 |
140 | #define VCHIQ_FOURCC_IS_LEGAL(fourcc) (fourcc != VCHIQ_FOURCC_INVALID) | | 142 | #define VCHIQ_FOURCC_IS_LEGAL(fourcc) (fourcc != VCHIQ_FOURCC_INVALID) |
141 | | | 143 | |
142 | #define VCHIQ_BULK_ACTUAL_ABORTED -1 | | 144 | #define VCHIQ_BULK_ACTUAL_ABORTED -1 |
143 | | | 145 | |
144 | typedef uint32_t BITSET_T; | | 146 | typedef uint32_t BITSET_T; |
145 | | | 147 | |
146 | vchiq_static_assert((sizeof(BITSET_T) * 8) == 32); | | 148 | vchiq_static_assert((sizeof(BITSET_T) * 8) == 32); |
147 | | | 149 | |
148 | #define BITSET_SIZE(b) ((b + 31) >> 5) | | 150 | #define BITSET_SIZE(b) ((b + 31) >> 5) |
149 | #define BITSET_WORD(b) (b >> 5) | | 151 | #define BITSET_WORD(b) (b >> 5) |
150 | #define BITSET_BIT(b) (1 << (b & 31)) | | 152 | #define BITSET_BIT(b) (1 << (b & 31)) |
151 | #define BITSET_ZERO(bs) memset(bs, 0, sizeof(bs)) | | 153 | #define BITSET_ZERO(bs) memset(bs, 0, sizeof(bs)) |
152 | #define BITSET_IS_SET(bs, b) (bs[BITSET_WORD(b)] & BITSET_BIT(b)) | | 154 | #define BITSET_IS_SET(bs, b) (bs[BITSET_WORD(b)] & BITSET_BIT(b)) |
153 | #define BITSET_SET(bs, b) (bs[BITSET_WORD(b)] |= BITSET_BIT(b)) | | 155 | #define BITSET_SET(bs, b) (bs[BITSET_WORD(b)] |= BITSET_BIT(b)) |
154 | #define BITSET_CLR(bs, b) (bs[BITSET_WORD(b)] &= ~BITSET_BIT(b)) | | 156 | #define BITSET_CLR(bs, b) (bs[BITSET_WORD(b)] &= ~BITSET_BIT(b)) |
155 | | | 157 | |
156 | #if VCHIQ_ENABLE_STATS | | 158 | #if VCHIQ_ENABLE_STATS |
157 | #define VCHIQ_STATS_INC(state, stat) (state->stats. stat++) | | 159 | #define VCHIQ_STATS_INC(state, stat) (state->stats. stat++) |
158 | #define VCHIQ_SERVICE_STATS_INC(service, stat) (service->stats. stat++) | | 160 | #define VCHIQ_SERVICE_STATS_INC(service, stat) (service->stats. stat++) |
159 | #define VCHIQ_SERVICE_STATS_ADD(service, stat, addend) \ | | 161 | #define VCHIQ_SERVICE_STATS_ADD(service, stat, addend) \ |
160 | (service->stats. stat += addend) | | 162 | (service->stats. stat += addend) |
161 | #else | | 163 | #else |
162 | #define VCHIQ_STATS_INC(state, stat) ((void)0) | | 164 | #define VCHIQ_STATS_INC(state, stat) ((void)0) |
163 | #define VCHIQ_SERVICE_STATS_INC(service, stat) ((void)0) | | 165 | #define VCHIQ_SERVICE_STATS_INC(service, stat) ((void)0) |
164 | #define VCHIQ_SERVICE_STATS_ADD(service, stat, addend) ((void)0) | | 166 | #define VCHIQ_SERVICE_STATS_ADD(service, stat, addend) ((void)0) |
165 | #endif | | 167 | #endif |
166 | | | 168 | |
167 | enum { | | 169 | enum { |
168 | DEBUG_ENTRIES, | | 170 | DEBUG_ENTRIES, |
169 | #if VCHIQ_ENABLE_DEBUG | | 171 | #if VCHIQ_ENABLE_DEBUG |
170 | DEBUG_SLOT_HANDLER_COUNT, | | 172 | DEBUG_SLOT_HANDLER_COUNT, |
171 | DEBUG_SLOT_HANDLER_LINE, | | 173 | DEBUG_SLOT_HANDLER_LINE, |
172 | DEBUG_PARSE_LINE, | | 174 | DEBUG_PARSE_LINE, |
173 | DEBUG_PARSE_HEADER, | | 175 | DEBUG_PARSE_HEADER, |
174 | DEBUG_PARSE_MSGID, | | 176 | DEBUG_PARSE_MSGID, |
175 | DEBUG_AWAIT_COMPLETION_LINE, | | 177 | DEBUG_AWAIT_COMPLETION_LINE, |
176 | DEBUG_DEQUEUE_MESSAGE_LINE, | | 178 | DEBUG_DEQUEUE_MESSAGE_LINE, |
177 | DEBUG_SERVICE_CALLBACK_LINE, | | 179 | DEBUG_SERVICE_CALLBACK_LINE, |
178 | DEBUG_MSG_QUEUE_FULL_COUNT, | | 180 | DEBUG_MSG_QUEUE_FULL_COUNT, |
179 | DEBUG_COMPLETION_QUEUE_FULL_COUNT, | | 181 | DEBUG_COMPLETION_QUEUE_FULL_COUNT, |
180 | #endif | | 182 | #endif |
181 | DEBUG_MAX | | 183 | DEBUG_MAX |
182 | }; | | 184 | }; |
183 | | | 185 | |
184 | #if VCHIQ_ENABLE_DEBUG | | 186 | #if VCHIQ_ENABLE_DEBUG |
185 | | | 187 | |
186 | #define DEBUG_INITIALISE(local) int *debug_ptr = (local)->debug; | | 188 | #define DEBUG_INITIALISE(local) int *debug_ptr = (local)->debug; |
187 | #define DEBUG_TRACE(d) \ | | 189 | #define DEBUG_TRACE(d) \ |
188 | do { debug_ptr[DEBUG_ ## d] = __LINE__; dsb(sy); } while (0) | | 190 | do { debug_ptr[DEBUG_ ## d] = __LINE__; dsb(sy); } while (0) |
189 | #define DEBUG_VALUE(d, v) \ | | 191 | #define DEBUG_VALUE(d, v) \ |
190 | do { debug_ptr[DEBUG_ ## d] = (v); dsb(sy); } while (0) | | 192 | do { debug_ptr[DEBUG_ ## d] = (v); dsb(sy); } while (0) |
191 | #define DEBUG_COUNT(d) \ | | 193 | #define DEBUG_COUNT(d) \ |
192 | do { debug_ptr[DEBUG_ ## d]++; dsb(sy); } while (0) | | 194 | do { debug_ptr[DEBUG_ ## d]++; dsb(sy); } while (0) |
193 | | | 195 | |
194 | #else /* VCHIQ_ENABLE_DEBUG */ | | 196 | #else /* VCHIQ_ENABLE_DEBUG */ |
195 | | | 197 | |
196 | #define DEBUG_INITIALISE(local) | | 198 | #define DEBUG_INITIALISE(local) |
197 | #define DEBUG_TRACE(d) | | 199 | #define DEBUG_TRACE(d) |
198 | #define DEBUG_VALUE(d, v) | | 200 | #define DEBUG_VALUE(d, v) |
199 | #define DEBUG_COUNT(d) | | 201 | #define DEBUG_COUNT(d) |
200 | | | 202 | |
201 | #endif /* VCHIQ_ENABLE_DEBUG */ | | 203 | #endif /* VCHIQ_ENABLE_DEBUG */ |
202 | | | 204 | |
203 | typedef enum { | | 205 | typedef enum { |
204 | VCHIQ_CONNSTATE_DISCONNECTED, | | 206 | VCHIQ_CONNSTATE_DISCONNECTED, |
205 | VCHIQ_CONNSTATE_CONNECTING, | | 207 | VCHIQ_CONNSTATE_CONNECTING, |
206 | VCHIQ_CONNSTATE_CONNECTED, | | 208 | VCHIQ_CONNSTATE_CONNECTED, |
207 | VCHIQ_CONNSTATE_PAUSING, | | 209 | VCHIQ_CONNSTATE_PAUSING, |
208 | VCHIQ_CONNSTATE_PAUSE_SENT, | | 210 | VCHIQ_CONNSTATE_PAUSE_SENT, |
209 | VCHIQ_CONNSTATE_PAUSED, | | 211 | VCHIQ_CONNSTATE_PAUSED, |
210 | VCHIQ_CONNSTATE_RESUMING, | | 212 | VCHIQ_CONNSTATE_RESUMING, |
211 | VCHIQ_CONNSTATE_PAUSE_TIMEOUT, | | 213 | VCHIQ_CONNSTATE_PAUSE_TIMEOUT, |
212 | VCHIQ_CONNSTATE_RESUME_TIMEOUT | | 214 | VCHIQ_CONNSTATE_RESUME_TIMEOUT |
213 | } VCHIQ_CONNSTATE_T; | | 215 | } VCHIQ_CONNSTATE_T; |
214 | | | 216 | |
215 | enum { | | 217 | enum { |
216 | VCHIQ_SRVSTATE_FREE, | | 218 | VCHIQ_SRVSTATE_FREE, |
217 | VCHIQ_SRVSTATE_HIDDEN, | | 219 | VCHIQ_SRVSTATE_HIDDEN, |
218 | VCHIQ_SRVSTATE_LISTENING, | | 220 | VCHIQ_SRVSTATE_LISTENING, |
219 | VCHIQ_SRVSTATE_OPENING, | | 221 | VCHIQ_SRVSTATE_OPENING, |
220 | VCHIQ_SRVSTATE_OPEN, | | 222 | VCHIQ_SRVSTATE_OPEN, |
221 | VCHIQ_SRVSTATE_OPENSYNC, | | 223 | VCHIQ_SRVSTATE_OPENSYNC, |
222 | VCHIQ_SRVSTATE_CLOSESENT, | | 224 | VCHIQ_SRVSTATE_CLOSESENT, |
223 | VCHIQ_SRVSTATE_CLOSERECVD, | | 225 | VCHIQ_SRVSTATE_CLOSERECVD, |
224 | VCHIQ_SRVSTATE_CLOSEWAIT, | | 226 | VCHIQ_SRVSTATE_CLOSEWAIT, |
225 | VCHIQ_SRVSTATE_CLOSED | | 227 | VCHIQ_SRVSTATE_CLOSED |
226 | }; | | 228 | }; |
227 | | | 229 | |
228 | enum { | | 230 | enum { |
229 | VCHIQ_POLL_TERMINATE, | | 231 | VCHIQ_POLL_TERMINATE, |
230 | VCHIQ_POLL_REMOVE, | | 232 | VCHIQ_POLL_REMOVE, |
231 | VCHIQ_POLL_TXNOTIFY, | | 233 | VCHIQ_POLL_TXNOTIFY, |
232 | VCHIQ_POLL_RXNOTIFY, | | 234 | VCHIQ_POLL_RXNOTIFY, |
233 | VCHIQ_POLL_COUNT | | 235 | VCHIQ_POLL_COUNT |
234 | }; | | 236 | }; |
235 | | | 237 | |
236 | typedef enum { | | 238 | typedef enum { |
237 | VCHIQ_BULK_TRANSMIT, | | 239 | VCHIQ_BULK_TRANSMIT, |
238 | VCHIQ_BULK_RECEIVE | | 240 | VCHIQ_BULK_RECEIVE |
239 | } VCHIQ_BULK_DIR_T; | | 241 | } VCHIQ_BULK_DIR_T; |
240 | | | 242 | |
241 | typedef void (*VCHIQ_USERDATA_TERM_T)(void *userdata); | | 243 | typedef void (*VCHIQ_USERDATA_TERM_T)(void *userdata); |
242 | | | 244 | |
243 | typedef struct vchiq_bulk_struct { | | 245 | typedef struct vchiq_bulk_struct { |
244 | short mode; | | 246 | short mode; |
245 | short dir; | | 247 | short dir; |
246 | void *userdata; | | 248 | void *userdata; |
247 | VCHI_MEM_HANDLE_T handle; | | 249 | VCHI_MEM_HANDLE_T handle; |
248 | void *data; | | 250 | void *data; |
249 | int size; | | 251 | int size; |
250 | void *remote_data; | | 252 | void *remote_data; |
251 | int remote_size; | | 253 | int remote_size; |
252 | int actual; | | 254 | int actual; |
253 | } VCHIQ_BULK_T; | | 255 | } VCHIQ_BULK_T; |
254 | | | 256 | |
255 | typedef struct vchiq_bulk_queue_struct { | | 257 | typedef struct vchiq_bulk_queue_struct { |
256 | int local_insert; /* Where to insert the next local bulk */ | | 258 | int local_insert; /* Where to insert the next local bulk */ |
257 | int remote_insert; /* Where to insert the next remote bulk (master) */ | | 259 | int remote_insert; /* Where to insert the next remote bulk (master) */ |
258 | int process; /* Bulk to transfer next */ | | 260 | int process; /* Bulk to transfer next */ |
259 | int remote_notify; /* Bulk to notify the remote client of next (mstr) */ | | 261 | int remote_notify; /* Bulk to notify the remote client of next (mstr) */ |
260 | int remove; /* Bulk to notify the local client of, and remove, | | 262 | int remove; /* Bulk to notify the local client of, and remove, |
261 | ** next */ | | 263 | ** next */ |
262 | VCHIQ_BULK_T bulks[VCHIQ_NUM_SERVICE_BULKS]; | | 264 | VCHIQ_BULK_T bulks[VCHIQ_NUM_SERVICE_BULKS]; |
263 | } VCHIQ_BULK_QUEUE_T; | | 265 | } VCHIQ_BULK_QUEUE_T; |
264 | | | 266 | |
265 | typedef struct remote_event_struct { | | 267 | typedef struct remote_event_struct { |
266 | int32_t armed; | | 268 | int32_t armed; |
267 | int32_t fired; | | 269 | int32_t fired; |
268 | uint32_t event; /* offset to VCHIQ_STATE_T */ | | 270 | uint32_t event; /* offset to VCHIQ_STATE_T */ |
269 | #define REMOTE_EVENT_SEMA(s,e) ((struct semaphore *)((char *)(s) + (e)->event)) | | 271 | #define REMOTE_EVENT_SEMA(s,e) ((struct semaphore *)((char *)(s) + (e)->event)) |
270 | } REMOTE_EVENT_T; | | 272 | } REMOTE_EVENT_T; |
271 | | | 273 | |
272 | typedef struct opaque_platform_state_t *VCHIQ_PLATFORM_STATE_T; | | 274 | typedef struct opaque_platform_state_t *VCHIQ_PLATFORM_STATE_T; |
273 | | | 275 | |
274 | typedef struct vchiq_state_struct VCHIQ_STATE_T; | | 276 | typedef struct vchiq_state_struct VCHIQ_STATE_T; |
275 | | | 277 | |
276 | typedef struct vchiq_slot_struct { | | 278 | typedef struct vchiq_slot_struct { |
277 | char data[VCHIQ_SLOT_SIZE]; | | 279 | char data[VCHIQ_SLOT_SIZE]; |
278 | } VCHIQ_SLOT_T; | | 280 | } VCHIQ_SLOT_T; |
279 | | | 281 | |
280 | typedef struct vchiq_slot_info_struct { | | 282 | typedef struct vchiq_slot_info_struct { |
281 | /* Use two counters rather than one to avoid the need for a mutex. */ | | 283 | /* Use two counters rather than one to avoid the need for a mutex. */ |
282 | int16_t use_count; | | 284 | int16_t use_count; |
283 | int16_t release_count; | | 285 | int16_t release_count; |
284 | } VCHIQ_SLOT_INFO_T; | | 286 | } VCHIQ_SLOT_INFO_T; |
285 | | | 287 | |
286 | typedef struct vchiq_service_struct { | | 288 | typedef struct vchiq_service_struct { |
287 | VCHIQ_SERVICE_BASE_T base; | | 289 | VCHIQ_SERVICE_BASE_T base; |
288 | VCHIQ_SERVICE_HANDLE_T handle; | | 290 | VCHIQ_SERVICE_HANDLE_T handle; |
289 | unsigned int ref_count; | | 291 | unsigned int ref_count; |
290 | int srvstate; | | 292 | int srvstate; |
291 | VCHIQ_USERDATA_TERM_T userdata_term; | | 293 | VCHIQ_USERDATA_TERM_T userdata_term; |
292 | unsigned int localport; | | 294 | unsigned int localport; |
293 | unsigned int remoteport; | | 295 | unsigned int remoteport; |
294 | int public_fourcc; | | 296 | int public_fourcc; |
295 | int client_id; | | 297 | int client_id; |
296 | char auto_close; | | 298 | char auto_close; |
297 | char sync; | | 299 | char sync; |
298 | char closing; | | 300 | char closing; |
299 | char trace; | | 301 | char trace; |
300 | atomic_t poll_flags; | | 302 | atomic_t poll_flags; |
301 | short version; | | 303 | short version; |
302 | short version_min; | | 304 | short version_min; |
303 | short peer_version; | | 305 | short peer_version; |
304 | | | 306 | |
305 | VCHIQ_STATE_T *state; | | 307 | VCHIQ_STATE_T *state; |
306 | VCHIQ_INSTANCE_T instance; | | 308 | VCHIQ_INSTANCE_T instance; |
307 | | | 309 | |
308 | int service_use_count; | | 310 | int service_use_count; |
309 | | | 311 | |
310 | VCHIQ_BULK_QUEUE_T bulk_tx; | | 312 | VCHIQ_BULK_QUEUE_T bulk_tx; |
311 | VCHIQ_BULK_QUEUE_T bulk_rx; | | 313 | VCHIQ_BULK_QUEUE_T bulk_rx; |
312 | | | 314 | |
313 | struct semaphore remove_event; | | 315 | struct semaphore remove_event; |
314 | struct semaphore bulk_remove_event; | | 316 | struct semaphore bulk_remove_event; |
315 | struct mutex bulk_mutex; | | 317 | struct mutex bulk_mutex; |
316 | | | 318 | |
317 | struct service_stats_struct { | | 319 | struct service_stats_struct { |
318 | int quota_stalls; | | 320 | int quota_stalls; |
319 | int slot_stalls; | | 321 | int slot_stalls; |
320 | int bulk_stalls; | | 322 | int bulk_stalls; |
321 | int error_count; | | 323 | int error_count; |
322 | int ctrl_tx_count; | | 324 | int ctrl_tx_count; |
323 | int ctrl_rx_count; | | 325 | int ctrl_rx_count; |
324 | int bulk_tx_count; | | 326 | int bulk_tx_count; |
325 | int bulk_rx_count; | | 327 | int bulk_rx_count; |
326 | int bulk_aborted_count; | | 328 | int bulk_aborted_count; |
327 | uint64_t ctrl_tx_bytes; | | 329 | uint64_t ctrl_tx_bytes; |
328 | uint64_t ctrl_rx_bytes; | | 330 | uint64_t ctrl_rx_bytes; |
329 | uint64_t bulk_tx_bytes; | | 331 | uint64_t bulk_tx_bytes; |
330 | uint64_t bulk_rx_bytes; | | 332 | uint64_t bulk_rx_bytes; |
331 | } stats; | | 333 | } stats; |
332 | } VCHIQ_SERVICE_T; | | 334 | } VCHIQ_SERVICE_T; |
333 | | | 335 | |
334 | /* The quota information is outside VCHIQ_SERVICE_T so that it can be | | 336 | /* The quota information is outside VCHIQ_SERVICE_T so that it can be |
335 | statically allocated, since for accounting reasons a service's slot | | 337 | statically allocated, since for accounting reasons a service's slot |
336 | usage is carried over between users of the same port number. | | 338 | usage is carried over between users of the same port number. |
337 | */ | | 339 | */ |
338 | typedef struct vchiq_service_quota_struct { | | 340 | typedef struct vchiq_service_quota_struct { |
339 | unsigned short slot_quota; | | 341 | unsigned short slot_quota; |
340 | unsigned short slot_use_count; | | 342 | unsigned short slot_use_count; |
341 | unsigned short message_quota; | | 343 | unsigned short message_quota; |
342 | unsigned short message_use_count; | | 344 | unsigned short message_use_count; |
343 | struct semaphore quota_event; | | 345 | struct semaphore quota_event; |
344 | int previous_tx_index; | | 346 | int previous_tx_index; |
345 | } VCHIQ_SERVICE_QUOTA_T; | | 347 | } VCHIQ_SERVICE_QUOTA_T; |
346 | | | 348 | |
347 | typedef struct vchiq_shared_state_struct { | | 349 | typedef struct vchiq_shared_state_struct { |
348 | | | 350 | |
349 | /* A non-zero value here indicates that the content is valid. */ | | 351 | /* A non-zero value here indicates that the content is valid. */ |
350 | int32_t initialised; | | 352 | int32_t initialised; |
351 | | | 353 | |
352 | /* The first and last (inclusive) slots allocated to the owner. */ | | 354 | /* The first and last (inclusive) slots allocated to the owner. */ |
353 | int32_t slot_first; | | 355 | int32_t slot_first; |
354 | int32_t slot_last; | | 356 | int32_t slot_last; |
355 | | | 357 | |
356 | /* The slot allocated to synchronous messages from the owner. */ | | 358 | /* The slot allocated to synchronous messages from the owner. */ |
357 | int32_t slot_sync; | | 359 | int32_t slot_sync; |
358 | | | 360 | |
359 | /* Signalling this event indicates that owner's slot handler thread | | 361 | /* Signalling this event indicates that owner's slot handler thread |
360 | ** should run. */ | | 362 | ** should run. */ |
361 | REMOTE_EVENT_T trigger; | | 363 | REMOTE_EVENT_T trigger; |
362 | | | 364 | |
363 | /* Indicates the byte position within the stream where the next message | | 365 | /* Indicates the byte position within the stream where the next message |
364 | ** will be written. The least significant bits are an index into the | | 366 | ** will be written. The least significant bits are an index into the |
365 | ** slot. The next bits are the index of the slot in slot_queue. */ | | 367 | ** slot. The next bits are the index of the slot in slot_queue. */ |
366 | int32_t tx_pos; | | 368 | int32_t tx_pos; |
367 | | | 369 | |
368 | /* This event should be signalled when a slot is recycled. */ | | 370 | /* This event should be signalled when a slot is recycled. */ |
369 | REMOTE_EVENT_T recycle; | | 371 | REMOTE_EVENT_T recycle; |
370 | | | 372 | |
371 | /* The slot_queue index where the next recycled slot will be written. */ | | 373 | /* The slot_queue index where the next recycled slot will be written. */ |
372 | int slot_queue_recycle; | | 374 | int slot_queue_recycle; |
373 | | | 375 | |
374 | /* This event should be signalled when a synchronous message is sent. */ | | 376 | /* This event should be signalled when a synchronous message is sent. */ |
375 | REMOTE_EVENT_T sync_trigger; | | 377 | REMOTE_EVENT_T sync_trigger; |
376 | | | 378 | |
377 | /* This event should be signalled when a synchronous message has been | | 379 | /* This event should be signalled when a synchronous message has been |
378 | ** released. */ | | 380 | ** released. */ |
379 | REMOTE_EVENT_T sync_release; | | 381 | REMOTE_EVENT_T sync_release; |
380 | | | 382 | |
381 | /* A circular buffer of slot indexes. */ | | 383 | /* A circular buffer of slot indexes. */ |
382 | int32_t slot_queue[VCHIQ_MAX_SLOTS_PER_SIDE]; | | 384 | int32_t slot_queue[VCHIQ_MAX_SLOTS_PER_SIDE]; |
383 | | | 385 | |
384 | /* Debugging state */ | | 386 | /* Debugging state */ |
385 | int32_t debug[DEBUG_MAX]; | | 387 | int32_t debug[DEBUG_MAX]; |
386 | } VCHIQ_SHARED_STATE_T; | | 388 | } VCHIQ_SHARED_STATE_T; |
387 | | | 389 | |
388 | typedef struct vchiq_slot_zero_struct { | | 390 | typedef struct vchiq_slot_zero_struct { |
389 | int32_t magic; | | 391 | int32_t magic; |
390 | int16_t version; | | 392 | int16_t version; |
391 | int16_t version_min; | | 393 | int16_t version_min; |
392 | int32_t slot_zero_size; | | 394 | int32_t slot_zero_size; |
393 | int32_t slot_size; | | 395 | int32_t slot_size; |
394 | int32_t max_slots; | | 396 | int32_t max_slots; |
395 | int32_t max_slots_per_side; | | 397 | int32_t max_slots_per_side; |
396 | int32_t platform_data[2]; | | 398 | int32_t platform_data[2]; |
397 | VCHIQ_SHARED_STATE_T master; | | 399 | VCHIQ_SHARED_STATE_T master; |
398 | VCHIQ_SHARED_STATE_T slave; | | 400 | VCHIQ_SHARED_STATE_T slave; |
399 | VCHIQ_SLOT_INFO_T slots[VCHIQ_MAX_SLOTS]; | | 401 | VCHIQ_SLOT_INFO_T slots[VCHIQ_MAX_SLOTS]; |
400 | } VCHIQ_SLOT_ZERO_T; | | 402 | } VCHIQ_SLOT_ZERO_T; |
401 | | | 403 | |
402 | struct vchiq_state_struct { | | 404 | struct vchiq_state_struct { |
403 | int id; | | 405 | int id; |
404 | int initialised; | | 406 | int initialised; |
405 | VCHIQ_CONNSTATE_T conn_state; | | 407 | VCHIQ_CONNSTATE_T conn_state; |
406 | int is_master; | | 408 | int is_master; |
407 | short version_common; | | 409 | short version_common; |
408 | | | 410 | |
409 | VCHIQ_SHARED_STATE_T *local; | | 411 | VCHIQ_SHARED_STATE_T *local; |
410 | VCHIQ_SHARED_STATE_T *remote; | | 412 | VCHIQ_SHARED_STATE_T *remote; |
411 | VCHIQ_SLOT_T *slot_data; | | 413 | VCHIQ_SLOT_T *slot_data; |
412 | | | 414 | |
413 | unsigned short default_slot_quota; | | 415 | unsigned short default_slot_quota; |
414 | unsigned short default_message_quota; | | 416 | unsigned short default_message_quota; |
415 | | | 417 | |
416 | /* Event indicating connect message received */ | | 418 | /* Event indicating connect message received */ |
417 | struct semaphore connect; | | 419 | struct semaphore connect; |
418 | | | 420 | |
419 | /* Mutex protecting services */ | | 421 | /* Mutex protecting services */ |
420 | struct mutex mutex; | | 422 | struct mutex mutex; |
421 | VCHIQ_INSTANCE_T *instance; | | 423 | VCHIQ_INSTANCE_T *instance; |
422 | | | 424 | |
423 | /* Processes incoming messages */ | | 425 | /* Processes incoming messages */ |
424 | VCHIQ_THREAD_T slot_handler_thread; | | 426 | VCHIQ_THREAD_T slot_handler_thread; |
425 | | | 427 | |
426 | /* Processes recycled slots */ | | 428 | /* Processes recycled slots */ |
427 | VCHIQ_THREAD_T recycle_thread; | | 429 | VCHIQ_THREAD_T recycle_thread; |
428 | | | 430 | |
429 | /* Processes synchronous messages */ | | 431 | /* Processes synchronous messages */ |
430 | VCHIQ_THREAD_T sync_thread; | | 432 | VCHIQ_THREAD_T sync_thread; |
431 | | | 433 | |
432 | /* Local implementation of the trigger remote event */ | | 434 | /* Local implementation of the trigger remote event */ |
433 | struct semaphore trigger_event; | | 435 | struct semaphore trigger_event; |
434 | | | 436 | |
435 | /* Local implementation of the recycle remote event */ | | 437 | /* Local implementation of the recycle remote event */ |
436 | struct semaphore recycle_event; | | 438 | struct semaphore recycle_event; |
437 | | | 439 | |
438 | /* Local implementation of the sync trigger remote event */ | | 440 | /* Local implementation of the sync trigger remote event */ |
439 | struct semaphore sync_trigger_event; | | 441 | struct semaphore sync_trigger_event; |
440 | | | 442 | |
441 | /* Local implementation of the sync release remote event */ | | 443 | /* Local implementation of the sync release remote event */ |
442 | struct semaphore sync_release_event; | | 444 | struct semaphore sync_release_event; |
443 | | | 445 | |
444 | char *tx_data; | | 446 | char *tx_data; |
445 | char *rx_data; | | 447 | char *rx_data; |
446 | VCHIQ_SLOT_INFO_T *rx_info; | | 448 | VCHIQ_SLOT_INFO_T *rx_info; |
447 | | | 449 | |
448 | struct mutex slot_mutex; | | 450 | struct mutex slot_mutex; |
449 | | | 451 | |
450 | struct mutex recycle_mutex; | | 452 | struct mutex recycle_mutex; |
451 | | | 453 | |
452 | struct mutex sync_mutex; | | 454 | struct mutex sync_mutex; |
453 | | | 455 | |
454 | struct mutex bulk_transfer_mutex; | | 456 | struct mutex bulk_transfer_mutex; |
455 | | | 457 | |
456 | /* Indicates the byte position within the stream from where the next | | 458 | /* Indicates the byte position within the stream from where the next |
457 | ** message will be read. The least significant bits are an index into | | 459 | ** message will be read. The least significant bits are an index into |
458 | ** the slot.The next bits are the index of the slot in | | 460 | ** the slot.The next bits are the index of the slot in |
459 | ** remote->slot_queue. */ | | 461 | ** remote->slot_queue. */ |
460 | int rx_pos; | | 462 | int rx_pos; |
461 | | | 463 | |
462 | /* A cached copy of local->tx_pos. Only write to local->tx_pos, and read | | 464 | /* A cached copy of local->tx_pos. Only write to local->tx_pos, and read |
463 | from remote->tx_pos. */ | | 465 | from remote->tx_pos. */ |
464 | int local_tx_pos; | | 466 | int local_tx_pos; |
465 | | | 467 | |
466 | /* The slot_queue index of the slot to become available next. */ | | 468 | /* The slot_queue index of the slot to become available next. */ |
467 | int slot_queue_available; | | 469 | int slot_queue_available; |
468 | | | 470 | |
469 | /* A flag to indicate if any poll has been requested */ | | 471 | /* A flag to indicate if any poll has been requested */ |
470 | int poll_needed; | | 472 | int poll_needed; |
471 | | | 473 | |
472 | /* Ths index of the previous slot used for data messages. */ | | 474 | /* Ths index of the previous slot used for data messages. */ |
473 | int previous_data_index; | | 475 | int previous_data_index; |
474 | | | 476 | |
475 | /* The number of slots occupied by data messages. */ | | 477 | /* The number of slots occupied by data messages. */ |
476 | unsigned short data_use_count; | | 478 | unsigned short data_use_count; |
477 | | | 479 | |
478 | /* The maximum number of slots to be occupied by data messages. */ | | 480 | /* The maximum number of slots to be occupied by data messages. */ |
479 | unsigned short data_quota; | | 481 | unsigned short data_quota; |
480 | | | 482 | |
481 | /* An array of bit sets indicating which services must be polled. */ | | 483 | /* An array of bit sets indicating which services must be polled. */ |
482 | atomic_t poll_services[BITSET_SIZE(VCHIQ_MAX_SERVICES)]; | | 484 | atomic_t poll_services[BITSET_SIZE(VCHIQ_MAX_SERVICES)]; |
483 | | | 485 | |
484 | /* The number of the first unused service */ | | 486 | /* The number of the first unused service */ |
485 | int unused_service; | | 487 | int unused_service; |
486 | | | 488 | |
487 | /* Signalled when a free slot becomes available. */ | | 489 | /* Signalled when a free slot becomes available. */ |
488 | struct semaphore slot_available_event; | | 490 | struct semaphore slot_available_event; |
489 | | | 491 | |
490 | struct semaphore slot_remove_event; | | 492 | struct semaphore slot_remove_event; |
491 | | | 493 | |
492 | /* Signalled when a free data slot becomes available. */ | | 494 | /* Signalled when a free data slot becomes available. */ |
493 | struct semaphore data_quota_event; | | 495 | struct semaphore data_quota_event; |
494 | | | 496 | |
495 | /* Incremented when there are bulk transfers which cannot be processed | | 497 | /* Incremented when there are bulk transfers which cannot be processed |
496 | * whilst paused and must be processed on resume */ | | 498 | * whilst paused and must be processed on resume */ |
497 | int deferred_bulks; | | 499 | int deferred_bulks; |
498 | | | 500 | |
499 | struct state_stats_struct { | | 501 | struct state_stats_struct { |
500 | int slot_stalls; | | 502 | int slot_stalls; |
501 | int data_stalls; | | 503 | int data_stalls; |
502 | int ctrl_tx_count; | | 504 | int ctrl_tx_count; |
503 | int ctrl_rx_count; | | 505 | int ctrl_rx_count; |
504 | int error_count; | | 506 | int error_count; |
505 | } stats; | | 507 | } stats; |
506 | | | 508 | |
507 | VCHIQ_SERVICE_T * services[VCHIQ_MAX_SERVICES]; | | 509 | VCHIQ_SERVICE_T * services[VCHIQ_MAX_SERVICES]; |
508 | VCHIQ_SERVICE_QUOTA_T service_quotas[VCHIQ_MAX_SERVICES]; | | 510 | VCHIQ_SERVICE_QUOTA_T service_quotas[VCHIQ_MAX_SERVICES]; |
509 | VCHIQ_SLOT_INFO_T slot_info[VCHIQ_MAX_SLOTS]; | | 511 | VCHIQ_SLOT_INFO_T slot_info[VCHIQ_MAX_SLOTS]; |
510 | | | 512 | |
511 | VCHIQ_PLATFORM_STATE_T platform_state; | | 513 | VCHIQ_PLATFORM_STATE_T platform_state; |
512 | }; | | 514 | }; |
513 | | | 515 | |
514 | struct bulk_waiter { | | 516 | struct bulk_waiter { |
515 | VCHIQ_BULK_T *bulk; | | 517 | VCHIQ_BULK_T *bulk; |
516 | struct semaphore event; | | 518 | struct semaphore event; |
517 | int actual; | | 519 | int actual; |
518 | }; | | 520 | }; |
519 | | | 521 | |
520 | extern spinlock_t bulk_waiter_spinlock; | | 522 | extern spinlock_t bulk_waiter_spinlock; |
521 | | | 523 | |
522 | extern int vchiq_core_log_level; | | 524 | extern int vchiq_core_log_level; |
523 | extern int vchiq_core_msg_log_level; | | 525 | extern int vchiq_core_msg_log_level; |
524 | extern int vchiq_sync_log_level; | | 526 | extern int vchiq_sync_log_level; |
525 | | | 527 | |
526 | extern VCHIQ_STATE_T *vchiq_states[VCHIQ_MAX_STATES]; | | 528 | extern VCHIQ_STATE_T *vchiq_states[VCHIQ_MAX_STATES]; |
527 | | | 529 | |
528 | extern const char * | | 530 | extern const char * |
529 | get_conn_state_name(VCHIQ_CONNSTATE_T conn_state); | | 531 | get_conn_state_name(VCHIQ_CONNSTATE_T conn_state); |
530 | | | 532 | |
531 | extern VCHIQ_SLOT_ZERO_T * | | 533 | extern VCHIQ_SLOT_ZERO_T * |
532 | vchiq_init_slots(void *mem_base, int mem_size); | | 534 | vchiq_init_slots(void *mem_base, int mem_size); |
533 | | | 535 | |
534 | extern VCHIQ_STATUS_T | | 536 | extern VCHIQ_STATUS_T |
535 | vchiq_init_state(VCHIQ_STATE_T *state, VCHIQ_SLOT_ZERO_T *slot_zero, | | 537 | vchiq_init_state(VCHIQ_STATE_T *state, VCHIQ_SLOT_ZERO_T *slot_zero, |
536 | int is_master); | | 538 | int is_master); |
537 | | | 539 | |
538 | extern VCHIQ_STATUS_T | | 540 | extern VCHIQ_STATUS_T |
539 | vchiq_connect_internal(VCHIQ_STATE_T *state, VCHIQ_INSTANCE_T instance); | | 541 | vchiq_connect_internal(VCHIQ_STATE_T *state, VCHIQ_INSTANCE_T instance); |
540 | | | 542 | |
541 | extern VCHIQ_SERVICE_T * | | 543 | extern VCHIQ_SERVICE_T * |
542 | vchiq_add_service_internal(VCHIQ_STATE_T *state, | | 544 | vchiq_add_service_internal(VCHIQ_STATE_T *state, |
543 | const VCHIQ_SERVICE_PARAMS_T *params, int srvstate, | | 545 | const VCHIQ_SERVICE_PARAMS_T *params, int srvstate, |
544 | VCHIQ_INSTANCE_T instance, VCHIQ_USERDATA_TERM_T userdata_term); | | 546 | VCHIQ_INSTANCE_T instance, VCHIQ_USERDATA_TERM_T userdata_term); |
545 | | | 547 | |
546 | extern VCHIQ_STATUS_T | | 548 | extern VCHIQ_STATUS_T |
547 | vchiq_open_service_internal(VCHIQ_SERVICE_T *service, int client_id); | | 549 | vchiq_open_service_internal(VCHIQ_SERVICE_T *service, int client_id); |
548 | | | 550 | |
549 | extern VCHIQ_STATUS_T | | 551 | extern VCHIQ_STATUS_T |
550 | vchiq_close_service_internal(VCHIQ_SERVICE_T *service, int close_recvd); | | 552 | vchiq_close_service_internal(VCHIQ_SERVICE_T *service, int close_recvd); |
551 | | | 553 | |
552 | extern void | | 554 | extern void |
553 | vchiq_terminate_service_internal(VCHIQ_SERVICE_T *service); | | 555 | vchiq_terminate_service_internal(VCHIQ_SERVICE_T *service); |
554 | | | 556 | |
555 | extern void | | 557 | extern void |
556 | vchiq_free_service_internal(VCHIQ_SERVICE_T *service); | | 558 | vchiq_free_service_internal(VCHIQ_SERVICE_T *service); |
557 | | | 559 | |
558 | extern VCHIQ_STATUS_T | | 560 | extern VCHIQ_STATUS_T |
559 | vchiq_shutdown_internal(VCHIQ_STATE_T *state, VCHIQ_INSTANCE_T instance); | | 561 | vchiq_shutdown_internal(VCHIQ_STATE_T *state, VCHIQ_INSTANCE_T instance); |
560 | | | 562 | |
561 | extern VCHIQ_STATUS_T | | 563 | extern VCHIQ_STATUS_T |
562 | vchiq_pause_internal(VCHIQ_STATE_T *state); | | 564 | vchiq_pause_internal(VCHIQ_STATE_T *state); |
563 | | | 565 | |
564 | extern VCHIQ_STATUS_T | | 566 | extern VCHIQ_STATUS_T |
565 | vchiq_resume_internal(VCHIQ_STATE_T *state); | | 567 | vchiq_resume_internal(VCHIQ_STATE_T *state); |
566 | | | 568 | |
567 | extern void | | 569 | extern void |
568 | remote_event_pollall(VCHIQ_STATE_T *state); | | 570 | remote_event_pollall(VCHIQ_STATE_T *state); |
569 | | | 571 | |
570 | extern VCHIQ_STATUS_T | | 572 | extern VCHIQ_STATUS_T |
571 | vchiq_bulk_transfer(VCHIQ_SERVICE_HANDLE_T handle, | | 573 | vchiq_bulk_transfer(VCHIQ_SERVICE_HANDLE_T handle, |
572 | VCHI_MEM_HANDLE_T memhandle, void *offset, int size, void *userdata, | | 574 | VCHI_MEM_HANDLE_T memhandle, void *offset, int size, void *userdata, |
573 | VCHIQ_BULK_MODE_T mode, VCHIQ_BULK_DIR_T dir); | | 575 | VCHIQ_BULK_MODE_T mode, VCHIQ_BULK_DIR_T dir); |
574 | | | 576 | |
575 | extern void | | 577 | extern void |
576 | vchiq_dump_state(void *dump_context, VCHIQ_STATE_T *state); | | 578 | vchiq_dump_state(void *dump_context, VCHIQ_STATE_T *state); |
577 | | | 579 | |
578 | extern void | | 580 | extern void |
579 | vchiq_dump_service_state(void *dump_context, VCHIQ_SERVICE_T *service); | | 581 | vchiq_dump_service_state(void *dump_context, VCHIQ_SERVICE_T *service); |
580 | | | 582 | |
581 | extern void | | 583 | extern void |
582 | vchiq_loud_error_header(void); | | 584 | vchiq_loud_error_header(void); |
583 | | | 585 | |
584 | extern void | | 586 | extern void |
585 | vchiq_loud_error_footer(void); | | 587 | vchiq_loud_error_footer(void); |
586 | | | 588 | |
587 | extern void | | 589 | extern void |
588 | request_poll(VCHIQ_STATE_T *state, VCHIQ_SERVICE_T *service, int poll_type); | | 590 | request_poll(VCHIQ_STATE_T *state, VCHIQ_SERVICE_T *service, int poll_type); |
589 | | | 591 | |
590 | static inline VCHIQ_SERVICE_T * | | 592 | static inline VCHIQ_SERVICE_T * |
591 | handle_to_service(VCHIQ_SERVICE_HANDLE_T handle) | | 593 | handle_to_service(VCHIQ_SERVICE_HANDLE_T handle) |
592 | { | | 594 | { |
593 | VCHIQ_STATE_T *state = vchiq_states[(handle / VCHIQ_MAX_SERVICES) & | | 595 | VCHIQ_STATE_T *state = vchiq_states[(handle / VCHIQ_MAX_SERVICES) & |
594 | (VCHIQ_MAX_STATES - 1)]; | | 596 | (VCHIQ_MAX_STATES - 1)]; |
595 | if (!state) | | 597 | if (!state) |
596 | return NULL; | | 598 | return NULL; |
597 | | | 599 | |
598 | return state->services[handle & (VCHIQ_MAX_SERVICES - 1)]; | | 600 | return state->services[handle & (VCHIQ_MAX_SERVICES - 1)]; |
599 | } | | 601 | } |
600 | | | 602 | |
601 | extern VCHIQ_SERVICE_T * | | 603 | extern VCHIQ_SERVICE_T * |
602 | find_service_by_handle(VCHIQ_SERVICE_HANDLE_T handle); | | 604 | find_service_by_handle(VCHIQ_SERVICE_HANDLE_T handle); |
603 | | | 605 | |
604 | extern VCHIQ_SERVICE_T * | | 606 | extern VCHIQ_SERVICE_T * |
605 | find_service_by_port(VCHIQ_STATE_T *state, int localport); | | 607 | find_service_by_port(VCHIQ_STATE_T *state, int localport); |
606 | | | 608 | |
607 | extern VCHIQ_SERVICE_T * | | 609 | extern VCHIQ_SERVICE_T * |
608 | find_service_for_instance(VCHIQ_INSTANCE_T instance, | | 610 | find_service_for_instance(VCHIQ_INSTANCE_T instance, |
609 | VCHIQ_SERVICE_HANDLE_T handle); | | 611 | VCHIQ_SERVICE_HANDLE_T handle); |
610 | | | 612 | |
611 | extern VCHIQ_SERVICE_T * | | 613 | extern VCHIQ_SERVICE_T * |
612 | find_closed_service_for_instance(VCHIQ_INSTANCE_T instance, | | 614 | find_closed_service_for_instance(VCHIQ_INSTANCE_T instance, |
613 | VCHIQ_SERVICE_HANDLE_T handle); | | 615 | VCHIQ_SERVICE_HANDLE_T handle); |
614 | | | 616 | |
615 | extern VCHIQ_SERVICE_T * | | 617 | extern VCHIQ_SERVICE_T * |
616 | next_service_by_instance(VCHIQ_STATE_T *state, VCHIQ_INSTANCE_T instance, | | 618 | next_service_by_instance(VCHIQ_STATE_T *state, VCHIQ_INSTANCE_T instance, |
617 | int *pidx); | | 619 | int *pidx); |
618 | | | 620 | |
619 | extern void | | 621 | extern void |
620 | lock_service(VCHIQ_SERVICE_T *service); | | 622 | lock_service(VCHIQ_SERVICE_T *service); |
621 | | | 623 | |
622 | extern void | | 624 | extern void |
623 | unlock_service(VCHIQ_SERVICE_T *service); | | 625 | unlock_service(VCHIQ_SERVICE_T *service); |
624 | | | 626 | |
625 | /* The following functions are called from vchiq_core, and external | | 627 | /* The following functions are called from vchiq_core, and external |
626 | ** implementations must be provided. */ | | 628 | ** implementations must be provided. */ |
627 | | | 629 | |
628 | extern VCHIQ_STATUS_T | | 630 | extern VCHIQ_STATUS_T |
629 | vchiq_prepare_bulk_data(VCHIQ_BULK_T *bulk, | | 631 | vchiq_prepare_bulk_data(VCHIQ_BULK_T *bulk, |
630 | VCHI_MEM_HANDLE_T memhandle, void *offset, int size, int dir); | | 632 | VCHI_MEM_HANDLE_T memhandle, void *offset, int size, int dir); |
631 | | | 633 | |
632 | extern void | | 634 | extern void |
633 | vchiq_transfer_bulk(VCHIQ_BULK_T *bulk); | | 635 | vchiq_transfer_bulk(VCHIQ_BULK_T *bulk); |
634 | | | 636 | |
635 | extern void | | 637 | extern void |
636 | vchiq_complete_bulk(VCHIQ_BULK_T *bulk); | | 638 | vchiq_complete_bulk(VCHIQ_BULK_T *bulk); |
637 | | | 639 | |
638 | extern VCHIQ_STATUS_T | | 640 | extern VCHIQ_STATUS_T |
639 | vchiq_copy_from_user(void *dst, const void *src, int size); | | 641 | vchiq_copy_from_user(void *dst, const void *src, int size); |
640 | | | 642 | |
641 | extern void | | 643 | extern void |
642 | remote_event_signal(REMOTE_EVENT_T *event); | | 644 | remote_event_signal(REMOTE_EVENT_T *event); |
643 | | | 645 | |
644 | void | | 646 | void |
645 | vchiq_platform_check_suspend(VCHIQ_STATE_T *state); | | 647 | vchiq_platform_check_suspend(VCHIQ_STATE_T *state); |
646 | | | 648 | |
647 | extern void | | 649 | extern void |
648 | vchiq_platform_paused(VCHIQ_STATE_T *state); | | 650 | vchiq_platform_paused(VCHIQ_STATE_T *state); |
649 | | | 651 | |
650 | extern VCHIQ_STATUS_T | | 652 | extern VCHIQ_STATUS_T |
651 | vchiq_platform_resume(VCHIQ_STATE_T *state); | | 653 | vchiq_platform_resume(VCHIQ_STATE_T *state); |
652 | | | 654 | |
653 | extern void | | 655 | extern void |
654 | vchiq_platform_resumed(VCHIQ_STATE_T *state); | | 656 | vchiq_platform_resumed(VCHIQ_STATE_T *state); |
655 | | | 657 | |
656 | extern void | | 658 | extern void |
657 | vchiq_dump(void *dump_context, const char *str, int len); | | 659 | vchiq_dump(void *dump_context, const char *str, int len); |
658 | | | 660 | |
659 | extern void | | 661 | extern void |
660 | vchiq_dump_platform_state(void *dump_context); | | 662 | vchiq_dump_platform_state(void *dump_context); |
661 | | | 663 | |
662 | extern void | | 664 | extern void |
663 | vchiq_dump_platform_instances(void *dump_context); | | 665 | vchiq_dump_platform_instances(void *dump_context); |
664 | | | 666 | |
665 | extern void | | 667 | extern void |
666 | vchiq_dump_platform_service_state(void *dump_context, | | 668 | vchiq_dump_platform_service_state(void *dump_context, |
667 | VCHIQ_SERVICE_T *service); | | 669 | VCHIQ_SERVICE_T *service); |
668 | | | 670 | |
669 | extern VCHIQ_STATUS_T | | 671 | extern VCHIQ_STATUS_T |
670 | vchiq_use_service_internal(VCHIQ_SERVICE_T *service); | | 672 | vchiq_use_service_internal(VCHIQ_SERVICE_T *service); |
671 | | | 673 | |
672 | extern VCHIQ_STATUS_T | | 674 | extern VCHIQ_STATUS_T |
673 | vchiq_release_service_internal(VCHIQ_SERVICE_T *service); | | 675 | vchiq_release_service_internal(VCHIQ_SERVICE_T *service); |
674 | | | 676 | |
675 | extern void | | 677 | extern void |
676 | vchiq_on_remote_use(VCHIQ_STATE_T *state); | | 678 | vchiq_on_remote_use(VCHIQ_STATE_T *state); |
677 | | | 679 | |
678 | extern void | | 680 | extern void |
679 | vchiq_on_remote_release(VCHIQ_STATE_T *state); | | 681 | vchiq_on_remote_release(VCHIQ_STATE_T *state); |
680 | | | 682 | |
681 | extern VCHIQ_STATUS_T | | 683 | extern VCHIQ_STATUS_T |
682 | vchiq_platform_init_state(VCHIQ_STATE_T *state); | | 684 | vchiq_platform_init_state(VCHIQ_STATE_T *state); |
683 | | | 685 | |
684 | extern VCHIQ_STATUS_T | | 686 | extern VCHIQ_STATUS_T |
685 | vchiq_check_service(VCHIQ_SERVICE_T *service); | | 687 | vchiq_check_service(VCHIQ_SERVICE_T *service); |
686 | | | 688 | |
687 | extern void | | 689 | extern void |
688 | vchiq_on_remote_use_active(VCHIQ_STATE_T *state); | | 690 | vchiq_on_remote_use_active(VCHIQ_STATE_T *state); |
689 | | | 691 | |
690 | extern VCHIQ_STATUS_T | | 692 | extern VCHIQ_STATUS_T |
691 | vchiq_send_remote_use(VCHIQ_STATE_T *state); | | 693 | vchiq_send_remote_use(VCHIQ_STATE_T *state); |
692 | | | 694 | |
693 | extern VCHIQ_STATUS_T | | 695 | extern VCHIQ_STATUS_T |
694 | vchiq_send_remote_release(VCHIQ_STATE_T *state); | | 696 | vchiq_send_remote_release(VCHIQ_STATE_T *state); |
695 | | | 697 | |
696 | extern VCHIQ_STATUS_T | | 698 | extern VCHIQ_STATUS_T |
697 | vchiq_send_remote_use_active(VCHIQ_STATE_T *state); | | 699 | vchiq_send_remote_use_active(VCHIQ_STATE_T *state); |
698 | | | 700 | |
699 | extern void | | 701 | extern void |
700 | vchiq_platform_conn_state_changed(VCHIQ_STATE_T *state, | | 702 | vchiq_platform_conn_state_changed(VCHIQ_STATE_T *state, |
701 | VCHIQ_CONNSTATE_T oldstate, VCHIQ_CONNSTATE_T newstate); | | 703 | VCHIQ_CONNSTATE_T oldstate, VCHIQ_CONNSTATE_T newstate); |
702 | | | 704 | |
703 | extern void | | 705 | extern void |
704 | vchiq_platform_handle_timeout(VCHIQ_STATE_T *state); | | 706 | vchiq_platform_handle_timeout(VCHIQ_STATE_T *state); |
705 | | | 707 | |
706 | extern void | | 708 | extern void |
707 | vchiq_set_conn_state(VCHIQ_STATE_T *state, VCHIQ_CONNSTATE_T newstate); | | 709 | vchiq_set_conn_state(VCHIQ_STATE_T *state, VCHIQ_CONNSTATE_T newstate); |
708 | | | 710 | |
709 | | | 711 | |
710 | extern void | | 712 | extern void |
711 | vchiq_log_dump_mem(const char *label, uint32_t addr, const void *voidMem, | | 713 | vchiq_log_dump_mem(const char *label, uint32_t addr, const void *voidMem, |
712 | size_t numBytes); | | 714 | size_t numBytes); |
713 | | | 715 | |
714 | extern void | | 716 | extern void |
715 | vchiq_core_initialize(void); | | 717 | vchiq_core_initialize(void); |
716 | | | 718 | |
717 | #endif | | 719 | #endif |