演示文稿第六章機器人動力學

第六章機器人動力學ppt課件目前一頁\總數(shù)八十頁\編于三點本章主要內(nèi)容

（1）機器人動力學研究概述；（2）拉格朗日動力學方法；（3）操作機的動力學分析；（4）二連桿機構(gòu)的動力學分析；（5）倒立擺系統(tǒng)的動力學分析；（6）機器人動力學方程一般形式；（7）考慮非剛體效應的動力學方程。5/24/2023目前二頁\總數(shù)八十頁\編于三點5/24/20236.1

機器人動力學研究概述

目前三頁\總數(shù)八十頁\編于三點6.1

機器人動力學研究概述

本章將在機器人運動學的基礎上考慮到力對具有一定質(zhì)量或慣量的物體運動的影響，從而引入機器人動力學問題；機器人動力學研究機器人動態(tài)方程的建立，它是一組描述機器人動態(tài)特性的數(shù)學方程；目前主要采用兩種理論來建立數(shù)學模型：（1）動力學基本理論，包括牛頓－歐拉方程（2）拉格朗日力學，特別是二階拉格朗日方程如同運動學，動力學也有兩個相反問題（1）正問題（2）逆問題5/24/20234目前四頁\總數(shù)八十頁\編于三點動力學的兩個相反問題動力學正問題：已知機械手各關節(jié)的作用力或力矩，求各關節(jié)的位移、速度和加速度（即運動軌跡），主要用于機器人仿真。動力學逆問題：已知機械手的運動軌跡，即幾個關節(jié)的位移、速度和加速度，求各關節(jié)所需要的驅(qū)動力或力矩，用于機器人實時控制。求解動力學方程的目的，通常是為了得到機器人的運動方程，即一旦給定輸入的力或力矩，就確定了系統(tǒng)地運動結(jié)果。動力學方程的一般形式：式中分別表示力矩、力、角位移和線位移5/24/20235目前五頁\總數(shù)八十頁\編于三點牛頓－歐拉方程牛頓方程……面向平動歐拉方程……面向轉(zhuǎn)動

式中Jc物體轉(zhuǎn)動慣量

ω物體角速度

τ

力矩5/24/20236目前六頁\總數(shù)八十頁\編于三點6.2

拉格朗日動力學方法

用于保守系統(tǒng)的拉格朗日方程

在《分析力學》一書中Lagrange是用s個獨立變量來描述力學體系的運動，這是一組二階微分方程。通常把這一方程叫做Lagrange方程，其基本形式為

其中，是所研究力學體系的廣義坐標；是作用在此力學體系上的廣義力；

T

是系統(tǒng)總動能。分析力學注重的不是力和加速度，而是具有更廣泛意義的能量，擴大了坐標的概念。

5/24/20237目前七頁\總數(shù)八十頁\編于三點

用于非保守系統(tǒng)的拉格朗日方程

對于同時受到保守力和耗散力作用的、由n個關節(jié)部件組成的機械系統(tǒng)，其Lagrange方程應為

其中，為廣義坐標，表示為系統(tǒng)中的線位移或角位移的變量；為作用在系統(tǒng)上的廣義力；是系統(tǒng)總的動能、勢能和耗散能，分別為5/24/20238目前八頁\總數(shù)八十頁\編于三點

拉格朗日函數(shù)方法

對于具有外力作用的非保守機械系統(tǒng)，其拉格朗日動力學函數(shù)L可定義為式中T——系統(tǒng)總的動能；V——系統(tǒng)總的勢能

若操作機的執(zhí)行元件控制某個轉(zhuǎn)動變量θ時，則執(zhí)行元件的總力矩應為

若操作機的執(zhí)行元件控制某個移動變量r時，則施加在運動方向r上的力應為

5/24/20239目前九頁\總數(shù)八十頁\編于三點

拉格朗日方程的特點

它是以廣義坐標表達的任意完整系統(tǒng)的運動方程式，方程式的數(shù)目和系統(tǒng)的自由度數(shù)是一致的；理想約束反力不出現(xiàn)在方程組中，因此建立運動方程式時只需分析已知的主動力，而不必分析未知的約束反力；Lagrange方程是以能量觀點建立起來的運動方程式，為了列出系統(tǒng)的運動方程式，只需要從兩個方面去分析，一個是表征系統(tǒng)運動的動力學量—系統(tǒng)的動能和勢能，另一個是表征主動力作用的動力學量—廣義力。因此用Lagrange方程來求解系統(tǒng)的動力學方程可以大大簡化建模過程。

5/24/202310目前十頁\總數(shù)八十頁\編于三點5/24/2023目前十一頁\總數(shù)八十頁\編于三點5/24/2023目前十二頁\總數(shù)八十頁\編于三點5/24/2023目前十三頁\總數(shù)八十頁\編于三點5/24/2023目前十四頁\總數(shù)八十頁\編于三點5/24/2023目前十五頁\總數(shù)八十頁\編于三點5/24/2023目前十六頁\總數(shù)八十頁\編于三點5/24/2023目前十七頁\總數(shù)八十頁\編于三點例6.3

操作機的動力學分析

操作機的動力學模型操作機的物理學模型

加上負載的操作機

5/24/202318目前十八頁\總數(shù)八十頁\編于三點

建立拉格朗日函數(shù)

（1）求動能T

先對求

顯然

而于是由于根據(jù)動能的公式

5/24/202319目前十九頁\總數(shù)八十頁\編于三點再對求由于

且有則得總動能

5/24/202320目前二十頁\總數(shù)八十頁\編于三點（2）求勢能V

根據(jù)勢能的公式式中為垂直高度，則對于有

對于有

得總勢能

（3）求得拉格朗日函數(shù)L

5/24/202321目前二十一頁\總數(shù)八十頁\編于三點

廣義力的計算

（1）求力矩

繞轉(zhuǎn)動執(zhí)行元件施加的力矩

則式中第一項為慣性項，第二項為哥氏項，第三項為重力項。5/24/202322目前二十二頁\總數(shù)八十頁\編于三點（2）求移動力

則式中第一項為慣性項，第二項為向心項，第三項為重力項。

通過線運動執(zhí)行元件施加的直線力

5/24/202323目前二十三頁\總數(shù)八十頁\編于三點

應用實例分析

例6-1

已知：對于操作機

對于下面的三種工作情況，試估算力矩。（1）手臂水平，并伸至全長，靜止，（2）手臂水平，并伸至全長，以最大速率運動，（3）手臂水平，并伸至全長，承受最大轉(zhuǎn)動加速度，5/24/202324目前二十四頁\總數(shù)八十頁\編于三點解：（1）手臂水平，并伸至全長，靜止，由已知條件可得則有5/24/202325則目前二十五頁\總數(shù)八十頁\編于三點解：（2）手臂水平，并伸至全長，以最大速率運動，由已知條件可得則有5/24/202326則目前二十六頁\總數(shù)八十頁\編于三點解：（3）手臂水平，并伸至全長，承受最大轉(zhuǎn)動加速度，由已知條件可得則有5/24/202327則目前二十七頁\總數(shù)八十頁\編于三點結(jié)果分析：

(1)為重力項，通常它遠大于其它項；

(2)當時，即當手臂垂直時，，可見重力負載的變化很大；

(3)當很小時，包含的項趨于零；

(4)通常采用只包括重力項和慣性項的公式就可得到比較滿意的結(jié)果，即采用如下簡化公式

5/24/202328目前二十八頁\總數(shù)八十頁\編于三點5/24/2023例6-4：目前二十九頁\總數(shù)八十頁\編于三點5/24/2023目前三十頁\總數(shù)八十頁\編于三點5/24/2023目前三十一頁\總數(shù)八十頁\編于三點5/24/2023目前三十二頁\總數(shù)八十頁\編于三點5/24/2023目前三十三頁\總數(shù)八十頁\編于三點5/24/2023目前三十四頁\總數(shù)八十頁\編于三點5/24/2023目前三十五頁\總數(shù)八十頁\編于三點5/24/2023目前三十六頁\總數(shù)八十頁\編于三點5/24/2023目前三十七頁\總數(shù)八十頁\編于三點5/24/2023目前三十八頁\總數(shù)八十頁\編于三點5/24/2023目前三十九頁\總數(shù)八十頁\編于三點5/24/2023目前四十頁\總數(shù)八十頁\編于三點5/24/2023目前四十一頁\總數(shù)八十頁\編于三點5/24/2023目前四十二頁\總數(shù)八十頁\編于三點5/24/2023目前四十三頁\總數(shù)八十頁\編于三點5/24/2023目前四十四頁\總數(shù)八十頁\編于三點5/24/2023把前面公式進行概況，有：目前四十五頁\總數(shù)八十頁\編于三點5/24/2023目前四十六頁\總數(shù)八十頁\編于三點6.5

倒立擺系統(tǒng)的動力學分析

rθ○○導軌小車

擺體驅(qū)動放大器計算機位角檢測倒立擺系統(tǒng)結(jié)構(gòu)圖

5/24/202347目前四十七頁\總數(shù)八十頁\編于三點二級倒立擺系統(tǒng)平衡控制5/24/202348目前四十八頁\總數(shù)八十頁\編于三點除皮帶外，全部對象（擺體、小車、導軌等）均視為剛體；各部分的摩擦力（力矩）與相對速度（角速度）成正比；施加在小車上的驅(qū)動力與加在功率放大器上的輸入電壓u成正比，比例系數(shù)設為G0；皮帶輪與傳送帶之間無滑動，傳送帶無伸長現(xiàn)象；信號與力的傳遞無延時。

倒立擺系統(tǒng)與基本假設

5/24/202349目前四十九頁\總數(shù)八十頁\編于三點

首先介紹一下均勻桿（長度為2L，質(zhì)量為m）轉(zhuǎn)動慣量的計算。

當均勻桿繞一端轉(zhuǎn)動時，其轉(zhuǎn)動慣量為：

由得通常給出桿相對質(zhì)心的轉(zhuǎn)動慣量：

所以5/24/202350目前五十頁\總數(shù)八十頁\編于三點

用牛頓力學的方法來建立動力學模型

（1）小車部分

小車質(zhì)量

小車滑動摩擦系數(shù)擺體對小車作用力的水平分量

擺體對小車作用力的垂直分量N

軌道反力m0rF&0or(X)uG05/24/202351目前五十一頁\總數(shù)八十頁\編于三點考慮到小車只有水平方向（X）的運動，故可列寫小車運動方程m0rF&0or(X)uG05/24/202352目前五十二頁\總數(shù)八十頁\編于三點（2）擺體部分

L2

m1

擺體質(zhì)量

L

擺體質(zhì)心c到支點距離

F1

擺體轉(zhuǎn)動摩擦系數(shù)

J1c擺體繞質(zhì)心轉(zhuǎn)動慣量

J1擺體繞支點的轉(zhuǎn)動慣量小車對擺體作用力的水平分量小車對擺體作用力的垂直分量

考慮到擺體為一平面運動體，則其運動可以分解為平動和繞質(zhì)心轉(zhuǎn)動兩部分。于是有質(zhì)心加速度＝質(zhì)心平動加速度＋繞質(zhì)心轉(zhuǎn)動加速度5/24/202353目前五十三頁\總數(shù)八十頁\編于三點計算質(zhì)心加速度水平分量為：

垂直分量為：

列寫擺體動力學方程式（平動部分）

L25/24/202354目前五十四頁\總數(shù)八十頁\編于三點列寫擺體動力學方程式

（轉(zhuǎn)動部分）代入，整理可得L25/24/202355目前五十五頁\總數(shù)八十頁\編于三點考慮到

將代入小車方程（1），可得列寫擺體動力學方程式

（轉(zhuǎn)動部分）5/24/202356目前五十六頁\總數(shù)八十頁\編于三點二方程聯(lián)立，可得矩陣形式對應于機器人動力學一般形式慣性項向心項哥氏項重力項廣義力5/24/202357目前五十七頁\總數(shù)八十頁\編于三點

用拉格朗日方程法建立動力學模型

應用非保守系統(tǒng)的拉格朗日方程，則小車和擺體的動能、勢能和耗散能分別為：

5/24/202358L2目前五十八頁\總數(shù)八十頁\編于三點當時，當時，于是有應用非保守機械系統(tǒng)的拉格朗日方程公式

5/24/202359目前五十九頁\總數(shù)八十頁\編于三點當時，即對小車而言5/24/202360目前六十頁\總數(shù)八十頁\編于三點當時，即對擺體而言5/24/202361目前六十一頁\總數(shù)八十頁\編于三點于是可以得到與相同的結(jié)果。

得到單級倒立擺的動力學方程為當考慮在不穩(wěn)定平衡點附近的線性化時，可令于是可得簡化動力學方程5/24/202362目前六十二頁\總數(shù)八十頁\編于三點

用拉格朗日函數(shù)法建立動力學模型

本節(jié)應用拉格朗日函數(shù)，也可以求解這一問題。

建立Lagrange函數(shù)

L=T–V

小車部分擺體部分則5/24/202363目前六十三頁\總數(shù)八十頁\編于三點對于小車（r）而言（見節(jié)）右式：左式：得第一個方程5/24/202364目前六十四頁\總數(shù)八十頁\編于三點對于擺（θ）而言

得第二個方程寫成矩陣形式，便得到與前兩種方法基本一樣的結(jié)果。右式：左式＝5/24/202365目前六十五頁\總數(shù)八十頁\編于三點平衡點附近簡化形式三種算法結(jié)果對比6.4.2

應用牛頓方程推導，寫成矢量形式得

6.4.3應用非保守機械系統(tǒng)的拉格朗日方程公式

6.4.4應用拉格朗日函數(shù)法求解5/24/202366目前六十六頁\總數(shù)八十頁\編于三點差異來自以下兩點1轉(zhuǎn)動慣量參考點的差異當均勻桿繞一端轉(zhuǎn)動時，其轉(zhuǎn)動慣量為：通常給出桿相對質(zhì)心的轉(zhuǎn)動慣量：所以2近似線性化過程（當很小時）5/24/202367目前六十七頁\總數(shù)八十頁\編于三點5/24/20236.6

機器人動力學方程的一般形式目前六十八頁\總數(shù)八十頁\編于三點5/24/2023目前六十九頁\總數(shù)八十頁\編于三點5/24/2023目前七十頁\總數(shù)八十頁\編于三點5/24/2023目前七十一頁\總數(shù)八十頁\編于三點5/24/2023目前七十二頁\總數(shù)八十頁\編于三點5/24/2023目前七十三頁\總數(shù)八十頁\編于三點5/24/2023目前七十四頁\總數(shù)八十頁\編于三點5/24/2023目前七十五頁\總數(shù)八十頁\編于三點6.7考慮非剛體效應的動力學方程需要指出的是，前面推導的動力學方程不能包含全部作用于操作臂上的力，只是包含了剛體力學中的那些力，而沒有包含摩擦力。然而，摩擦力也是一種非常重要的力，所有機構(gòu)都必然受到摩擦力的影響。在目前機器人的傳動機構(gòu)中，例如被普遍采用的齒輪傳動機構(gòu)中，由于摩擦力產(chǎn)生的力是相當大的，即在典型工況下大約為操作臂驅(qū)動力矩的25％左右。5/24/202376目前七十六頁\總數(shù)八十頁\編于三點

為了使動力學方程能夠反映實際的工況，建立機器人的摩擦力模型是非常必要的。其中，最簡單的摩擦力模型就是粘性摩擦，摩擦力矩與