diff --git a/src/Robot_arm_motion/requirements.txt b/src/Robot_arm_motion/requirements.txt new file mode 100644 index 0000000000..e69de29bb2 diff --git a/src/Robot_arm_motion/scripts/robot_arm.py b/src/Robot_arm_motion/scripts/robot_arm.py new file mode 100644 index 0000000000..a810cb96f1 --- /dev/null +++ b/src/Robot_arm_motion/scripts/robot_arm.py @@ -0,0 +1,93 @@ +""" +MuJoCo机械臂仿真v0.2 +功能:基础2关节机械臂可视化+关节角度控制+夹爪开合控制 +项目根目录:Robot_arm_motion +代码目录:scripts +作者:邓卓 +日期:2025-12-22 +版本:v0.2(添加夹爪开合控制,修复XML Schema错误) +""" +import mujoco +import mujoco.viewer as viewer +import numpy as np + +def create_simple_arm_model(): + """创建简易2关节机械臂+立方体模型的XML字符串(修复ctrlrange属性错误)""" + xml = """ + + + """ + return mujoco.MjModel.from_xml_string(xml) + +def main(): + """主函数:加载模型+启动仿真(新增夹爪控制)""" + # 加载模型 + model = create_simple_arm_model() + data = mujoco.MjData(model) + + # 设置初始关节角度 + joint1_id = mujoco.mj_name2id(model, mujoco.mjtObj.mjOBJ_JOINT, "joint1") + joint2_id = mujoco.mj_name2id(model, mujoco.mjtObj.mjOBJ_JOINT, "joint2") + data.ctrl[joint1_id] = np.pi/4 # 关节1转45° + data.ctrl[joint2_id] = -np.pi/6 # 关节2转-30° + + # 新增:设置夹爪初始开合角度(半开状态) + left_gripper_id = mujoco.mj_name2id(model, mujoco.mjtObj.mjOBJ_JOINT, "left_gripper_joint") + right_gripper_id = mujoco.mj_name2id(model, mujoco.mjtObj.mjOBJ_JOINT, "right_gripper_joint") + data.ctrl[left_gripper_id] = 0.03 # 左夹爪张开3mm + data.ctrl[right_gripper_id] = -0.03 # 右夹爪张开3mm + + # 启动可视化 + print("=== Robot_arm_motion v0.2 仿真启动(新增夹爪开合控制) ===") + print("当前夹爪状态:半开(3mm)") + with viewer.launch_passive(model, data) as v: + while v.is_running(): + mujoco.mj_step(model, data) + v.sync() + +if __name__ == "__main__": + main() \ No newline at end of file diff --git a/src/Robot_arm_motion/test.py b/src/Robot_arm_motion/test.py new file mode 100644 index 0000000000..e69de29bb2