为什么加载SDF会导致Mobilizer创建闭环错误
Why is loading my SDF causing Mobilizer creating a closed loop error
我试图将SDF加载到drake中,但我的程序抛出了std::runtime_error
terminate called after throwing an instance of 'std::runtime_error'
what(): This mobilizer is creating a closed loop since the outboard body already has an inboard mobilizer connected to it. If a physical loop is really needed, consider using a constraint instead.
Aborted (core dumped)
这是我运行的代码
MultibodyPlant<double>* dp =
builder.AddSystem<MultibodyPlant<double>>(max_time_step);
dp->set_name("plant");
dp->RegisterAsSourceForSceneGraph(&scene_graph);
drake::multibody::Parser parser(dp);
const std::string sdf_path = kDoublePendulumSdfPath;
parser.AddModelFromFile(sdf_path);
dp->Finalize();
这是我的SDF
<sdf version="1.4">
<model name="t-wrecks">
<link name="left_foot"><pose>0 0 0 0 0 0</pose><collision name="collision"><geometry><box><size>1 1 1</size></box></geometry></collision><visual name="visual"><geometry><box><size>1 1 1</size></box></geometry></visual></link>
<link name="right_foot"><pose>2 0 0 0 0 0</pose><collision name="collision"><geometry><box><size>1 1 1</size></box></geometry></collision><visual name="visual"><geometry><box><size>1 1 1</size></box></geometry></visual></link>
<link name="left_leg"><pose>0 0 1.5 0 0 0</pose><collision name="collision"><geometry><box><size>0.5 0.5 2</size></box></geometry></collision><visual name="visual"><geometry><box><size>0.5 0.5 2</size></box></geometry></visual></link>
<link name="right_leg"><pose>2 0 1.5 0 0 0 0</pose><collision name="collision"><geometry><box><size>0.5 0.5 2</size></box></geometry></collision><visual name="visual"><geometry><box><size>0.5 0.5 2</size></box></geometry></visual></link>
<link name="left_thigh"><pose>0 -0.4 3 0.5 0 0</pose><collision name="collision"><geometry><box><size>0.5 0.5 2</size></box></geometry></collision><visual name="visual"><geometry><box><size>0.5 0.5 2</size></box></geometry></visual></link>
<link name="right_thigh"><pose>2 -0.4 3 0.5 0 0</pose><collision name="collision"><geometry><box><size>0.5 0.5 2</size></box></geometry></collision><visual name="visual"><geometry><box><size>0.5 0.5 2</size></box></geometry></visual></link>
<link name="pelvis"><pose>1.0 -0.75 3.75 0 0 0</pose><collision name="collision"><geometry><box><size>2.5 1 0.25</size></box></geometry></collision><visual name="visual"><geometry><box><size>2.5 1 0.25</size></box></geometry></visual></link>
<joint name="left_leg_foot" type="revolute"><pose>0 0 0 0 0 0</pose><child>left_foot</child><parent>left_leg</parent><axis><xyz>1 0 0</xyz></axis></joint>
<joint name="right_leg_foot" type="revolute"><pose>0 0 0 0 0 0</pose><child>right_foot</child><parent>right_leg</parent><axis><xyz>1 0 0</xyz></axis></joint><joint name="left_knee" type="revolute"><pose>0 0 1.0 0 0 0</pose><child>left_leg</child><parent>left_thigh</parent><axis><xyz>1 0 0</xyz></axis></joint><joint name="right_knee" type="revolute"><pose>0 0 1 0 0 0</pose><child>right_leg</child><parent>right_thigh</parent><axis><xyz>1 0 0</xyz></axis></joint>
<joint name="left_hip" type="revolute"><pose>0 0 1 0 0 0</pose><child>pelvis</child><parent>right_thigh</parent><axis><xyz>1 0 0</xyz></axis></joint><joint name="right_hip" type="revolute"><pose>0 0 1 0 0 0</pose><child>pelvis</child><parent>left_thigh</parent><axis><xyz>1 0 0</xyz></axis></joint>
</model>
<static>true</static>
</sdf>
这是因为目前我们只支持具有严格树结构的模型。从SDF文件中,这个树结构是从<parent>
和<child>
标记推断出来的,由于这个限制,Drake将其理解为树结构中的inboard
和outboard
体(我们最终会取消这个限制,但可能不会很快(。
在您的情况下,我看到您提供了pelvis
主体作为另外两个链接的子链接;right_thigh
和left_thigh
,这在今天是不受支持的。
若要解决此问题,请交换关节left_hip
和right_hip
中的子关节/父关节。
顺便说一句,我在你的文件中没有看到惯性属性,只有视觉效果和碰撞。因此,您将无法模拟或计算任何有用的动力学信息。我想这只是因为这是正在进行的工作。
祝你好运。
相关文章:
- C++使用params创建线程函数会导致转换错误
- 为什么加载SDF会导致Mobilizer创建闭环错误
- 此代码编译良好,但文件未创建?请指出错误
- 对象创建错误的C++矢量
- 如果用户输入的字符过多,则创建错误消息
- 本机库中的 OpenCV 创建错误
- #include "date.h" 创建错误 E1696 无法打开源文件"date.h",也无法打开包含文件:没有这样的文件或目录
- 使用makeword函数创建错误e0109-表观呼叫的括号前表达式必须具有(指针到 - )函数类型
- piThread在调用函数后创建错误
- CMAKE GCOV C 创建错误的.gcno文件
- 关于 C++ 中的头文件创建错误
- 窗口创建错误 - 可能是事件处理
- 氧气创建错误
- Xcode typedef 的 struct 创建错误/警告
- pthread 在分离的线程上创建错误 11
- 为什么代码创建错误的二进制搜索树
- 有人建议我的代码为什么在basic_ios和sstream中创建错误
- JNA -结构创建错误
- pthread在c++中创建错误
- 对象创建错误