xref: /aosp_15_r20/external/pigweed/pw_router/static_router.cc (revision 61c4878ac05f98d0ceed94b57d316916de578985)
1*61c4878aSAndroid Build Coastguard Worker // Copyright 2021 The Pigweed Authors
2*61c4878aSAndroid Build Coastguard Worker //
3*61c4878aSAndroid Build Coastguard Worker // Licensed under the Apache License, Version 2.0 (the "License"); you may not
4*61c4878aSAndroid Build Coastguard Worker // use this file except in compliance with the License. You may obtain a copy of
5*61c4878aSAndroid Build Coastguard Worker // the License at
6*61c4878aSAndroid Build Coastguard Worker //
7*61c4878aSAndroid Build Coastguard Worker //     https://www.apache.org/licenses/LICENSE-2.0
8*61c4878aSAndroid Build Coastguard Worker //
9*61c4878aSAndroid Build Coastguard Worker // Unless required by applicable law or agreed to in writing, software
10*61c4878aSAndroid Build Coastguard Worker // distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
11*61c4878aSAndroid Build Coastguard Worker // WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
12*61c4878aSAndroid Build Coastguard Worker // License for the specific language governing permissions and limitations under
13*61c4878aSAndroid Build Coastguard Worker // the License.
14*61c4878aSAndroid Build Coastguard Worker 
15*61c4878aSAndroid Build Coastguard Worker #include "pw_router/static_router.h"
16*61c4878aSAndroid Build Coastguard Worker 
17*61c4878aSAndroid Build Coastguard Worker #include <algorithm>
18*61c4878aSAndroid Build Coastguard Worker 
19*61c4878aSAndroid Build Coastguard Worker namespace pw::router {
20*61c4878aSAndroid Build Coastguard Worker 
RoutePacket(ConstByteSpan packet,PacketParser & parser)21*61c4878aSAndroid Build Coastguard Worker Status StaticRouter::RoutePacket(ConstByteSpan packet, PacketParser& parser) {
22*61c4878aSAndroid Build Coastguard Worker   if (!parser.Parse(packet)) {
23*61c4878aSAndroid Build Coastguard Worker     parser_errors_.Increment();
24*61c4878aSAndroid Build Coastguard Worker     return Status::DataLoss();
25*61c4878aSAndroid Build Coastguard Worker   }
26*61c4878aSAndroid Build Coastguard Worker 
27*61c4878aSAndroid Build Coastguard Worker   std::optional<uint32_t> maybe_address = parser.GetDestinationAddress();
28*61c4878aSAndroid Build Coastguard Worker   if (!maybe_address.has_value()) {
29*61c4878aSAndroid Build Coastguard Worker     parser_errors_.Increment();
30*61c4878aSAndroid Build Coastguard Worker     return Status::DataLoss();
31*61c4878aSAndroid Build Coastguard Worker   }
32*61c4878aSAndroid Build Coastguard Worker 
33*61c4878aSAndroid Build Coastguard Worker   auto route = std::find_if(routes_.begin(), routes_.end(), [&](auto r) {
34*61c4878aSAndroid Build Coastguard Worker     return r.address == *maybe_address;
35*61c4878aSAndroid Build Coastguard Worker   });
36*61c4878aSAndroid Build Coastguard Worker   if (route == routes_.end()) {
37*61c4878aSAndroid Build Coastguard Worker     route_errors_.Increment();
38*61c4878aSAndroid Build Coastguard Worker     return Status::NotFound();
39*61c4878aSAndroid Build Coastguard Worker   }
40*61c4878aSAndroid Build Coastguard Worker 
41*61c4878aSAndroid Build Coastguard Worker   if (Status status = route->egress.SendPacket(packet, parser); !status.ok()) {
42*61c4878aSAndroid Build Coastguard Worker     egress_errors_.Increment();
43*61c4878aSAndroid Build Coastguard Worker     return Status::Unavailable();
44*61c4878aSAndroid Build Coastguard Worker   }
45*61c4878aSAndroid Build Coastguard Worker 
46*61c4878aSAndroid Build Coastguard Worker   return OkStatus();
47*61c4878aSAndroid Build Coastguard Worker }
48*61c4878aSAndroid Build Coastguard Worker 
49*61c4878aSAndroid Build Coastguard Worker }  // namespace pw::router
50