1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
""" 7自由度机械臂状态
"""
...
"""
# Franka 机器人
"""
...
"""
# FrankaRobot
## 设置碰撞行为
Set separate torque and force boundaries for acceleration/deceleration and constant velocity movement phases.
Forces or torques between lower and upper threshold are shown as contacts in the RobotState.
Forces or torques above the upper threshold are registered as collision and cause the robot to stop moving.
Args:
lower_torque_thresholds_acceleration (list): 关节加速度下限
upper_torque_thresholds_acceleration (list): 关节加速度上限
lower_torque_thresholds_nominal (list): 关节名义下限
upper_torque_thresholds_nominal (list): 关节名义上限
lower_force_thresholds_acceleration (list): 力加速度下限
upper_force_thresholds_acceleration (list): 力加速度上限
lower_force_thresholds_nominal (list): 力名义下限
upper_force_thresholds_nominal (list): 力名义上限
"""
...
"""
# FrankaRobot
## 设置关节阻抗
Args:
data: list[float; 7] 关节阻抗
"""
...
"""
# FrankaRobot
## 设置笛卡尔阻抗
Args:
data: list[float; 6] 笛卡尔阻抗
"""
...
"""
# FrankaRobot
## 设置默认行为
"""
...
"""
# FrankaRobot
## 设置引导模式
Locks or unlocks guiding mode movement in (x, y, z, roll, pitch, yaw).
Args:
guiding_mode: list[float; 6] 自由度是否锁定
nullspace: bool 是否使用零空间
"""
...
"""
# FrankaRobot
## 设置末端执行器到基坐标系
Args:
data: list[float; 16] 末端执行器到基坐标系的变换矩阵
"""
...
"""
# FrankaRobot
## 设置末端执行器到工具坐标系
Args:
data: list[float; 16] 末端执行器到工具坐标系的变换矩阵
"""
...
"""
# FrankaRobot
## 设置负载
The transformation matrix is represented as a vectorized 4x4 matrix in column-major format.
This is not for setting end effector parameters, which have to be set in the administrator's interface.
Args:
m_load: float 负载质量
x_load: list[float; 3] 负载位置
i_load: list[float; 9] 负载惯性
"""
...
"""
# FrankaRobot
## 机械臂状态
Returns:
PyArmState7 机械臂状态
"""
...
"""
# FrankaRobot
## 关节空间运动
初始位置为 [0., -PI / 4., 0., -3. * PI / 4., 0., PI / 2., PI / 4.]
Args:
target: list[float; 7] 目标关节角度
speed: float 运动速度比
"""
...
"""
# FrankaRobot
## 基于齐次变换矩阵的笛卡尔空间运动(按列排布的齐次变换矩阵转为的向量)
初始位置为
[0.999988717111279, -0.0017158199764830543, 0.0006070528432007165, 0.0,
-0.0017159793580267732, -0.9999888667416037, 0.0002621238143371493, 0.0,
0.0006066080065316006, -0.00026316761376355145, -0.9999997813847427, 0.0,
0.30648819513520104, -0.0005332618190956864, 0.48708322693240846, 1.0]
]
"""
"""
# FrankaRobot
## 基于欧拉角的笛卡尔空间运动
"""
"""
# Franka 机械爪
"""
"""
# Franka 机械爪
## 归位
"""
...
"""
# Franka 机械爪
## 抓取
Args:
width: float 抓取宽度,前后裕度各 5mm
speed: float 抓取速度
force: float 抓取力
"""
...
"""
# Franka 机械爪
## 移动爪
Args:
width: float 宽度
speed: float 速度
"""
...
"""
# Franka 机械爪
## 停止
"""
...