拖动无交互SDF链接时机器人仿真行为异常的原因问询

问题描述 #

我创建了一个在仿真每一步向关节发送电机值的机器人，同时生成了一组SDF链接网格。但在GUI模式下拖动SDF链接时，尽管两者无交互，机器人行为仍发生变化，请问可能的原因是什么？

已尝试的操作 #

• 确保机器人的targetAngles在多次仿真中可复现，且各次仿真的初始条件（据我判断）完全一致；若不与SDF链接交互，每次仿真的适配度结果一致。
• 确认机器人上未安装触觉传感器。
• 推测该问题是仿真中额外计算SDF链接移动导致的数值误差，但不确定是否正确。

复现步骤 #

第一次仿真：
运行generate.py
运行simulate.py
观察终端输出的位移结果

第二次仿真：
运行generate.py
运行simulate.py并同时用光标拖动SDF链接
观察终端输出的位移结果

相关代码 #

generate.py #

import pyrosim.pyrosim as pyrosim
def Create_World():
    pyrosim.Start_SDF("world.sdf")

    for i in range(10):
        for j in range(10):
            pyrosim.Send_Cube(name=f"Box{i}", pos=[-10+i*1.5,10+j*1.5,.51] , size=[1,1,1])
    pyrosim.End()


def Create_Robot():
    pyrosim.Start_URDF("body.urdf")
    pyrosim.Send_Cube(name="Torso", pos=[0,0,1.5] , size=[1,1,1])
    pyrosim.Send_Joint( name = "Torso_FrontLeg" , parent= "Torso" , child = "FrontLeg" , type = "revolute", position = [0.5,0,1])
    pyrosim.Send_Cube(name="FrontLeg", pos=[0.5,0,-0.5] , size=[1,1,1])

    pyrosim.Send_Joint( name = "Torso_BackLeg" , parent= "Torso" , child = "BackLeg" , type = "revolute", position = [-0.5,0,1])
    pyrosim.Send_Cube(name="BackLeg", pos=[-0.5,0,-0.5] , size=[1,1,1])

    pyrosim.End()

Create_World()
Create_Robot()

simulate.py #

import pybullet_data
import pybullet as p
import time
import pyrosim.pyrosim as pyrosim
import numpy as np
import random

physicsClient = p.connect(p.GUI)
p.setAdditionalSearchPath(pybullet_data.getDataPath())


p.configureDebugVisualizer(p.COV_ENABLE_GUI,0)

p.setGravity(0,0,-9.8)

planeId = p.loadURDF("plane.urdf")
p.loadSDF("world.sdf")
robotId = p.loadURDF("body.urdf")

pyrosim.Prepare_To_Simulate(robotId)

backLegSensorValues = np.zeros(1000)
frontTargetAngles = np.zeros(1000)
backTargetAngles = np.zeros(1000)

frontAmplitude = np.pi/4
frontFrequency = 10
frontPhaseOffset = 0

backAmplitude = np.pi/4
backFrequency = 10
backPhaseOffset = np.pi/3

stateOfLinkZero = p.getBasePositionAndOrientation(robotId)
positionOfLinkZero = stateOfLinkZero[0]
xCoord = positionOfLinkZero[0]
print('Initial X Coordinate= ', xCoord)

for i in range(1000):

    p.stepSimulation()
    frontTargetAngles = frontAmplitude * np.sin(frontFrequency * i + frontPhaseOffset)
    backTargetAngles = backAmplitude * np.sin(backFrequency * i + backPhaseOffset)


    pyrosim.Set_Motor_For_Joint(
        bodyIndex = robotId,
        jointName = "Torso_FrontLeg",
        controlMode = p.POSITION_CONTROL,
        targetPosition = frontTargetAngles,
        maxForce = 500)

    pyrosim.Set_Motor_For_Joint(
        bodyIndex = robotId,
        jointName = "Torso_BackLeg",
        controlMode = p.POSITION_CONTROL,
        targetPosition = backTargetAngles,
        maxForce = 500)

    time.sleep(1/4000)


    if i%100 == 0 or i == 999:
        stateOfLinkZero = p.getBasePositionAndOrientation(robotId)
        positionOfLinkZero = stateOfLinkZero[0]
        xCoord = positionOfLinkZero[0]
        print('X Coordinate= ', xCoord)

p.disconnect()

问题解答 #

1. GUI线程与仿真线程的同步干扰：PyBullet的GUI模式下，拖动SDF链接的操作会占用主线程资源，导致time.sleep(1/4000)的执行精度下降，仿真步长的一致性被打破。虽然循环次数固定，但每步仿真的实际时间间隔出现偏差，会改变电机控制指令的生效时机，最终导致机器人运动轨迹偏移。

2. 物理引擎计算资源被抢占：拖动SDF链接时，物理引擎需要实时计算刚体状态变更（即使和机器人无碰撞），会抢占部分计算资源，导致机器人关节控制的求解精度下降。物理引擎可能会动态调整每步仿真的迭代次数或求解器精度，引入的数值误差积累后造成机器人行为变化。

3. 全局随机状态的间接影响：代码中导入了random模块，PyBullet内部部分物理计算可能依赖全局随机种子。GUI交互可能触发引擎内部的状态重置或随机数生成逻辑，间接影响机器人仿真的初始条件或中间计算结果，导致行为不一致。

验证建议 #

• 改用p.connect(p.DIRECT)关闭GUI，通过代码程序化移动SDF链接，观察机器人行为是否变化，排除GUI线程干扰。
• 替换time.sleep，使用PyBullet内置的p.setRealTimeSimulation(1)或固定时间步长控制，确保每步仿真的时间间隔严格一致。
• 仿真开始前显式设置全局随机种子（如random.seed(0)和np.random.seed(0)），消除随机因素影响。

内容的提问来源于stack exchange，提问作者Rashid Abramov