雅克比矩阵在机器人运动学中的应用

以六轴机械臂为例,设机械臂关节空间为q,位置矩阵为p,速度矩阵为v

q = q 0 , q 1 , q 2 , q 3 , q 4 , q 5 q=q_0,q_1,q_2,q_3,q_4,q_5 q=q0,q1,q2,q3,q4,q5

p = x , y , z T = f x ( q ) f y ( q ) f z ( q ) p=x,y,z^T=\begin{bmatrix}f_x(q) \\ f_y(q)\\ f_z(q) \\ \end{bmatrix} p=x,y,zT= fx(q)fy(q)fz(q)

联立机械臂速度矩阵、关节空间和位置矩阵的关系如下

v = p ˙ = ( d f x d t d f y d t d f z d t ) = ( ∂ f x ∂ q 0 d q 0 d t ⋯ ∂ f x ∂ q 5 d q 5 d t ∂ f y ∂ q 0 d q 0 d t ⋯ ∂ f y ∂ q 5 d q 5 d t ∂ f z ∂ q 0 d q 0 d t ⋯ ∂ f z ∂ q 5 d q 5 d t ) = ( ∂ f x ∂ q 0 ⋯ ∂ f x ∂ q 5 ∂ f y ∂ q 0 ⋯ ∂ f y ∂ q 5 ∂ f z ∂ q 0 ⋯ ∂ f z ∂ q 5 ) ( q 1 ⋮ q 5 ) v=\dot p=\begin{pmatrix}\frac {df_x}{dt} \\ \frac {df_y}{dt} \\ \frac {df_z}{dt}\\ \end{pmatrix} =\begin{pmatrix}\frac {\partial f_x} {\partial q_0}\frac {dq_0} {dt}& \cdots & \frac {\partial f_x} {\partial q_5}\frac {dq_5} {dt} \\ \frac {\partial f_y} {\partial q_0} \frac {dq_0} {dt} &\cdots&\frac {\partial f_y} {\partial q_5} \frac {dq_5} {dt} \\\frac {\partial f_z} {\partial q_0} \frac {dq_0} {dt} &\cdots & \frac {\partial f_z} {\partial q_5} \frac {dq_5} {dt} \end{pmatrix}= \begin{pmatrix}\frac {\partial f_x} {\partial q_0}& \cdots & \frac {\partial f_x} {\partial q_5} \\ \frac {\partial f_y} {\partial q_0}& \cdots & \frac {\partial f_y} {\partial q_5} \\\frac {\partial f_z} {\partial q_0}& \cdots & \frac {\partial f_z} {\partial q_5} \end{pmatrix}\begin{pmatrix}q_1 \\ \vdots \\ q_5\\ \end{pmatrix} v=p˙= dtdfxdtdfydtdfz = ∂q0∂fxdtdq0∂q0∂fydtdq0∂q0∂fzdtdq0⋯⋯⋯∂q5∂fxdtdq5∂q5∂fydtdq5∂q5∂fzdtdq5 = ∂q0∂fx∂q0∂fy∂q0∂fz⋯⋯⋯∂q5∂fx∂q5∂fy∂q5∂fz q1⋮q5

将中间矩阵定义为雅克比矩阵J,则

J = ( ∂ f x ∂ q 0 ⋯ ∂ f x ∂ q 5 ∂ f y ∂ q 0 ⋯ ∂ f y ∂ q 5 ∂ f z ∂ q 0 ⋯ ∂ f z ∂ q 5 ) J=\begin{pmatrix}\frac {\partial f_x} {\partial q_0}& \cdots & \frac {\partial f_x} {\partial q_5} \\ \frac {\partial f_y} {\partial q_0}& \cdots & \frac {\partial f_y} {\partial q_5} \\\frac {\partial f_z} {\partial q_0}& \cdots & \frac {\partial f_z} {\partial q_5} \end{pmatrix} J= ∂q0∂fx∂q0∂fy∂q0∂fz⋯⋯⋯∂q5∂fx∂q5∂fy∂q5∂fz

v = J q ˙ v=J\dot q v=Jq˙

q ˙ = q ˙ 0 , q ˙ 1 , q ˙ 2 , q ˙ 3 , q ˙ 4 , q ˙ 5 \dot q=\\dot q_0,\\dot q_1,\\dot q_2,\\dot q_3,\\dot q_4,\\dot q_5 q˙=q˙0,q˙1,q˙2,q˙3,q˙4,q˙5

那么雅克比矩阵J可以用来表示从关节速度空间q_dot到关节末端执行空间速度的映射,即一个末端的位置可以由多个关节空间的速度映射得到,即

q ˙ J ⟶ v \dot q {J \over \longrightarrow }v q˙⟶Jv

同样,末端执行空间速度F同样可以使用雅克比矩阵映射到关节空间力矩

τ J T ⟶ F \tau {J ^T \over \longrightarrow}F τ⟶JTF

τ = J T F \tau = J^TF τ=JTF

例如7轴机械臂,具有冗余的一个关节空间(7x1)q_6,所以在末端执行空间的变换矩阵(6x1)(3x3旋转+3x1平移)进行映射的时候q_6无论处在什么位置,都不会影响末端执行空间的位置和速度,称为零空间

相关推荐
深圳慧闻智造技术有限公司8 小时前
机器人减速机壳体加工精度要求的四大核心维度分析
人工智能·机器人·机器人壳体加工
维克兜率天13 小时前
【维克】大数定律与中心极限定理:为什么长期均值终将回归?
经验分享·学习·金融·概率论
ARM+FPGA+AI工业主板定制专家14 小时前
国产化RK3576+FPGA架构|晶圆传输机器人高速定位+AI瑕疵检测一体化方案
fpga开发·架构·机器人·嵌入式·fpga·工控·机器人运控
视图猿人14 小时前
ROS2 AGV SLAM导航仿真系统技术详解与踩坑实录
机器人·ros2
CoreTK_EMC16 小时前
机器人 EMC 深度解析:产业放量下的技术痛点与落地路径
机器人·芯通康·机器人emc·人形机器人电磁兼容·伺服关节 emc 防护·机器人灵巧手 emc·emc 整改
一颗小树x17 小时前
机器人世界模型:2026 技术全景与工程选型指南
机器人·指南·操作·vla·世界模型
bj_zhb21 小时前
矩阵的白化变换/球化变换
线性代数·矩阵
机器人落地派1 天前
机器人项目变更闭环检查表:别只写“已经改了”
人工智能·机器人·人形机器人·机器人落地·评审
workflower1 天前
供应链分销网络选址问题
人工智能·机器学习·设计模式·自然语言处理·机器人
硅谷秋水2 天前
ABot-M0.5:统一的移动-与-操作世界动作模型
人工智能·深度学习·机器学习·计算机视觉·语言模型·机器人