Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 1 | // Copyright 2020 The Pigweed Authors |
| 2 | // |
| 3 | // Licensed under the Apache License, Version 2.0 (the "License"); you may not |
| 4 | // use this file except in compliance with the License. You may obtain a copy of |
| 5 | // the License at |
| 6 | // |
| 7 | // https://www.apache.org/licenses/LICENSE-2.0 |
| 8 | // |
| 9 | // Unless required by applicable law or agreed to in writing, software |
| 10 | // distributed under the License is distributed on an "AS IS" BASIS, WITHOUT |
| 11 | // WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the |
| 12 | // License for the specific language governing permissions and limitations under |
| 13 | // the License. |
| 14 | |
Ewout van Bekkum | 7f5b305 | 2021-11-11 17:35:23 -0800 | [diff] [blame] | 15 | // clang-format off |
| 16 | #include "pw_rpc/internal/log_config.h" // PW_LOG_* macros must be first. |
| 17 | |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 18 | #include "pw_rpc/server.h" |
Ewout van Bekkum | 7f5b305 | 2021-11-11 17:35:23 -0800 | [diff] [blame] | 19 | // clang-format on |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 20 | |
Wyatt Hepler | 3e2d719 | 2020-06-11 08:28:21 -0700 | [diff] [blame] | 21 | #include <algorithm> |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 22 | #include <mutex> |
Wyatt Hepler | 3e2d719 | 2020-06-11 08:28:21 -0700 | [diff] [blame] | 23 | |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 24 | #include "pw_log/log.h" |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 25 | #include "pw_rpc/internal/endpoint.h" |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 26 | #include "pw_rpc/internal/packet.h" |
| 27 | |
| 28 | namespace pw::rpc { |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 29 | namespace { |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 30 | |
Wyatt Hepler | 80f26ff | 2020-06-01 09:30:17 -0700 | [diff] [blame] | 31 | using std::byte; |
| 32 | |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 33 | using internal::Packet; |
Alexei Frolov | 33a1e8f | 2020-05-26 08:39:32 -0700 | [diff] [blame] | 34 | using internal::PacketType; |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 35 | |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 36 | } // namespace |
| 37 | |
Ted Pudlik | 4180d4d | 2021-10-28 00:07:29 +0000 | [diff] [blame] | 38 | Status Server::ProcessPacket(std::span<const byte> packet_data, |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 39 | ChannelOutput& interface) { |
Wyatt Hepler | 1d000cc | 2021-10-20 11:05:06 -0700 | [diff] [blame] | 40 | PW_TRY_ASSIGN(Result<Packet> result, |
Ted Pudlik | 4180d4d | 2021-10-28 00:07:29 +0000 | [diff] [blame] | 41 | Endpoint::ProcessPacket(packet_data, Packet::kServer)); |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 42 | Packet& packet = *result; |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 43 | |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 44 | internal::rpc_lock().lock(); |
Wyatt Hepler | 1d000cc | 2021-10-20 11:05:06 -0700 | [diff] [blame] | 45 | internal::ServerCall* const call = |
| 46 | static_cast<internal::ServerCall*>(FindCall(packet)); |
| 47 | |
Wyatt Hepler | 3aab7f6 | 2021-10-05 16:14:51 -0700 | [diff] [blame] | 48 | // Verbose log for debugging. |
| 49 | // PW_LOG_DEBUG("RPC server received packet type %u for %u:%08x/%08x", |
| 50 | // static_cast<unsigned>(packet.type()), |
| 51 | // static_cast<unsigned>(packet.channel_id()), |
| 52 | // static_cast<unsigned>(packet.service_id()), |
| 53 | // static_cast<unsigned>(packet.method_id())); |
| 54 | |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 55 | internal::Channel* channel = GetInternalChannel(packet.channel_id()); |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 56 | |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 57 | if (channel == nullptr) { |
Alexei Frolov | 33a1e8f | 2020-05-26 08:39:32 -0700 | [diff] [blame] | 58 | // If the requested channel doesn't exist, try to dynamically assign one. |
| 59 | channel = AssignChannel(packet.channel_id(), interface); |
| 60 | if (channel == nullptr) { |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 61 | internal::rpc_lock().unlock(); |
Wyatt Hepler | 3be460d | 2021-09-09 16:28:12 -0700 | [diff] [blame] | 62 | // If a channel can't be assigned, send a RESOURCE_EXHAUSTED error. Never |
| 63 | // send responses to error messages, though, to avoid infinite cycles. |
| 64 | if (packet.type() != PacketType::CLIENT_ERROR) { |
| 65 | internal::Channel temp_channel(packet.channel_id(), &interface); |
| 66 | temp_channel |
| 67 | .Send(Packet::ServerError(packet, Status::ResourceExhausted())) |
| 68 | .IgnoreError(); |
| 69 | } |
| 70 | return OkStatus(); // OK since the packet was handled |
Alexei Frolov | 33a1e8f | 2020-05-26 08:39:32 -0700 | [diff] [blame] | 71 | } |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 72 | } |
| 73 | |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 74 | const auto [service, method] = FindMethod(packet); |
| 75 | |
| 76 | if (method == nullptr) { |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 77 | internal::rpc_lock().unlock(); |
Wyatt Hepler | 3be460d | 2021-09-09 16:28:12 -0700 | [diff] [blame] | 78 | // Don't send responses to errors to avoid infinite error cycles. |
| 79 | if (packet.type() != PacketType::CLIENT_ERROR) { |
| 80 | channel->Send(Packet::ServerError(packet, Status::NotFound())) |
| 81 | .IgnoreError(); |
| 82 | } |
| 83 | return OkStatus(); // OK since the packet was handled. |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 84 | } |
| 85 | |
| 86 | switch (packet.type()) { |
| 87 | case PacketType::REQUEST: { |
Wyatt Hepler | 960f5df | 2021-09-08 10:17:21 -0700 | [diff] [blame] | 88 | // If the REQUEST is for an ongoing RPC, the existing call will be |
| 89 | // cancelled when the new call object is created. |
Alexei Frolov | 86e05de | 2021-10-19 16:52:31 -0700 | [diff] [blame] | 90 | const internal::CallContext context( |
| 91 | *this, *channel, *service, *method, packet.call_id()); |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 92 | internal::rpc_lock().unlock(); |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 93 | method->Invoke(context, packet); |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 94 | break; |
| 95 | } |
Wyatt Hepler | a921116 | 2021-06-12 15:40:11 -0700 | [diff] [blame] | 96 | case PacketType::CLIENT_STREAM: |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 97 | HandleClientStreamPacket(packet, *channel, call); |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 98 | break; |
| 99 | case PacketType::CLIENT_ERROR: |
Wyatt Hepler | 1716915 | 2021-10-20 18:46:08 -0700 | [diff] [blame] | 100 | case PacketType::DEPRECATED_CANCEL: |
Alexei Frolov | 86e05de | 2021-10-19 16:52:31 -0700 | [diff] [blame] | 101 | if (call != nullptr && call->id() == packet.call_id()) { |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 102 | call->HandleError(packet.status()); |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 103 | } else { |
| 104 | internal::rpc_lock().unlock(); |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 105 | } |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 106 | break; |
Wyatt Hepler | a921116 | 2021-06-12 15:40:11 -0700 | [diff] [blame] | 107 | case PacketType::CLIENT_STREAM_END: |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 108 | HandleClientStreamPacket(packet, *channel, call); |
Wyatt Hepler | a921116 | 2021-06-12 15:40:11 -0700 | [diff] [blame] | 109 | break; |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 110 | default: |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 111 | internal::rpc_lock().unlock(); |
Wyatt Hepler | 82db4b1 | 2021-09-23 09:10:12 -0700 | [diff] [blame] | 112 | PW_LOG_WARN("pw_rpc server unable to handle packet of type %u", |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 113 | unsigned(packet.type())); |
| 114 | } |
Wyatt Hepler | 1d000cc | 2021-10-20 11:05:06 -0700 | [diff] [blame] | 115 | |
| 116 | return OkStatus(); // OK since the packet was handled |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 117 | } |
| 118 | |
Wyatt Hepler | cbd09c2 | 2020-09-15 11:17:24 -0700 | [diff] [blame] | 119 | std::tuple<Service*, const internal::Method*> Server::FindMethod( |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 120 | const internal::Packet& packet) { |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 121 | // Packets always include service and method IDs. |
Wyatt Hepler | 3e2d719 | 2020-06-11 08:28:21 -0700 | [diff] [blame] | 122 | auto service = std::find_if(services_.begin(), services_.end(), [&](auto& s) { |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 123 | return s.id() == packet.service_id(); |
Wyatt Hepler | 3e2d719 | 2020-06-11 08:28:21 -0700 | [diff] [blame] | 124 | }); |
| 125 | |
| 126 | if (service == services_.end()) { |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 127 | return {}; |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 128 | } |
| 129 | |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 130 | return {&(*service), service->FindMethod(packet.method_id())}; |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 131 | } |
Wyatt Hepler | 80f26ff | 2020-06-01 09:30:17 -0700 | [diff] [blame] | 132 | |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 133 | void Server::HandleClientStreamPacket(const internal::Packet& packet, |
| 134 | internal::Channel& channel, |
Wyatt Hepler | 960f5df | 2021-09-08 10:17:21 -0700 | [diff] [blame] | 135 | internal::ServerCall* call) const { |
Alexei Frolov | 86e05de | 2021-10-19 16:52:31 -0700 | [diff] [blame] | 136 | if (call == nullptr || call->id() != packet.call_id()) { |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 137 | internal::rpc_lock().unlock(); |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 138 | PW_LOG_DEBUG( |
Wyatt Hepler | 3aab7f6 | 2021-10-05 16:14:51 -0700 | [diff] [blame] | 139 | "Received client stream packet for %u:%08x/%08x, which is not pending", |
| 140 | static_cast<unsigned>(packet.channel_id()), |
| 141 | static_cast<unsigned>(packet.service_id()), |
| 142 | static_cast<unsigned>(packet.method_id())); |
Adrien Larbanet | d1ca56c | 2021-06-10 14:20:45 +0000 | [diff] [blame] | 143 | channel.Send(Packet::ServerError(packet, Status::FailedPrecondition())) |
Wyatt Hepler | 82db4b1 | 2021-09-23 09:10:12 -0700 | [diff] [blame] | 144 | .IgnoreError(); // Errors are logged in Channel::Send. |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 145 | return; |
| 146 | } |
| 147 | |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 148 | if (!call->has_client_stream()) { |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 149 | internal::rpc_lock().unlock(); |
Adrien Larbanet | d1ca56c | 2021-06-10 14:20:45 +0000 | [diff] [blame] | 150 | channel.Send(Packet::ServerError(packet, Status::InvalidArgument())) |
Wyatt Hepler | 82db4b1 | 2021-09-23 09:10:12 -0700 | [diff] [blame] | 151 | .IgnoreError(); // Errors are logged in Channel::Send. |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 152 | return; |
| 153 | } |
| 154 | |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 155 | if (!call->client_stream_open()) { |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 156 | internal::rpc_lock().unlock(); |
Adrien Larbanet | d1ca56c | 2021-06-10 14:20:45 +0000 | [diff] [blame] | 157 | channel.Send(Packet::ServerError(packet, Status::FailedPrecondition())) |
Wyatt Hepler | 82db4b1 | 2021-09-23 09:10:12 -0700 | [diff] [blame] | 158 | .IgnoreError(); // Errors are logged in Channel::Send. |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 159 | return; |
| 160 | } |
| 161 | |
| 162 | if (packet.type() == PacketType::CLIENT_STREAM) { |
Wyatt Hepler | 82db4b1 | 2021-09-23 09:10:12 -0700 | [diff] [blame] | 163 | call->HandlePayload(packet.payload()); |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 164 | } else { // Handle PacketType::CLIENT_STREAM_END. |
Wyatt Hepler | c8bdc7d | 2021-10-20 09:29:01 -0700 | [diff] [blame] | 165 | call->HandleClientStreamEnd(); |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 166 | } |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 167 | } |
| 168 | |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 169 | } // namespace pw::rpc |