]> rtime.felk.cvut.cz Git - hubacji1/iamcar.git/blob - decision_control/slotplanner.cc
Add method to get init pose center from slot
[hubacji1/iamcar.git] / decision_control / slotplanner.cc
1 /*
2 This file is part of I am car.
3
4 I am car is free software: you can redistribute it and/or modify
5 it under the terms of the GNU General Public License as published by
6 the Free Software Foundation, either version 3 of the License, or
7 (at your option) any later version.
8
9 I am car is distributed in the hope that it will be useful,
10 but WITHOUT ANY WARRANTY; without even the implied warranty of
11 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12 GNU General Public License for more details.
13
14 You should have received a copy of the GNU General Public License
15 along with I am car. If not, see <http://www.gnu.org/licenses/>.
16 */
17
18 #include "slotplanner.h"
19
20 ParallelSlot::ParallelSlot()
21 {}
22
23 // getter
24 PolygonObstacle &ParallelSlot::slot()
25 {
26         return this->slot_;
27 }
28
29 // other
30 RRTNode *ParallelSlot::fposecenter()
31 {
32         if (this->slot().bnodes().front()->y() >
33                         this->slot().bnodes().back()->y())
34                 return this->slot().bnodes().front();
35         else
36                 return this->slot().bnodes().back();
37 }