GaitGeneration by Graph Search
読み取り中…
検索中…
一致する文字列を見つけられません
node_creator_builder_straight_move.cpp
[詳解]
1
3
4// Copyright(c) 2023-2025 Design Engineering Laboratory, Saitama University
5// Released under the MIT license
6// https://opensource.org/licenses/mit-license.php
7
9
10#include <vector>
11
12#include "cassert_define.h"
17
18namespace designlab {
19
21 const std::shared_ptr<const IHexapodCoordinateConverter>& converter_ptr,
22 const std::shared_ptr<const IHexapodStatePresenter>& presenter_ptr,
23 const std::shared_ptr<const IHexapodPostureValidator>& checker_ptr)
24 : converter_ptr_(converter_ptr),
25 presenter_ptr_(presenter_ptr),
26 checker_ptr_(checker_ptr) {}
27
29 const DividedMapState& map,
30 std::map<HexapodMove, std::unique_ptr<INodeCreator> >* node_creator) const {
31 using enum DiscreteLegPos;
32 using enum HexapodMove;
33
34 assert(node_creator != nullptr); // node_creator が nullptr でない.
35 assert(node_creator->size() == 0); // node_creator は空でなければならない.
36
37 // 追加したい場合,以下のように記述する.
38 // (*node_creator)[HexapodMove::???] =
39 // std::make_unique<クラス名>(クラスのコンストラクタの引数);
40 // この場合,HexapodMove::???のノードを作成するクラスは,^~~~~~ である.
41
42 const auto hierarchy_list = std::vector<DiscreteLegPos>{
44
45 (*node_creator)[kLegHierarchyChange] =
46 std::make_unique<NodeCreatorLegHierarchy>(kLegUpDown, hierarchy_list);
47
48 (*node_creator)[kLegUpDown] = std::make_unique<NodeCreatorLegUpDown>(
49 map, converter_ptr_, presenter_ptr_, checker_ptr_, kComUpDown);
50
51 (*node_creator)[kComUpDown] = std::make_unique<NodeCreatorComUpDown>(
52 map, converter_ptr_, presenter_ptr_, checker_ptr_, kComMove);
53
54 (*node_creator)[kComMove] = std::make_unique<NodeCreatorComMoveStraight>(
55 map, converter_ptr_, presenter_ptr_, checker_ptr_, kLegHierarchyChange);
56}
57
58} // namespace designlab
マップを格子状に分割して管理するクラス.
NodeCreatorBuilderStraightMove(const std::shared_ptr< const IHexapodCoordinateConverter > &converter_ptr, const std::shared_ptr< const IHexapodStatePresenter > &presenter_ptr, const std::shared_ptr< const IHexapodPostureValidator > &checker_ptr)
void Build(const DividedMapState &map, std::map< HexapodMove, std::unique_ptr< INodeCreator > > *node_creator) const override
INodeCreatorを生成する.
DiscreteLegPos
離散化された脚位置を表す列挙体. 先行研究では 1~7の int型の数値で表現されているが, 可読性を上げるために列挙体にした. 離散化された脚位置は 3bit (0 ~ 7)の範囲で表現される...
@ kUpperBack
現在の位置より後方かつ上方にある.
@ kBack
現在の位置より後方にある.
@ kCenter
現在の位置にある.
@ kUpperFront
現在の位置より前方かつ上方にある.
@ kFront
現在の位置より前方にある.
@ kLowerBack
現在の位置より後方かつ下方にある.
@ kLowerFront
現在の位置より前方かつ下方にある.
HexapodMove
ロボットが次にどの動作をするのかを表す列挙体.
@ kLegUpDown
脚の上下移動.
@ kComMove
重心の平行移動.Center Of Massで重心のこと.
@ kComUpDown
重心の上下移動.
@ kLegHierarchyChange
脚の平行移動.脚の階層を変更する.