Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
34 commits
Select commit Hold shift + click to select a range
a0b13ba
提交选题
longzhongliang Nov 26, 2025
9668166
Merge pull request #1 from longzhongliang/grasp
longzhongliang Nov 26, 2025
aae3d36
提交选题
longzhongliang Nov 26, 2025
7c6d1d7
Merge pull request #2 from longzhongliang/grasp
longzhongliang Nov 26, 2025
fe38550
提交了模型文件和测试代码
longzhongliang Dec 15, 2025
62bc2d0
Merge pull request #3 from longzhongliang/grasp
longzhongliang Dec 15, 2025
3576327
提交了模型文件和测试代码
longzhongliang Dec 15, 2025
904cd5c
Merge pull request #4 from longzhongliang/grasp
longzhongliang Dec 15, 2025
623c1c2
提交了模型文件和测试代码
longzhongliang Dec 17, 2025
09b598a
Merge pull request #5 from longzhongliang/grasp
longzhongliang Dec 17, 2025
00a47f8
机械臂控制
longzhongliang Dec 18, 2025
b300ee1
Merge pull request #6 from longzhongliang/grasp
longzhongliang Dec 18, 2025
7f146b3
机械臂控制
longzhongliang Dec 18, 2025
d6e9824
Merge pull request #7 from longzhongliang/grasp
longzhongliang Dec 18, 2025
ac2e058
机械臂路径运行路径轨迹
longzhongliang Dec 19, 2025
b8222db
Merge pull request #8 from longzhongliang/grasp
longzhongliang Dec 19, 2025
c578f4f
抓取姿态生成与评估可视化系统
longzhongliang Dec 19, 2025
d363fc3
机械臂强化学习训练可视化系统
longzhongliang Dec 19, 2025
d3865ad
Merge pull request #9 from longzhongliang/grasp
longzhongliang Dec 19, 2025
ddacfb2
Merge pull request #10 from longzhongliang/grasp
longzhongliang Dec 19, 2025
3eb89f4
传感器融合与状态估计可视化系统
longzhongliang Dec 19, 2025
34e8412
Merge pull request #11 from longzhongliang/grasp
longzhongliang Dec 19, 2025
316b4cf
传感器融合与状态估计可视化系统
longzhongliang Dec 19, 2025
dd510cf
Merge pull request #12 from longzhongliang/grasp
longzhongliang Dec 19, 2025
783a093
机械臂轨迹规划与优化可视化系统
longzhongliang Dec 19, 2025
15df328
Merge pull request #13 from longzhongliang/grasp
longzhongliang Dec 19, 2025
38a36bb
机械臂工作空间可视化
longzhongliang Dec 20, 2025
1d4dfc8
机械臂工作空间可视化
longzhongliang Dec 20, 2025
e283fe7
Merge pull request #14 from longzhongliang/grasp
longzhongliang Dec 20, 2025
eb1da4b
Merge pull request #15 from longzhongliang/grasp
longzhongliang Dec 20, 2025
70466d8
抓取力分析
longzhongliang Dec 21, 2025
42a88e0
Merge pull request #16 from longzhongliang/grasp
longzhongliang Dec 21, 2025
c56f875
抓取力分析
longzhongliang Dec 21, 2025
0144197
Merge pull request #17 from longzhongliang/grasp
longzhongliang Dec 21, 2025
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
25 changes: 25 additions & 0 deletions src/robotic_arm_grasping/README.md
Original file line number Diff line number Diff line change
@@ -0,0 +1,25 @@
# Robotic Arm Grasping

## 项目简介
本项目使用 MuJoCo 物理引擎实现机械臂抓取系统的仿真与优化。核心目标是利用 MuJoCo 强大的动力学建模能力,精准模拟机械臂、目标物体的物理交互(如夹持力、摩擦力、碰撞响应),完成从目标感知、抓取规划到动作执行的全流程闭环,并通过算法迭代提升抓取稳定性与成功率。

## 环境配置
### 第一步:安装 MuJoCo 引擎
参考 [MuJoCo 官方文档](https://mujoco.org/book/installation.html) 完成安装:
1. 下载 MuJoCo 2.3.7+ 压缩包,解压至对应路径:
- Linux/Mac:`~/.mujoco/mujoco-2.3.7`
- Windows:`C:\Users\YourName\.mujoco\mujoco-2.3.7`
2. 配置环境变量(可选,用于命令行直接调用 MuJoCo 引擎)

### 第二步:安装项目依赖
```bash
# 克隆仓库
git clone https://github.com/your-username/mujoco-robotic-grasping.git
cd mujoco-robotic-grasping

# 安装 Python 依赖
pip install -r requirements.txt

参考资料
MuJoCo 官方文档:核心 API 说明、模型导入规范、物理参数配置指南
MuJoCo Python 接口教程:Python 调用示例、仿真控制细节****
151 changes: 151 additions & 0 deletions src/robotic_arm_grasping/arm_control.py
Original file line number Diff line number Diff line change
@@ -0,0 +1,151 @@
import threading, queue
import tkinter as tk
import glfw, mujoco as mj
import numpy as np

XML_PATH = 'arm_with_gripper.xml'

CTRL_QUEUE = queue.Queue() # 6 关节指令
GRIP_QUEUE = queue.Queue() # 抓取状态 True=闭合 False=张开

# ---------- Tkinter 面板 ----------
def tk_panel(joint_names, joint_ranges):
root = tk.Tk()
root.title('Arm Panel + Grab')

# 6 个关节滑杆
scales, vars = [], [tk.DoubleVar() for _ in joint_names]
def send_joint(*_):
ctrl = np.clip([v.get() for v in vars],
[r[0] for r in joint_ranges],
[r[1] for r in joint_ranges])
CTRL_QUEUE.put(ctrl)

for i, (name, rng) in enumerate(zip(joint_names, joint_ranges)):
tk.Label(root, text=name).grid(row=i, column=0, sticky='e')
s = tk.Scale(root, from_=rng[0], to=rng[1], resolution=0.01,
orient=tk.HORIZONTAL, length=300, variable=vars[i],
command=send_joint)
s.set((rng[0] + rng[1]) * 0.5)
s.grid(row=i, column=1)
scales.append(s)

# Grab / Release 按钮
def grab():
GRIP_QUEUE.put(True)
def release():
GRIP_QUEUE.put(False)

tk.Button(root, text='Grab', command=grab, bg='green', fg='white').grid(row=6, column=0, pady=10)
tk.Button(root, text='Release', command=release, bg='red', fg='white').grid(row=6, column=1, pady=10)

root.mainloop()

# ---------- MuJoCo 渲染线程 ----------
def mujoco_thread(joint_ids, joint_ranges, grip_act_ids):
model = mj.MjModel.from_xml_path(XML_PATH)
data = mj.MjData(model)

# 初始值
ctrl_jnt = np.array([(r[0] + r[1]) * 0.5 for r in joint_ranges])
ctrl_grip_open = np.array([0.05, 1.5, 1.2] * 3) # 3 指张开(对应 slide/hinge1/hinge2)
data.ctrl[joint_ids] = ctrl_jnt
data.ctrl[grip_act_ids] = ctrl_grip_open
CTRL_QUEUE.put(ctrl_jnt)
GRIP_QUEUE.put(False)

if not glfw.init():
raise RuntimeError('glfw init failed')
win = glfw.create_window(1200, 900, 'Arm Panel + Grab (Fixed)', None, None)
if not win:
glfw.terminate(); raise RuntimeError('glfw window failed')
glfw.make_context_current(win)
glfw.swap_interval(1)

cam = mj.MjvCamera()
cam.azimuth, cam.elevation = 135, -20
cam.distance = 1.8
cam.lookat[:] = [0, 0, 0.3]
opt = mj.MjvOption()
mj.mjv_defaultOption(opt)
scene = mj.MjvScene(model, maxgeom=5000)
con = mj.MjrContext(model, mj.mjtFontScale.mjFONTSCALE_150)

# 添加状态保持变量
last_ctrl_jnt = ctrl_jnt.copy()
last_grab_state = False

# 添加标志位,用于跟踪是否已经处理过初始队列消息
processed_initial_ctrl = False
processed_initial_grip = False

while not glfw.window_should_close(win):
glfw.poll_events()
width, height = glfw.get_framebuffer_size(win)
viewport = mj.MjrRect(0, 0, width, height)

# 1. 关节指令
try:
ctrl_jnt = CTRL_QUEUE.get_nowait()
# 只有在处理过初始消息后才更新状态
if processed_initial_ctrl:
ctrl_jnt = np.clip(ctrl_jnt,
[r[0] for r in joint_ranges],
[r[1] for r in joint_ranges])
data.ctrl[joint_ids] = ctrl_jnt
last_ctrl_jnt = ctrl_jnt.copy() # 保存最后一次控制指令
else:
processed_initial_ctrl = True
except queue.Empty:
# 如果没有新的控制指令,保持上次的状态
data.ctrl[joint_ids] = last_ctrl_jnt

# 2. 抓取指令(9 个执行器一起写,保证 equality 同步)
try:
grab = GRIP_QUEUE.get_nowait()
# 只有在处理过初始消息后才更新状态
if processed_initial_grip:
if grab: # 闭合
data.ctrl[grip_act_ids] = [-0.02, -0.2, 0.0] * 3
else: # 张开
data.ctrl[grip_act_ids] = [0.05, 1.5, 1.2] * 3
last_grab_state = grab # 保存最后一次抓取状态
else:
processed_initial_grip = True
except queue.Empty:
# 如果没有新的抓取指令,保持上次的状态
if last_grab_state: # 闭合状态
data.ctrl[grip_act_ids] = [-0.02, -0.2, 0.0] * 3
else: # 张开状态
data.ctrl[grip_act_ids] = [0.05, 1.5, 1.2] * 3

mj.mj_step(model, data)
mj.mjv_updateScene(model, data, opt, None, cam, mj.mjtCatBit.mjCAT_ALL, scene)
mj.mjr_render(viewport, scene, con)
glfw.swap_buffers(win)

glfw.terminate()

# ---------- 主入口 ----------
def main():
model = mj.MjModel.from_xml_path(XML_PATH)

# 6 个 arm 执行器
jnt_act = ['motor_joint1', 'motor_joint2', 'motor_joint3',
'motor_joint4', 'motor_joint5', 'motor_joint6']
# 9 个夹爪执行器(3 指 × 3 自由度)
grip_act = ['motor_finger1_slide', 'motor_finger1_hinge1', 'motor_finger1_hinge2',
'motor_finger2_slide', 'motor_finger2_hinge1', 'motor_finger2_hinge2',
'motor_finger3_slide', 'motor_finger3_hinge1', 'motor_finger3_hinge2']

joint_ids = [model.actuator(n).id for n in jnt_act]
grip_ids = [model.actuator(n).id for n in grip_act]

# 用关节真实 range 做硬限位
joint_ranges = [model.jnt_range[model.joint(j.replace('motor_', '')).id] for j in jnt_act]

threading.Thread(target=tk_panel, args=(jnt_act, joint_ranges), daemon=True).start()
mujoco_thread(joint_ids, joint_ranges, grip_ids)

if __name__ == '__main__':
main()
Loading
Loading