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 | |
| 15 | #include "pw_rpc/server.h" |
| 16 | |
Wyatt Hepler | 3e2d719 | 2020-06-11 08:28:21 -0700 | [diff] [blame] | 17 | #include <algorithm> |
| 18 | |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 19 | #include "pw_log/log.h" |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 20 | #include "pw_rpc/internal/endpoint.h" |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 21 | #include "pw_rpc/internal/packet.h" |
Wyatt Hepler | 80f26ff | 2020-06-01 09:30:17 -0700 | [diff] [blame] | 22 | #include "pw_rpc/server_context.h" |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 23 | |
| 24 | namespace pw::rpc { |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 25 | namespace { |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 26 | |
Wyatt Hepler | 80f26ff | 2020-06-01 09:30:17 -0700 | [diff] [blame] | 27 | using std::byte; |
| 28 | |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 29 | using internal::Packet; |
Alexei Frolov | 33a1e8f | 2020-05-26 08:39:32 -0700 | [diff] [blame] | 30 | using internal::PacketType; |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 31 | |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 32 | } // namespace |
| 33 | |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 34 | Status Server::ProcessPacket(std::span<const byte> data, |
| 35 | ChannelOutput& interface) { |
Wyatt Hepler | 1d000cc | 2021-10-20 11:05:06 -0700 | [diff] [blame] | 36 | PW_TRY_ASSIGN(Result<Packet> result, |
| 37 | Endpoint::ProcessPacket(data, Packet::kServer)); |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 38 | Packet& packet = *result; |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 39 | |
Wyatt Hepler | 1d000cc | 2021-10-20 11:05:06 -0700 | [diff] [blame] | 40 | internal::ServerCall* const call = |
| 41 | static_cast<internal::ServerCall*>(FindCall(packet)); |
| 42 | |
Wyatt Hepler | 3aab7f6 | 2021-10-05 16:14:51 -0700 | [diff] [blame] | 43 | // Verbose log for debugging. |
| 44 | // PW_LOG_DEBUG("RPC server received packet type %u for %u:%08x/%08x", |
| 45 | // static_cast<unsigned>(packet.type()), |
| 46 | // static_cast<unsigned>(packet.channel_id()), |
| 47 | // static_cast<unsigned>(packet.service_id()), |
| 48 | // static_cast<unsigned>(packet.method_id())); |
| 49 | |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 50 | internal::Channel* channel = GetInternalChannel(packet.channel_id()); |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 51 | if (channel == nullptr) { |
Alexei Frolov | 33a1e8f | 2020-05-26 08:39:32 -0700 | [diff] [blame] | 52 | // If the requested channel doesn't exist, try to dynamically assign one. |
| 53 | channel = AssignChannel(packet.channel_id(), interface); |
| 54 | if (channel == nullptr) { |
Wyatt Hepler | 3be460d | 2021-09-09 16:28:12 -0700 | [diff] [blame] | 55 | // If a channel can't be assigned, send a RESOURCE_EXHAUSTED error. Never |
| 56 | // send responses to error messages, though, to avoid infinite cycles. |
| 57 | if (packet.type() != PacketType::CLIENT_ERROR) { |
| 58 | internal::Channel temp_channel(packet.channel_id(), &interface); |
| 59 | temp_channel |
| 60 | .Send(Packet::ServerError(packet, Status::ResourceExhausted())) |
| 61 | .IgnoreError(); |
| 62 | } |
| 63 | return OkStatus(); // OK since the packet was handled |
Alexei Frolov | 33a1e8f | 2020-05-26 08:39:32 -0700 | [diff] [blame] | 64 | } |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 65 | } |
| 66 | |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 67 | const auto [service, method] = FindMethod(packet); |
| 68 | |
| 69 | if (method == nullptr) { |
Wyatt Hepler | 3be460d | 2021-09-09 16:28:12 -0700 | [diff] [blame] | 70 | // Don't send responses to errors to avoid infinite error cycles. |
| 71 | if (packet.type() != PacketType::CLIENT_ERROR) { |
| 72 | channel->Send(Packet::ServerError(packet, Status::NotFound())) |
| 73 | .IgnoreError(); |
| 74 | } |
| 75 | return OkStatus(); // OK since the packet was handled. |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 76 | } |
| 77 | |
| 78 | switch (packet.type()) { |
| 79 | case PacketType::REQUEST: { |
Wyatt Hepler | 960f5df | 2021-09-08 10:17:21 -0700 | [diff] [blame] | 80 | // If the REQUEST is for an ongoing RPC, the existing call will be |
| 81 | // cancelled when the new call object is created. |
Alexei Frolov | 86e05de | 2021-10-19 16:52:31 -0700 | [diff] [blame] | 82 | const internal::CallContext context( |
| 83 | *this, *channel, *service, *method, packet.call_id()); |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 84 | method->Invoke(context, packet); |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 85 | break; |
| 86 | } |
Wyatt Hepler | a921116 | 2021-06-12 15:40:11 -0700 | [diff] [blame] | 87 | case PacketType::CLIENT_STREAM: |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 88 | HandleClientStreamPacket(packet, *channel, call); |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 89 | break; |
| 90 | case PacketType::CLIENT_ERROR: |
Alexei Frolov | 86e05de | 2021-10-19 16:52:31 -0700 | [diff] [blame] | 91 | if (call != nullptr && call->id() == packet.call_id()) { |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 92 | call->HandleError(packet.status()); |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 93 | } |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 94 | break; |
Wyatt Hepler | a921116 | 2021-06-12 15:40:11 -0700 | [diff] [blame] | 95 | case PacketType::CANCEL: |
Wyatt Hepler | 1d000cc | 2021-10-20 11:05:06 -0700 | [diff] [blame] | 96 | if (call != nullptr && call->id() == packet.call_id()) { |
| 97 | call->HandleError(Status::Cancelled()); |
| 98 | } |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 99 | break; |
Wyatt Hepler | a921116 | 2021-06-12 15:40:11 -0700 | [diff] [blame] | 100 | case PacketType::CLIENT_STREAM_END: |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 101 | HandleClientStreamPacket(packet, *channel, call); |
Wyatt Hepler | a921116 | 2021-06-12 15:40:11 -0700 | [diff] [blame] | 102 | break; |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 103 | default: |
Wyatt Hepler | 82db4b1 | 2021-09-23 09:10:12 -0700 | [diff] [blame] | 104 | 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] | 105 | unsigned(packet.type())); |
| 106 | } |
Wyatt Hepler | 1d000cc | 2021-10-20 11:05:06 -0700 | [diff] [blame] | 107 | |
| 108 | return OkStatus(); // OK since the packet was handled |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 109 | } |
| 110 | |
Wyatt Hepler | cbd09c2 | 2020-09-15 11:17:24 -0700 | [diff] [blame] | 111 | std::tuple<Service*, const internal::Method*> Server::FindMethod( |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 112 | const internal::Packet& packet) { |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 113 | // Packets always include service and method IDs. |
Wyatt Hepler | 3e2d719 | 2020-06-11 08:28:21 -0700 | [diff] [blame] | 114 | auto service = std::find_if(services_.begin(), services_.end(), [&](auto& s) { |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 115 | return s.id() == packet.service_id(); |
Wyatt Hepler | 3e2d719 | 2020-06-11 08:28:21 -0700 | [diff] [blame] | 116 | }); |
| 117 | |
| 118 | if (service == services_.end()) { |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 119 | return {}; |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 120 | } |
| 121 | |
Wyatt Hepler | 0f26235 | 2020-07-29 09:51:27 -0700 | [diff] [blame] | 122 | return {&(*service), service->FindMethod(packet.method_id())}; |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 123 | } |
Wyatt Hepler | 80f26ff | 2020-06-01 09:30:17 -0700 | [diff] [blame] | 124 | |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 125 | void Server::HandleClientStreamPacket(const internal::Packet& packet, |
| 126 | internal::Channel& channel, |
Wyatt Hepler | 960f5df | 2021-09-08 10:17:21 -0700 | [diff] [blame] | 127 | internal::ServerCall* call) const { |
Alexei Frolov | 86e05de | 2021-10-19 16:52:31 -0700 | [diff] [blame] | 128 | if (call == nullptr || call->id() != packet.call_id()) { |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 129 | PW_LOG_DEBUG( |
Wyatt Hepler | 3aab7f6 | 2021-10-05 16:14:51 -0700 | [diff] [blame] | 130 | "Received client stream packet for %u:%08x/%08x, which is not pending", |
| 131 | static_cast<unsigned>(packet.channel_id()), |
| 132 | static_cast<unsigned>(packet.service_id()), |
| 133 | static_cast<unsigned>(packet.method_id())); |
Adrien Larbanet | d1ca56c | 2021-06-10 14:20:45 +0000 | [diff] [blame] | 134 | channel.Send(Packet::ServerError(packet, Status::FailedPrecondition())) |
Wyatt Hepler | 82db4b1 | 2021-09-23 09:10:12 -0700 | [diff] [blame] | 135 | .IgnoreError(); // Errors are logged in Channel::Send. |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 136 | return; |
| 137 | } |
| 138 | |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 139 | if (!call->has_client_stream()) { |
Adrien Larbanet | d1ca56c | 2021-06-10 14:20:45 +0000 | [diff] [blame] | 140 | channel.Send(Packet::ServerError(packet, Status::InvalidArgument())) |
Wyatt Hepler | 82db4b1 | 2021-09-23 09:10:12 -0700 | [diff] [blame] | 141 | .IgnoreError(); // Errors are logged in Channel::Send. |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 142 | return; |
| 143 | } |
| 144 | |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 145 | if (!call->client_stream_open()) { |
Adrien Larbanet | d1ca56c | 2021-06-10 14:20:45 +0000 | [diff] [blame] | 146 | channel.Send(Packet::ServerError(packet, Status::FailedPrecondition())) |
Wyatt Hepler | 82db4b1 | 2021-09-23 09:10:12 -0700 | [diff] [blame] | 147 | .IgnoreError(); // Errors are logged in Channel::Send. |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 148 | return; |
| 149 | } |
| 150 | |
| 151 | if (packet.type() == PacketType::CLIENT_STREAM) { |
Wyatt Hepler | 82db4b1 | 2021-09-23 09:10:12 -0700 | [diff] [blame] | 152 | call->HandlePayload(packet.payload()); |
Wyatt Hepler | 01fc15b | 2021-06-10 18:15:59 -0700 | [diff] [blame] | 153 | } else { // Handle PacketType::CLIENT_STREAM_END. |
Wyatt Hepler | ddfc077 | 2021-09-03 16:46:25 -0700 | [diff] [blame] | 154 | call->EndClientStream(); |
Wyatt Hepler | 712d367 | 2020-07-13 15:52:11 -0700 | [diff] [blame] | 155 | } |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 156 | } |
| 157 | |
Alexei Frolov | 5d6d392 | 2020-05-08 13:57:02 -0700 | [diff] [blame] | 158 | } // namespace pw::rpc |