Nav2 Navigation Stack - jazzy  jazzy
ROS 2 Navigation Stack
trajectories.hpp
1 // Copyright (c) 2022 Samsung Research America, @artofnothingness Alexey Budyakov
2 //
3 // Licensed under the Apache License, Version 2.0 (the "License");
4 // you may not use this file except in compliance with the License.
5 // You may obtain a copy of the License at
6 //
7 // http://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,
11 // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12 // See the License for the specific language governing permissions and
13 // limitations under the License.
14 
15 #ifndef NAV2_MPPI_CONTROLLER__MODELS__TRAJECTORIES_HPP_
16 #define NAV2_MPPI_CONTROLLER__MODELS__TRAJECTORIES_HPP_
17 
18 // xtensor creates warnings that needs to be ignored as we are building with -Werror
19 #pragma GCC diagnostic push
20 #pragma GCC diagnostic ignored "-Warray-bounds"
21 #pragma GCC diagnostic ignored "-Wstringop-overflow"
22 #include <xtensor/xtensor.hpp>
23 #include <xtensor/xview.hpp>
24 #pragma GCC diagnostic pop
25 
26 namespace mppi::models
27 {
28 
34 {
35  xt::xtensor<float, 2> x;
36  xt::xtensor<float, 2> y;
37  xt::xtensor<float, 2> yaws;
38 
42  void reset(unsigned int batch_size, unsigned int time_steps)
43  {
44  x = xt::zeros<float>({batch_size, time_steps});
45  y = xt::zeros<float>({batch_size, time_steps});
46  yaws = xt::zeros<float>({batch_size, time_steps});
47  }
48 };
49 
50 } // namespace mppi::models
51 
52 #endif // NAV2_MPPI_CONTROLLER__MODELS__TRAJECTORIES_HPP_
Candidate Trajectories.
void reset(unsigned int batch_size, unsigned int time_steps)
Reset state data.