3-RRR+(S-P)人形機器人仿生肩關節(jié)主參數(shù)設計及其工作空間分析

楊 龍 褚宏鵬 孫通帥 邱雪松 周玉林

燕山大學機械工程學院，秦皇島，066004

3-RRR+(S-P)人形機器人仿生肩關節(jié)主參數(shù)設計及其工作空間分析

楊 龍 褚宏鵬 孫通帥 邱雪松 周玉林

燕山大學機械工程學院，秦皇島，066004

通過實驗測量得到人體肩關節(jié)的運動空間。依據(jù)結(jié)構仿生原則，對比人體肱骨結(jié)構參數(shù)，將3-RRR+(S-P)人形機器人仿生肩關節(jié)的輸出偏置角定為45°，并通過坐標變換得到其安全工作空間。依據(jù)空間一致性原則，對比人體肩關節(jié)的運動空間，確定仿生肩關節(jié)定平臺在“人體”中的安裝位姿角，使仿生肩關節(jié)相對于“人體”的安全工作空間與人體肩關節(jié)運動空間的中心位置(對稱軸線)重合，從而設計完成3-RRR+(S-P)人形機器人仿生肩關節(jié)。最后，建立3-RRR+(S-P)人形機器人仿生肩關節(jié)與人體肩關節(jié)的空間映射關系。

仿生肩關節(jié)；主參數(shù)設計；結(jié)構仿生；空間一致性

0 引言

目前，仿生機器人研究主要集中在模型設計、材料工程和力學工程等方向。BI等[1]研究了一種矩形水翼沿翼展方向的靈活性對推力產(chǎn)生和推進效率的影響規(guī)律。姜銘等[2]分別運用并聯(lián)雙自由度轉(zhuǎn)動機構和單自由度轉(zhuǎn)動機構設計機器狗的各關節(jié)，并構造出24個自由度的混聯(lián)機器狗。ZHOU等[3]提出了一種機器魚自由游泳的運動模型和基于波動推進模型的神經(jīng)網(wǎng)絡偏航控制方法。MENON等[4]設計出2種模仿壁虎步態(tài)的爬壁機器人。GUO等[5]仿照尺蠖，設計了一種具有離子聚合物金屬復合驅(qū)動器的仿生運動樣機。

在人形機器人領域，機器人機械本體設計受到研究者的廣泛關注。BOUOUDEN等[6]提出了一種控制雙足機器人行走的控制器設計策略。CHIANG等[7]提出了利用擬人骨盆設計人形機器人本體的思想。CHENG等[8]設計了一種包括3個轉(zhuǎn)動和1個移動的四自由度并聯(lián)髖關節(jié)模擬器，并利用四元數(shù)法對其運動學進行了分析。ZHANG等[9]設計了一種仿生并聯(lián)機構，并研究了其運動學正解、性能圖譜并進行了多功能優(yōu)化。WANG等[10]提出了一種由6個氣動人工肌肉驅(qū)動的人形機器人眼，并對其進行了運動學分析。劉辛軍等[11]設計出一種串并聯(lián)結(jié)構的擬人七自由度冗余手臂。

在人形機器人機械本體中，肩關節(jié)是非常重要的組成部分。STANISIC等[12]提出了一種復制人體肩關節(jié)抓取動作的混聯(lián)機構。洪熠等[13]設計了一種將氣動人工肌肉作為驅(qū)動器的仿人肩關節(jié)實驗裝置。金振林等[14]基于新型正交布置的3RRR球面并聯(lián)機構，設計了一種具有結(jié)構緊湊、解耦性好的人形機器人肩關節(jié)。IKEMOTO等[15]提出了能夠分別實現(xiàn)人體盂肱關節(jié)、肩胸關節(jié)運動功能的機構。

在人體各個關節(jié)中，肩關節(jié)具有最大的運動空間，現(xiàn)有仿生肩關節(jié)的工作空間難以滿足人體肩關節(jié)的運動空間要求。因此,本文使用Xsens MVN慣性運動捕捉系統(tǒng)測量人體肩關節(jié)的運動范圍；依據(jù)結(jié)構仿生設計原則，確定3-RRR+(S-P)仿生肩關節(jié)的輸出偏置角；根據(jù)空間一致性原則，對比人體肩關節(jié)運動空間，確定3-RRR+(S-P)仿生肩關節(jié)的安裝位姿角，完成主參數(shù)設計。最后，根據(jù)坐標變換原則，建立仿生肩關節(jié)與人體肩關節(jié)的工作空間映射關系。

1 人體肩關節(jié)的運動空間

1.1 人體肩關節(jié)的參考坐標系

人體解剖學的3個典型參考平面為：矢狀面(將人體分為左右兩部分)、冠狀面(將人體分為前后兩部分)、橫切面(將人體分為上下兩部分)，如圖1所示。依據(jù)人體參考平面，分別建立人體坐標系{W}、肩胛骨坐標系{J}、肱骨坐標系{G}。

圖1 人體參考平面與坐標系Fig.1 Reference plane of human and coordinate system

人體坐標系{W}如圖1所示，ZW軸為橫切面與矢狀面的交線，YW軸為橫切面與冠狀面的交線，XW軸為冠狀面與矢狀面的交線，坐標系原點OW為三平面交點。

圖2 肩胛骨坐標系{J}和肱骨坐標系{G}Fig.2 Scapula coordinate system {J} and humeral coordinate system {G}

肩胛骨坐標系{J}與肩胛骨固連，如圖2所示，坐標原點OJ為肩胛骨關節(jié)盂的球心點，XJ軸、YJ軸、ZJ軸分別與XW軸、YW軸、ZW軸平行且正向相同。

肱骨坐標系{G}與肱骨固連，如圖2所示，坐標原點OG為肱骨頭的球心點，XG軸為肱骨頭球心點指向肘關節(jié)軸線的垂線；在初始位置(大臂豎直上舉)時，坐標系{G}與坐標系{J}正向重合。

1.2 人體肩關節(jié)運動的歐拉角表示法

在生物力學中，三自由度關節(jié)的運動由互相垂直的2個擺動和繞自身軸線的轉(zhuǎn)動組成。為了與生物力學的描述相對應，提出人體肩關節(jié)運動的X-Z-X歐拉角表示法。

如圖3所示，肱骨坐標系{G}的初始方位與肩胛骨坐標系{J}重合，首先將肱骨坐標系{G}繞XG軸轉(zhuǎn)α角，再繞ZG轉(zhuǎn)β角，最后繞XG軸轉(zhuǎn)γ角。相應的旋轉(zhuǎn)矩陣為

(1)

Ci=cosiSi=sinii=α，β，γ

圖3 X-Z-X歐拉角表示法Fig.3 Representation of Euler angle X-Z-X

假設肱骨長度為1，則肱骨末端點G在肩胛骨坐標系{J}中的坐標為

(2)

1.3 人體肩關節(jié)的運動空間

使用XsensMVN慣性運動捕捉系統(tǒng)測量人體肩關節(jié)的運動范圍，實驗環(huán)境為常溫，無強磁干擾。實驗對象為10名男性(編號：01～10)和10名女性(編號：11～20)，男性實驗對象身高為(1.710±0.030)m，體重為(68.0±2.5)kg，女性實驗對象身高為(1.572±0.028)m，體重為(45.0±2.1)kg。

測量的初始位置為肱骨豎直上舉，對應的歐拉角α=β=0，分兩個步驟對肱骨的擺動范圍進行測量。

第一步，測量大臂在人體冠狀面內(nèi)的最大擺動角度，即α=0時，β的最大值βmax。分析20名實驗對象的測量數(shù)據(jù)，得到βmax的平均值180°。

第二步，當大臂在人體冠狀面內(nèi)擺動到一定位置時，測量大臂在人體橫切面內(nèi)的擺動范圍，即當歐拉角β從0°開始，測量步長為10°時的歐拉角α的最小值αmin和最大值αmax。

分析數(shù)據(jù)(過程省略)，得到如下插值函數(shù)：

(3)

根據(jù)式(2)、式(3)，得到人體肩關節(jié)的運動空間，如圖4所示。

圖4 人體肩關節(jié)的運動空間Fig.4 Motion space of human shoulder

2 3-RRR+(S-P)仿生肩關節(jié)的輸出偏置角

3-RRR+(S-P)仿生肩關節(jié)的原型機構為偏置輸出的3-RRR+(S-P)仿生關節(jié)機構[16]，如圖5所示，上下平臺鉸鏈點分別位于等邊三角形頂點上，α1=α2=90°，β1=60°，β2=45°，X11、X12、X13為過球心的3條轉(zhuǎn)動副軸線。偏置輸出桿的末端點P與球心的連線OP是實際輸出桿軸線，它與直輸出桿軸線的夾角稱為輸出偏置角φ。

圖5 偏置輸出的3-RRR+(S-P)仿生關節(jié)機構Fig.5 Bias output of bionic joint mechanism 3-RRR+{S-P}

人體肱骨屬于典型的偏置輸出桿，如圖6所示，肱骨頸為直輸出桿OP0，肱骨體為偏折輸出桿P0P，肱骨頭球心到肘關節(jié)軸線的垂線為實際輸出桿OP，OP0與P0P的夾角為偏擺角θ，OP0與OP的夾角為輸出偏置角φ：

(4)

圖6 人體肱骨結(jié)構示意圖Fig.6 Diagram of human humeral structure

由人體解剖學，成年男子(身高1.7 m)的肱骨尺寸：OP=320 mm，OP0=60 mm，40°≤θ≤50°，將此尺寸帶入式(2)，得到41.15°≤φ≤47.15°。所以，依據(jù)仿生設計原則，將3-RRR+(S-P)仿生肩關節(jié)的輸出偏置角定為45°。

3 3-RRR+(S-P)仿生肩關節(jié)的安全工作

空間

如圖5所示，取機構的中心點O為坐標原點，建立固定坐標系{C}即OXCYCZC、動坐標系{D}即OXDYDZD和偏置坐標系{P}即OXPYPZP。其中，固定坐標系與支撐桿固連，XC軸與支撐桿軸線重合，正向向上，ZC軸由XC軸、X11軸及右手螺旋法則確定，YC軸由右手螺旋法則確定；動坐標系與輸出桿固聯(lián)，XD軸與直輸出桿軸線重合，正向指向外，ZD軸由XD軸、X13軸及右手螺旋法則確定，YD軸由右手螺旋法確定；偏置坐標系與輸出桿固連，輸出桿和偏置輸出桿所構成的平面與OXDZD面重合，取OP為XP軸，正向向外，ZP軸與ZD軸正向重合，YP軸由右手螺旋法則確定。

用RPY角描述動坐標系{D}相對于固定坐標系{C}的方位。動坐標系{D}的初始方位與固定坐標系{C}重合，將動坐標系{D}依次繞XC軸、YC軸、ZC軸轉(zhuǎn)φX角、φY角、φZ角，則相應的旋轉(zhuǎn)矩陣為

(5)

Cj=cosjSj=sinjj=φX，φY，φZ

偏置坐標系{P}相對于動坐標系{D}的旋轉(zhuǎn)矩陣為

(6)

所以，偏置坐標系{P}相對于固定坐標系{C}的旋轉(zhuǎn)矩陣為

(7)

p11=CφYCφZCφ+(SφXSφYCφZ-CφXSφZ)Sφ

p21=CφYSφZCφ+(SφXSφYSφZ+CφXCφZ)Sφ

p31=-SφYCφ+SφXCφYSφ

p12=-CφYCφZSφ+(SφXSφYCφZ-CφXSφZ)Cφ

p22=-CφYSφZSφ+(SφXSφYSφZ+CφXCφZ)Cφ

p32=SφYSφ+SφXCφYCφ

p13=CφXSφYCφZ+SφXSφZ

p23=CφXSφYSφZ-SφXCφZ

p33=CφXCφY

假設|OP|=1，則仿生肩關節(jié)的輸出末端點P在固定坐標系{C}中的坐標為

(8)

3-RRR球面并聯(lián)機構的安全工作空間[14]用RPY角表示為：φX∈(-90°，90°)，φY∈(-63°，63°)，φZ∈(-63°，63°)。再根據(jù)式(7)、式(8)，得到3-RRR+(S-P)仿生肩關節(jié)的安全工作空間，如圖7所示。

圖7 3-RRR+(S-P)仿生肩關節(jié)的安全工作空間Fig.7 Safe working space of bionic shoulder joint 3-RRR+{S-P}

4 3-RRR+(S-P)仿生肩關節(jié)的安裝位姿角

依據(jù)工作空間一致性原則，對比人體肩關節(jié)運動空間，確定3-RRR+(S-P)仿生肩關節(jié)定平臺在“人體”中的安裝位姿，使3-RRR+(S-P)仿生肩關節(jié)相對于肩胛骨坐標系的安全工作空間與人體肩關節(jié)運動空間的中心位置(對稱軸線)重合。

仿生肩關節(jié)的安裝位姿角：固定坐標系{C}的初始方位與肩胛骨坐標系{J}重合，然后依次繞YJ軸、XJ軸、ZJ軸轉(zhuǎn)動的φY角、φX角、φZ角。

4.1 仿生肩關節(jié)的初始安裝位姿角

觀察發(fā)現(xiàn)，仿生肩關節(jié)的安全工作空間關于zC=0平面對稱，而人體肩關節(jié)的運動空間關于xJ=0平面對稱，將初始安裝位姿角定為

(9)

此時，仿生肩關節(jié)的輸出末端點P在肩胛骨坐標系{J}中的坐標為

(10)

根據(jù)式(8)、式(10)，得到仿生肩關節(jié)相對于肩胛骨坐標系{J}的安全工作空間，如圖8所示。

圖8 仿生肩關節(jié)相對于{J}的安全工作空間Fig.8 Safe working space of bionic shoulder joint relative to {J}

此時，仿生肩關節(jié)相對于肩胛骨坐標系{J}的安全工作空間、人體肩關節(jié)的工作空間均關于xJ=0平面對稱，兩個工作空間yJ-zJ方向的視圖，分別見圖9、圖10。

圖9 仿生肩關節(jié)安全工作空間的yJ-zJ方向視圖Fig.9 yJ-zJ direction view of safe working space of bionic shoulder joint

圖10 人體肩關節(jié)運動空間的yJ-zJ方向視圖Fig.10 yJ-zJ direction view of human shoulder joint movement space

4.2 仿生肩關節(jié)的最終安裝位姿角

根據(jù)兩個工作空間的yJ-zJ方向視圖，在初始安裝位姿的基礎上，將仿生肩關節(jié)的固定坐標系{C}繞肩胛骨坐標系{J}的XJ軸轉(zhuǎn)-25°，最終安裝位姿角為

(11)

此時，仿生肩關節(jié)的輸出末端點P在肩胛骨坐標系{J}中的坐標為

(12)

根據(jù)式(8)、式(12)，得到仿生肩關節(jié)相對于肩胛骨坐標系{J}的安全工作空間和人體肩關節(jié)運動空間的對比關系，如圖11所示。

圖11 仿生肩關節(jié)的安全工作空間與人體肩關節(jié)的 運動空間Fig.11 Safe working space of bionic shoulder joint and human shoulder joint movement space

完成3-RRR+(S-P)仿生肩關節(jié)的兩個主參數(shù)設計后，3-RRR+(S-P)人形機器人仿生肩關節(jié)如圖12所示。

圖12 3-RRR+(S-P)人形機器人仿生肩關節(jié)Fig.12 Bionic shoulder joint of 3-RRR+{S-P} humanoid robot

5 3-RRR+(S-P)仿生肩關節(jié)與人體肩關節(jié)的工作空間映射關系

5.1 人體肩關節(jié)相對于固定坐標系的運動空間

肱骨坐標系{G}的方位由X-Z-X歐拉角(α、β和γ)決定，此時，肱骨坐標系{G}相對于肩胛骨坐標系{J}的旋轉(zhuǎn)矩陣為

(13)

肩胛骨坐標系{J}相對于固定坐標系{C}的旋轉(zhuǎn)矩陣為

(14)

所以，肱骨坐標系{G}相對于固定坐標系{C}的旋轉(zhuǎn)矩陣為

(15)

r11=0.423cosαsinβ+0.906sinαsinβ

r21=0.906cosαsinβ-0.423sinαsinβ

r31=-cosβ

r12=0.423(cosαcosβcosγ-sinαsinγ)+ 0.906(sinαcosβcosγ+cosαsinγ)

r22=0.906(cosαcosβcosγ-sinαsinγ)- 0.423(sinαcosβcosγ+cosαsinγ)

r32=sinβcosγ

r13=-0.423(cosαcosβsinγ+sinαcosγ)- 0.906(sinαcosβsinγ-cosαcosγ)

r23=-0.906(cosαcosβsinγ+sinαcosγ)+ 0.423(sinαcosβsinγ-cosαcosγ)

r33=-sinβsinγ

5.2 3-RRR+(S-P)人形機器人仿生肩關節(jié)工作空間

偏置坐標系{P}的方位由動坐標系{D}的RPY角(φX、φY、φZ)決定，此時，動坐標系{D}相對于固定坐標系{C}的旋轉(zhuǎn)矩陣為

(16)

偏置坐標系{P}相對于動坐標系{D}的旋轉(zhuǎn)矩陣為

(17)

所以，偏置坐標系{P}相對于固定坐標系{C}的旋轉(zhuǎn)矩陣為

(18)

5.3 工作空間映射關系

(19)

A=0.906cosαsinβ-0.423sinαsinβ-

0.906(cosαcosβcosγ-sinαsinγ)+

0.423(sinαcosβcosγ+cosαsinγ)

式(19)表達了3-RRR+(S-P)人形機器人仿生肩關節(jié)與人體肩關節(jié)的工作空間映射關系。

6 結(jié)語

通過實驗測量和數(shù)據(jù)分析，得到了人體肩關節(jié)的運動空間；依據(jù)結(jié)構仿生設計原則和空間一致性原則，確定了3-RRR+(S-P)仿生肩關節(jié)的2個主參數(shù)，即輸出偏置角和安裝位姿角，完成了3-RRR+(S-P)仿生肩關節(jié)的主參數(shù)設計；得到了仿生肩關節(jié)和人體肩關節(jié)的工作空間映射關系。

[1] BI Shusheng, CAI Yueri. Effect of Spanwise Flexibility on Propulsion Performance of a Flapping Hydrofoil at Low Reynolds Number[J]. Chinese Journal of Mechanical Engineering,2012,25(1):12-19.

[2] 姜銘,李鷺揚. 混聯(lián)仿生機器狗構型研究[J]. 機械工程學報,2012,48(1):19-14. JIANG Ming, LI Luyang. Mechanism Architecture of Hybrid Serial-parallel Robot Dog[J]. Journal of Mechanical Engineering,2012,48(1):19-24.

[3] ZHOU Chao, HOU Zengguang, CAO Zhiqiang, et al. Motion Modeling and Neural Networks Based Yaw Control of a Biomimetic Robotic Fish[J]. Information Sciences,2013,237:39-48.

[4] MENON C, SITTI M. A Biomimetic Climbing Robot Based on the Gecko[J]. Journal of Bionic Engineering,2006,3(3):115-125.

[5] GUO Shuxiang, SHI Liwei, XIAO Nan, et al. A Biomimetic Underwater Microrobot with Multifunctional Locomotion[J]. Robotics and Autonomous Systems,2012,60(12):1472-1483.

[6] BOUOUDEN S, ABDESSEMED F. Walking Control for a Planar Biped Robot Using 0-flat Normal Form[J]. Robotics and Rutonomous Systems,2014,62(1):68-80.

[7] CHIANG M H, CHANG F R. Anthropomorphic Design of the Human-like Walking Robot[J]. Journal of Bionic Engineering,2013,10(2):186-193.

[8] CHENG Gang, YU Jingli, GU Wei. Kinematic Analysis of 3SPS1PS Bionic Parallel Test Platform for Hip Joint Simulator Based on Unit Quaternion[J]. Robotics and Computer-integrated Manufacturing,2012,28(2):257-264.

[9] ZHANG Dan, GAO Zhen. Forward Kinematics, Performance Analysis, and Multi-objective Optimization of a Bioinspired Parallel Manipulator[J]. Robotics and Computer-integrated Manufacturing,2012,28(4):484-492.

[10] WANG Xuanyin, ZHANG Yang, FU Xiaojie, et al. Design and Kinematic Analysis of a Novel Humanoid Robot Eye Using Pneumatic Artificial Muscles[J]. Journal of Bionic Engineering,2008,5(3):264-270.

[11] 劉辛軍,汪勁松,高峰,等. 一種串并聯(lián)結(jié)構擬人七自由度冗余手臂的設計[J]. 中國機械工程, 2002, 13(2): 101-105. LIU Xinjun, WANG Jinsong, GAO Feng, et al. Design of a Serial-parallel 7-DOF Redundant Anthropomorphic Arm[J]. China Mechanical Engineering,2002,13(2):101-105.

[12] STANISIC M M, GOEHLER C M. Reproducing Human Arm Motion Using a Kinematically Coupled Humanoid Shoulder-elbow Complex[J]. Applied Bionics and Biomechanics,2008,5(4):175-185.

[13] 洪熠,施光林. 基于氣動肌肉仿人肩關節(jié)的運動控制[J]. 機械與電子,2009(4):62-65. HONG Yi, SHI Guanglin.Design of a Bionics Shoulder Joint Driven by Pneumatic Muscle Actuators[J]. Machinery & Electronics,2009(4):62-65.

[14] 金振林,曹舜,高峰. 新型機器人肩關節(jié)及其運動學分析[J]. 中國機械工程,2009,20(14):1639-1642. JIN Zhenlin, CAO Shun, GAO Feng. Design and Kinematics Analysis of a Novel Robot Shoulder Joint[J]. China Mechanical Engineering,2009,20(14):1639-1642.

[15] IKEMOTO S, KANNOU F, HOSODA K. HumanlikeShoulder Complex for Musculoskeletal Robot Arms[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Vilamoura, Portugal,2012:4892-4897.

[16] 楊龍, 邱雪松, 侯雨雷, 等. 偏置輸出的3-RRR+(S-P)仿生關節(jié)機構設計與工作空間分析[J].農(nóng)業(yè)機械學報，2015,46(3):366-371. YANG Long, QIU Xuesong, HOU Yulei, et al. Structure Design and Workspace Analysis of a Novel 3-RRR+(S-P) Bionic Joint Mechanism with Offset Output[J]. Transactions of the Chinese Society for Agricultural Machinery,2015,46(3):366-371.

(編輯 張 洋)

Main Parameter Design and Workspace Analysis of a Novel 3-RRR+(S-P) Humanoid Robotic Bionic Shoulder

YANG Long CHU Hongpeng SUN Tongshuai QIU Xuesong ZHOU Yulin

School of Mechanical Engineering, Yanshan University, Qinhuangdao, Hebei, 066004

The moving spaces of human shoulder were obtained by experiments. Based on the principles of structural bionic, the output offset angles of 3-RRR+(S-P) humanoid robotic bionic shoulder were designed as 45° referring to the structure of humerus. And then, the secure workspaces of the bionic shoulder were obtained by coordinate transformation. Based on the principles of space consistency, the installation orientations of the bionic shoulder relative to “human body” were determined referring to the moving spaces of human shoulder. The center positions(symmetry axes) of the secure workspaces of the bionic shoulder relative to “human body” and the moving spaces of human shoulder were coincident. Thereby, the 3-RRR+(S-P) humanoid robotic bionic shoulder was proposed. Finally, the workspace mapping relation between 3-RRR+(S-P) humanoid robotic bionic shoulder and human shoulder was obtained.

bionic shoulder；main parameter design；structural bionic；space consistency

2016-01-03

國家自然科學基金資助項目(51275443,51305384)

TP24

10.3969/j.issn.1004-132X.2017.02.012

楊 龍，男，1988年生。燕山大學機械工程學院博士研究生。主要研究方向為人形機器人及仿生學。發(fā)表論文5篇。褚宏鵬，男，1990年生。燕山大學機械工程學院碩士研究生。孫通帥，男，1991年生。燕山大學機械工程學院碩士研究生。邱雪松，女，1973年生。燕山大學機械工程學院副教授。周玉林(通信作者)，男，1961年生。燕山大學機械工程學院教授、博士研究生導師。E-mail:zyl@ysu.edu.cn。