如何程序化缩放RigidBody？Drake是否有类RigidTransform的缩放工具？

一、编程缩放SDFormat生成的RigidBody #

构建阶段（推荐方案） #

MultibodyPlant在调用Finalize()后会进入不可变状态，无法修改刚体的核心几何参数，因此建议在构建阶段完成缩放操作，步骤如下：

1. 将SDFormat模型加载到未最终化的MultibodyPlant中；
2. 获取目标刚体对应的BodyIndex；
3. 遍历该刚体的碰撞/视觉几何实例，修改其缩放参数；
4. （可选）重新计算刚体的质量与惯性矩——几何缩放会改变质量分布，此步骤可保证动力学参数准确；
5. 调用plant.Finalize()完成构建。

示例代码：

// 假设已加载模型到model_instance
const BodyIndex body_idx = plant.GetBodyIndices(model_instance).front();

// 缩放碰撞几何
for (const GeometryId& geom_id : plant.GetCollisionGeometriesForBody(body_idx)) {
  auto& geom_instance = plant.GetMutableGeometryInstance(geom_id);
  // 设置XYZ方向缩放比例，此处为均匀缩放2倍
  geom_instance.set_scale(Eigen::Vector3d(2.0, 2.0, 2.0));
}

// 缩放视觉几何
for (const GeometryId& geom_id : plant.GetVisualGeometriesForBody(body_idx)) {
  auto& geom_instance = plant.GetMutableGeometryInstance(geom_id);
  geom_instance.set_scale(Eigen::Vector3d(2.0, 2.0, 2.0));
}

// 基于缩放后的几何重新计算刚体质量与惯性矩
plant.CalcMassPropertiesFromGeometries(body_idx);

// 最终化MultibodyPlant
plant.Finalize();

关于Plant最终化后的操作 #

Plant最终化后，内部动力学结构、几何数据均已固化，无法修改刚体的几何缩放参数。如果仅需调整视觉表现，可通过可视化接口（如Meshcat）单独修改视觉几何的缩放，但此操作不会影响动力学计算结果。

二、Drake中的缩放变换工具 #

Drake没有提供与RigidTransform完全对等的“纯缩放变换”类，但有专门工具满足缩放需求：

1. UniformScalingTransform：用于处理均匀缩放，支持与RigidTransform组合使用，实现缩放+刚体变换的复合操作；
2. AffineTransform：用于处理非均匀缩放或更复杂的仿射变换（包含缩放、旋转、平移的组合）。

示例代码：

// 均匀缩放变换（整体缩放2倍）
UniformScalingTransform<double> uniform_scale(2.0);

// 组合均匀缩放与刚体变换（先旋转平移，再缩放）
RigidTransform<double> X_AB(Eigen::AngleAxisd(M_PI/2, Eigen::Vector3d::UnitZ()), Eigen::Vector3d(1,0,0));
AffineTransform<double> combined_transform = uniform_scale * X_AB;

// 非均匀缩放的仿射变换（XYZ方向分别缩放2/1.5/3倍）
Eigen::Matrix3d scale_matrix;
scale_matrix << 2.0, 0, 0,
                0, 1.5, 0,
                0, 0, 3.0;
AffineTransform<double> non_uniform_scale(scale_matrix, Eigen::Vector3d::Zero());

内容的提问来源于stack exchange，提问作者Nicholas Pfaff