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