+ All Categories
Home > Documents > Analysis of Bracing-Constraint Dynamics with Energy-efficient … · 2016-08-30 · Analysis of...

Analysis of Bracing-Constraint Dynamics with Energy-efficient … · 2016-08-30 · Analysis of...

Date post: 15-Jun-2018
Category:
Upload: lamthuy
View: 217 times
Download: 0 times
Share this document with a friend
7
Analysis of Bracing-Constraint Dynamics with Energy-efficient for Elbow-bracing Manipulator X. Li 1 M. Minami 1 H. Han 2 and Y. Wei 2 (1 Okayama University 2 Harbin Engineering University) Abstract– The configuration of elbow-bracing is built by imitating human’s handwriting behavior that human can do accurate task with less consumption energy by bracing the elbow or hand on the task. In this paper, first, the motion equation of the elbow-bracing manipulator under constrained condition has been derived. Second, as the consumption energy is calculated based on the voltage and current of the motor, the equation of motion of the motor has been proposed. Then, a control method based on the constraint dynamics of the elbow-bracing manipulator is proposed to simultaneously control constraint force and hand’s trajectory and elbow-bracing position in work space. Moreover, we focus on the energy-efficient of the elbow-bracing manipulator, and analysis the factors which have a great effect on the consumption energy, i.e. elbow-bracing position, constraint force. Finally, a simulation experiment for 5-link elbow-bracing manipulator tracking spatial trajectory has been conducted which reveals the effectiveness of energy-efficiecy and high accuracy for the elbow-bracing manipulator and presents the ralationship of the above two factors to the energy-efficiency. Key Words: Elbow-bracing manipulator; Constraint dynamics; constraint force control ; Energy-efficient 1 Introduction Humans can write characters accurately on a paper with less power by bracing and restricting the wrist, as shown in Fig.1. Moreover, this bracing strategy may overcome the hindrances of hyper-redundant manip- ulators being too heavy to spare the hand payload for desired tasks. Fig. 1: Human’s writing motion utilizing bracing wrist Roy and Whitcomb 1) categorized motions and control methods of constrained robot as (a) model based control 2) 3) that assume undeformable robots and deformable environments, and (b) methods based on position/velocity control 4) that assume unde- formable robots and also deformable environments. Park and Khatib 5) 6) proposed kinematics model of plural contact to control constraint motion in cate- gory (b). Finally, there is classification of (c) con- trol method 7) that assume undeformable robots and undeformable environments. Yamane and Nakamura proposed walking of humanoid robot 8) and a con- cept of dynamics filter 9) in this category. Effective- ness and accuracy of hyper-redundant manipulators subject to constraint on environments have been dis- cussed, West and Asada 10) proposed common con- tact mode of kinematics for designing position/force simultaneous controller of manipulator in constraint motion. In this paper, considering the control method of undeformable robots and undeformable environments. Under these conditions, algebraic equation can be de- rived from constraint condition and equation of mo- tion as (1). Af n = a (1) f n is constraint force, A, a and B are vector and matrices that will be defined in the next section, τ is a vector of input torques. Eq.(1) shows an algebraic relation between input torques and constraint force when robot’s hand is subject to constraint. The above equation has been derived by Hemami and Wyman 11) in discipline of biped walking, and applied by Peng and Adachi 12) in discipline of force/position control by robots at the beginning. Peng considered that τ is input and f n is output, and Eq.(1) was used as force sensor to detect f n . Despite the nature that the robot motions under a condition of (c) undeformable robot and undeformable environment be subject to the algebraic equation, Eq.(1), researches on robot force control in category (c) seems to be not based on the Eq.(1) except Peng as far as we know. In this paper, Eq.(1) is used for calculating input torque τ to accomplish desired constraint force f nd contrary to Peng’s idea. Considering the hand writing mo- tion, we know that too much pushing the wrist to table bears fatigue and meaningless, and also too less pushing makes us tired too. This suggests a hypothe- sis that appropriate supporting force exists, and also effective bracing position may exist. In the past of this research, the control of constraint motion has been applied to many robots. The grind- ing robot that has been researching by Minami and Adachi 13) , the hand of robot is constrainted to a changing surface to grinding a target object into de- sired shape with force-sensorless feed-forward control. And the bracing control also be used to a mobile robot with redundant manipulator and the bracing manip-
Transcript
Page 1: Analysis of Bracing-Constraint Dynamics with Energy-efficient … · 2016-08-30 · Analysis of Bracing-Constraint Dynamics with Energy-efficient for Elbow-bracing Manipulator ...

Analysis of Bracing-Constraint Dynamics withEnergy-efficient for Elbow-bracing Manipulator

X. Li1 M. Minami1 ∗H. Han2 and Y. Wei2

(1 Okayama University 2 Harbin Engineering University)

Abstract– The configuration of elbow-bracing is built by imitating human’s handwriting behavior thathuman can do accurate task with less consumption energy by bracing the elbow or hand on the task. In thispaper, first, the motion equation of the elbow-bracing manipulator under constrained condition has beenderived. Second, as the consumption energy is calculated based on the voltage and current of the motor, theequation of motion of the motor has been proposed. Then, a control method based on the constraint dynamicsof the elbow-bracing manipulator is proposed to simultaneously control constraint force and hand’s trajectoryand elbow-bracing position in work space. Moreover, we focus on the energy-efficient of the elbow-bracingmanipulator, and analysis the factors which have a great effect on the consumption energy, i.e. elbow-bracingposition, constraint force. Finally, a simulation experiment for 5-link elbow-bracing manipulator trackingspatial trajectory has been conducted which reveals the effectiveness of energy-efficiecy and high accuracy forthe elbow-bracing manipulator and presents the ralationship of the above two factors to the energy-efficiency.

Key Words: Elbow-bracing manipulator; Constraint dynamics; constraint force control ; Energy-efficient

1 Introduction

Humans can write characters accurately on a paperwith less power by bracing and restricting the wrist, asshown in Fig.1. Moreover, this bracing strategy mayovercome the hindrances of hyper-redundant manip-ulators being too heavy to spare the hand payload fordesired tasks.

Fig. 1: Human’s writing motion utilizing bracingwrist

Roy and Whitcomb 1) categorized motions andcontrol methods of constrained robot as (a) modelbased control 2) 3) that assume undeformable robotsand deformable environments, and (b) methods basedon position/velocity control 4) that assume unde-formable robots and also deformable environments.Park and Khatib 5) 6) proposed kinematics model ofplural contact to control constraint motion in cate-gory (b). Finally, there is classification of (c) con-trol method 7) that assume undeformable robots andundeformable environments. Yamane and Nakamuraproposed walking of humanoid robot 8) and a con-cept of dynamics filter 9) in this category. Effective-ness and accuracy of hyper-redundant manipulatorssubject to constraint on environments have been dis-cussed, West and Asada 10) proposed common con-tact mode of kinematics for designing position/forcesimultaneous controller of manipulator in constraintmotion.

In this paper, considering the control method ofundeformable robots and undeformable environments.

Under these conditions, algebraic equation can be de-rived from constraint condition and equation of mo-tion as (1).

Afn = a − Bτ (1)

fn is constraint force, A, a and B are vector andmatrices that will be defined in the next section, τ isa vector of input torques. Eq.(1) shows an algebraicrelation between input torques and constraint forcewhen robot’s hand is subject to constraint. The aboveequation has been derived by Hemami and Wyman 11)

in discipline of biped walking, and applied by Pengand Adachi 12) in discipline of force/position controlby robots at the beginning. Peng considered that τis input and fn is output, and Eq.(1) was used asforce sensor to detect fn. Despite the nature that therobot motions under a condition of (c) undeformablerobot and undeformable environment be subject tothe algebraic equation, Eq.(1), researches on robotforce control in category (c) seems to be not basedon the Eq.(1) except Peng as far as we know. In thispaper, Eq.(1) is used for calculating input torque τto accomplish desired constraint force fnd contraryto Peng’s idea. Considering the hand writing mo-tion, we know that too much pushing the wrist totable bears fatigue and meaningless, and also too lesspushing makes us tired too. This suggests a hypothe-sis that appropriate supporting force exists, and alsoeffective bracing position may exist.

In the past of this research, the control of constraintmotion has been applied to many robots. The grind-ing robot that has been researching by Minami andAdachi 13), the hand of robot is constrainted to achanging surface to grinding a target object into de-sired shape with force-sensorless feed-forward control.And the bracing control also be used to a mobile robotwith redundant manipulator and the bracing manip-

Page 2: Analysis of Bracing-Constraint Dynamics with Energy-efficient … · 2016-08-30 · Analysis of Bracing-Constraint Dynamics with Energy-efficient for Elbow-bracing Manipulator ...

ulator that have been researching by Washino andMinami 14), Kondo and Itoshima 15) to maintainingthe balance of the mobile robot or conserve energyof the redundant manipulator. Xiang Li, et al.16) de-rive the dynamical equation for humanoid robot usingExtended Newton-Euler and discuss its walking mod-els, such as slipping, bumping, surface-contacting andpoint-contacting of foot.

In this paper, we focus on the energy-efficient ofthe elbow-bracing manipulator through two factors,i.e. elbow-bracing position and constraint force. Insection 2, the motion equation of elbow-bracing ma-nipulator with constrained force and motor has beenderived. In section 3, PD controller has been usedto achieve the task for the elbow-bracing manipula-tor. In section 4, a simulation experiment for a 5-linkelbow-bracing manipulator has been conducted. Fi-nally, we give our conclusion.

2 Motion equation with constraintand motor for elbow-bracing manip-ulator

2.1 Constrained conditionAs shown in Fig.2, the intermediate links of an n-

link manipulator are contacted with the environmentat p points.

Fig. 2: Constrained model of the elbow-bracing ma-nipulator

The constraint function is expressed as,

C(r(q)) = [C1(r1(q)), C2(r2(q)), · · · , Cp(rp(q))]T

= 0 (2)

Here, q ∈ Rn is joint angle vector with n joints,ri ∈ Rm(m < n) is i-th link position that is subjectto constraint. The relation between ri and q and therelation between ri and q are expressed as,

ri = ri(q) (3)

ri = J i(q)q, J i(q) = [J i(q), 0] . (4)

In (4), J i is m × n matrix, J i consists of m × imatrix and zero submatrix 0 with m × (n − i).

In the formulation of constraint motion of robot,we consider that a plural intermediate links are con-tacting with the environment. In Fig.2, a general-ized surface can be defined with the position con-straints along the tangents to this surface and force

constraints along the normals. Then the unit vectorsof normals, jcci, which represent direction of con-straint forces, fn = [fn1, fn2 . . . fnp]

T , and the unitvectors of tangents, jtti, which represent direction offriction forces,f t = [ft1, ft2 . . . ftp]

T , are expressed as,

jcci =(

∂Ci

∂rT

)T

/

∥∥∥∥∂Ci

∂rT

∥∥∥∥ (5)

jtti =ri

‖ri‖(6)

2.2 Motion equation with constraintAs we known, the jacobian transpose maps Carte-

sian forces into equivalent joint torques. Then, wedefine that,

jTci = J i(q)Tjcci =

(∂Ci

∂qT

)T

/

∥∥∥∥∂Ci

∂rT

∥∥∥∥ (7)

jTti = J i(q)Tjtti =

(∂ri

∂qT

)Tri

‖ri‖(8)

JTc = [jT

c1, jTc2, · · · , jT

cp] (9)

JTt = [jT

t1, jTt2, · · · , jT

tp] (10)

JTc , JT

t are n × p matrices, and fn, f t are p × 1vectors. Using above definitions, equation of motionof the manipulator subject to constraints at p pointsis expressed as

M(q)q + h(q, q) + g(q) + Dq

= τ +p∑

i=1

(jTcifni) −

p∑

i=1

(jTtifti)

= τ + JTc fn − JT

t f t (11)

Differentiating (2) with respect to time t twice, con-straint condition of q is set up like

qT

[∂

∂q

(∂C

∂qT

)]q +

(∂C

∂qT

)q = 0 (12)

The solution of (11) that is q and q must satisfy (12)disregarding time t that the manipulator be alwayssubject to constraint. When the q satisfying (12) andthe q in (11) is equal to each other, the solution q(t)in (11) satisfies (2) regardless of time.

Here, the relation between constraint force fn andfriction force f t is shown in the following equationwith coefficients of sliding friction.

f t = Kfn, K = diag[K1,K2, · · · ,Kp] (13)

0 < Ki < 1, (i = 1, 2, · · · , p)

Therefore, Eq.(11) can be translated into the follow-ing equation.

Page 3: Analysis of Bracing-Constraint Dynamics with Energy-efficient … · 2016-08-30 · Analysis of Bracing-Constraint Dynamics with Energy-efficient for Elbow-bracing Manipulator ...

M(q)q + h(q, q) + g(q) + Dq

= τ + (JTc − JT

t K)fn (14)

In order to obtain the relationship between τ andfn, such as (1), we combine (12) and (14) to eliminateq. First, we define

M c , (∂C/∂qT)M−1(∂C/∂qT)T (15)

B ,∥∥∥∥

∂C

∂rT

∥∥∥∥(

∂C

∂qT

)M−1 (16)

a , B Dq + h + g −∥∥∥∥

∂C

∂rT

∥∥∥∥qT

[∂

∂q

(∂C

∂qT

)]q

(17)

A , M c − BJTt K (18)

Then,

qT

[∂

∂q

(∂C

∂qT

)]q +

(∂C

∂qT

)M−1(h (19)

+JTt Kfn + Dq + g − τ − JT

c fn) = 0

M cfn

=∥∥∥∥

∂C

∂rT

∥∥∥∥(

∂C

∂qT

)M−1(JT

t Kfn + Dq + h

+g − τ ) −∥∥∥∥

∂C

∂rT

∥∥∥∥qT

[∂

∂q

(∂C

∂qT

)]q

= BJTt Kfn − Bτ + a (20)

Finally, we can get (1). And we assume that Ais positive definite matrix. Therefore, fn can be ex-pressed as,

fn = A−1(a − Bτ ) (21)

2.3 Equation of MotorTo represent the motion of each motor, the follow-

ing symbols are used.vi is the voltage of the motor, v = [v1, v2, · · · , vl]T ;ii is the current of the motor, i = [i1, i2, · · · , il]T ;vgi is the back EMF of the motor;Ri is the resistance of the motor;Li is the inductance of the motor;θi is the rotational angle of the motor;τgi is the electromagnetic torque of the motor;τLi is the load torque of the motor;Imi is the inertia of the motor;KEi is the coefficient of the back EMF;KTi is the coefficient of the electromagnetic torque;dmi is the viscous friction coefficient of the reducer;ki is the reduction radio of the reducer;

As the DC motor is considered in this paper, the

coefficients, KEi and KTi are equal. And we assumethat

KTi = KEi = Ki (22)

The relationship between the parameters of the mo-tor can be expressed as the following equations

vi(t) = Liii + Riii(t) + vgi(t) (23)

vgi(t) = KEiθi(t) (24)

Imiθ = τgi(t) − τLi(t) − dmiθi (25)

τgi(t) = KTiii(t) (26)

As the reduction radio of the reducer is ki, the fol-lowing equations can be obtained.

θi = kiqi (27)

τLi =τi

ki(28)

Based on the above equations, we can obtain theequation of motor.

Lidiidt

= vi − Riii − Kikiqi (29)

τi = −Imik2i qi + Kikiii − dmik

2i qi (30)

The equation of motor can be rewritten in the formof vector, as shown in the following equations.

Ldi

dt= v − Ri − Kmq (31)

τ = −Jmq + Kmi − Dmq (32)

Where

R = diag[R1, R2, · · · , Rl],L = diag[L1, L2, · · · , Ll]

Km = diag[Km1,Km2, · · · ,Kml],Kmi = Kiki

Jm = diag[Jm1, Jm2, · · · , Jml], Jmi = Imik2i

Dm = diag[Dm1, Dm2, · · · , Dml], Dmi = dmik2i

The consumption energy can be expressed as thefollowing equation.

Ei(T ) =∫ T

0

vi(t)ii(t)dt (33)

2.4 Motion equation of manipulator includ-ing motor under constraint condition

By combining (12),(14) and (31), and substituting(32) into (14), we can obtain the motion equation ofmanipulator including motor under constraint condi-tion, as shown in the following equation.

M + Jm −(JTc − JT

t K) 0∂C∂qT 0 0

0 0 L

qfn

di/dt

=

Kmi − h − g − (D + Dm)q−qT

[∂∂q

(∂C∂qT

)]q

v − Ri − Kmq

(34)

Page 4: Analysis of Bracing-Constraint Dynamics with Energy-efficient … · 2016-08-30 · Analysis of Bracing-Constraint Dynamics with Energy-efficient for Elbow-bracing Manipulator ...

Fig. 3: Block diagram of control for 5-link elbow-bracing manipulator

3 Control method

Basede on (1), the control law of the torque τ forthe 4-link elbow-bracing manipulator is shown in thefollowing equation.

τ = B+(a − Afnd) (35)

Where, B+ is pseudo inverse matrix.Noticed that the direction in which the position vec-

tor are constrained are complementary to the direc-tion in which the constrained force is constrained. Bydividing the woke space into two orthogonal domains,a position domains and a force domain, which arecomplementary to the directions of the correspondingconstraints, in each of the two domains, position orforce can be controlled independently and arbitrarily.Therefore, in order to simultaneously control the con-straint force and position, the following equations canbe obtained.

τ = B+(a − Afnd) + (I − B+B)l . (36)

Where, rank(I − B+B) equals n − p. BecauseI − B+B is non-dimensional matrix, l has dimen-sions of torque. Considering l to be new input, l canbe used to track target trajectory of hand rd5 and con-trol bracing position through null-space I − B+B ofB+. By the nature of pseudo inverse matrix, addingany value to l has no influence on achieving fnd. So,the task of tracking trajectory and the task of achiev-ing fnd can be achieved in decoupled nature.

Here, a method to determine l is discussed. In the

simulation to utilize 5-link manipulator in this paper,one degree of freedom is used for force control of el-bow, one degree is for contacting position control ofelbow and three degrees are for three-dimensional po-sition control of hand.

l = jT

3y[Kp3y(yd3 − y3) + Kd3y(yd3 − y3)]

+ JT5 [Kp5(rd5 − r5) + Kd5(rd5 − r5)] (37)

Here, jT

3y is the first column vector that comprises

jT

3 defined in Eq.(4). Kp3y and Kd3y are control gainsof position and velocity in y axis direction of 2nd linkthat is shown in Fig.4, J5 is Jacobian matrix definedby Eq.(4) when i = 5, and Kp5 and Kd5 are controlgain matrices of position and velocity of fourth link.

Equation(36) can be realizable in the case thatrobots are driven by DD motors, but the input ofusual DC motor is driven by voltage input. In thispaper, the following equation that gives input voltagev to the DC motors is used instead of the controller of(36), where Kv is coefficient matrix to convert torqueinto voltage.

v = Kv

[B+(a − Afnd) + (I − B+B)l

](38)

The block diagram of the control method for 4-linkelbow-bracing manipulator is shown in Fig.3. Theoutput of the controller v is considered as the input ofthe motor which also includes joint angular velocity qand angular acceleration q that are the outputs of the

Page 5: Analysis of Bracing-Constraint Dynamics with Energy-efficient … · 2016-08-30 · Analysis of Bracing-Constraint Dynamics with Energy-efficient for Elbow-bracing Manipulator ...

manipulator. And the output of the motor is τ whichis the input of the 4-link elbow-bracing manipulator.As the second link of the manipulator is subject tothe constraint surface, the constraint force in normaldirection of the surface, which is made up of JT

c andfn, and the friction force in the tangent direction ofthe surface, which is made up of JT

t and Kfn areadded to the motion equation of the manipulator. Theformula to calculate the constraint force fn is givenby (21) which guarantee that the motion of the elbow-bracing manipulator satisfies the constraint conditionof (2), which is the merit of this paper.

In Fig.3, the definition of B, a and A are shown in(16), (17) and (18). B+, I −B+B are introduced inthe former section.

4 Simulation for 5-link elbow-bracingmanipulator

4.1 The model of 5-link elbow-bracing manip-ulator

The model of 5 links manipulator shown in Fig. 4.

x

y

z

w

w

w

5

4

q1

q2

q3

fn

∑ w

yd3

ft

q

q

x

y

zt

t

t

qt

∑ t

cc(x c ,y ,z )

d5d5(x d5 ,y ,z )

Fig. 4: Simulation model of 5-link elbow-bracing ma-nipulator

In the initial period(t = 0), the coordinate systemof Σt has the same orientation of Σw,and hand targettrajectory is given as the following equations. T is themotion cycle.

xd(t) = xc (39)

yd(t) = r cos2π

Tt + yc (40)

zd(t) = r sin2π

Tt + zc (41)

where, r = 0.2[m], (xc, yc, zc) = (0, 0.8, 0.5)[m],T = 5[s].

During the motion period(t > 0), the coordinatesystem of Σt is rotating about zt-axis with rotationalangle qt (qt = 2πt/T ).

4.2 Simulation experimentLink’s weight is mi = 1.0 [kg], link’s length is li =

0.5 [m], viscous friction coefficient of joint is Di = 2.9[N · m · s/rad], torque constant is Ki = 0.2 [N · m/A],resistance is Ri = 0.6 [Ω], inductance is Li = 0.1[H],

inertia moment of motor is Imi = 1.64×10−4 [kg · m2],reduction ratio is ki = 3.0 and viscous friction co-efficient of reducer is dmi = 0.1 [N · m · s/rad](i =1, 2, 3, 4, 5).

4.2.1 Analysis of energy-efficiency

The task for the 5-LINK manipulator is track-ing spatial trajectory which is described in the for-mer part. As three degrees of freedom are used forthe three-demensional position of manipulator’s end-effector to achieve spatial trajectory tracking, it hasredundency for 5-link manipulator without constraintto track three-dimensional trajectory. However, in ourmodel of 5-link elbow-bracing manipulator, the othertwo degrees of freedom are used to control the elbow-bracing position yd3 and constraint force fnd, which,simultaneously decreases the effect of link’s gravityduring trajectory tracking. Therefore, the trackingaccuracy for manipulator with constraint is higherthan the manipulator without constraint. What’smore, it is more energy-efficient.

As it valid deems that the transiant responses frominitial condition should be ingored, the time of whichis 3s 17), energy consumption E∗(T ) after t = T = 5[s]defined by following equations are utilized to evaluatethe influence of elbow-bracing position and constraintforce. Moreover, the constrant force is 40[N ], and theelbow-bracing position is 0.4[m].

E∗i (T ) =

∫ 3T

T

vi(t)ii(t)dt, (42)

E∗(T ) =5∑

i=1

E∗i (T ). (43)

Then the comparisons of energy consumption andtracking error for manipulators with bracing elbowand without bracing elbow are shown in Fig.5 andFig.6, seprately.

-1000

0

1000

2000

3000

4000

5000

6000

7000

8000

9000

0 5 10 15

Time (sec)

Without constraint

With constraint

-1

0

1

2

3

4

5

6

7

8

9

Co

nsu

mp

tio

n E

ne

rgy[K

J]

Fig. 5: Consumption energy for 5-link manipulatorwith 3nd link bracing and without 3nd link bracing

From Fig.5, it is known that energy consumptionis reduced by 1/9 when bracing elbow in comparison

Page 6: Analysis of Bracing-Constraint Dynamics with Energy-efficient … · 2016-08-30 · Analysis of Bracing-Constraint Dynamics with Energy-efficient for Elbow-bracing Manipulator ...

x-a

xis

tra

ckin

g e

rro

r[m

]y

-axi

s tr

ack

ing

err

or[

m]

Time(sec)

z-a

xis

tra

ckin

g e

rro

r[m

]

-0.008

-0.003

0.002

0.007

0 5 10 15

Without constraint

With constraint

-0.02

0

0.02

0.04

0 5 10 15

-0.02

0

0.02

0.04

0.06

0.08

0 5 10 15

Without constraint

With constraint

Time(sec)

Time(sec)

Without constraint

With constraint

Fig. 6: Tracking error for 5-link manipuladtor with3nd link bracing and without 3nd link bracing

with no bracing, which displays the drastic effective-ness of bracing elbow. From Fig.6, it is known thatthe tracking error in y-axis and z-axis for manipulatorwith constraint are obviously less than the trackingerror for manipulator without constraint. Therefore,the model of the 5-link elbow-bracing manipulator inthis paper is energy-efficient and holds high accuracy.

4.2.2 Analysis of the factors which influencethe consumption energy

It is known that five variables are controlled by thecontrol law as shown in Eq.(36), and two of which arethe constraint force fnd and elbow-bracing positionyd3. Therefore, the simulation of consumption energyfor 5-link manipulator in the influence of these twofactors is considered.

Fig.7 shows the range of yd3 during the process ofqt = 0. Based on Fig.7, the range of yd3 can be cal-culated by the following equations.

min(yd3) = yc + r −√

(l4 + l5)2 − z2c (44)

≈ 0.14[m]

max(yd3) =√

(l2 + l3)2 − l21 (45)

≈ 0.86[m]

Then, the simulation is conducted under the condi-tion that the elbow-bracing position yd3 is changing as0.2, 0.3···0.8[m], and the constraint force fnd is chang-ing as 20, 25 · · · 60[N ], and T = 5[s]. The 3-D figureof the consumption energy during time t = [T, 3T ][s]with both elbow-bracing position and constraint forcechanging is shown in Fig.8.

In Fig.8, it is known that the consumption energy is

cc(x c ,y ,z )

yd3

yd3

l

l

l

l

l

1

2

3

4

5

l

l

l

l

l

3

5

4

2

1

cc(x c ,y ,z )

(x cc z,rc y , )+

(x cc z,rc y , )+

x

y

z

w

w

w

x

y

z

w

w

w

Fig. 7: Range of yd3

Fig. 8: Consumption energy with both elbow-bracingposition and constraint force changing.(Point A rep-resents the optimal fnd and yd3 in the case of theminimum consumption energy)

the function of yd3 and fnd. Assuming that the valueof fnd is a constant, consumption energy is changingbased on yd3. Furthermore, the function between-consumption energy and yd3 is parabolic form whichhas a minimum value. Likewise, if yd3 is constantvalue, the function between consumption energy andfnd is parabolic form, too. Therefore, it is necessoryto calculat the optimal pair for yd3 and fnd to ob-tain the minimum consumption energy. As shown inFig.8, at point A which means that fnd = 35[N ] andyd3 = 0.55[m], the consumption energy for the 5-linkelbow-bracing manipulator is minimum.

5 Conclusion

In this paper, first, the constraint dynamics of theelbow-bracing manipulator including motor was pro-posed.

Next, by dividing the work space into two orthogo-

Page 7: Analysis of Bracing-Constraint Dynamics with Energy-efficient … · 2016-08-30 · Analysis of Bracing-Constraint Dynamics with Energy-efficient for Elbow-bracing Manipulator ...

nal domain, a position domain and a force domain, acontroller whose control of constraint force and posi-tion has no interference was discussed.

Then, the consumption energy and tracking errorfor the 5-link manipulator with constraint and with-out constraint were analysed. And the simulation re-sults reveal that the model of 5-link elbow-bracingmanipulator proposed in this paper is effectiveness inthe aspect of energy-efficiency and high accuracy dur-ing the process of tracking spatial trajectory.

Finally, the relationship between elbow-bracing po-sition, constraint force and consumption energy isanalysed. What’s more, Based on Fig.8, it is knownthat the minimum consumption energy for the manip-ulator can be obtained at optimal values for elbow-bracing position and constraint force pair. And, inour further research, we focus on the method to ob-tain these values, as well as to achieve tracking rapidtrajectory.

Refences1) J. Roy, L. L. Whitcomb, “Adaptive Force Control

of Position/Velocity Controlled Robots” Theoryand Experiment, IEEE Transactions on Roboticsand Automation, Vol.18, No.2, pp.121-137, 2002.

2) B. Siciliano, L. Villani, “A passivity-based ap-proach to force regulation and motion control ofrobot manipulators” Automatica, Vol.32, No.3,pp.443-447, 1996.

3) L. Villani, C. C. de Wit, B. Brogliato, “An expo-nentially stable adaptive control for force and posi-tion tracking of robot manipulators” IEEE Trans.Automat. Contr., Vol44, pp.778-802, 1999.

4) J. D. Schutter, H. V. Brussel, “Compliant robotmotion 2. A control approach based on externalcontrol loops” Int. J. Robot. Res., Vol.7, No.4,pp.18-33, 1988.

5) J. Park, O. Khatib, “Multi-Link Multi-ContactForce Control for Manipulators” Proc. of 2005IEEE Int. Conf. on Robotics and Automation,pp.3624-3629, 2005.

6) A. Petrovskaya, J. Park, O. Khatib, “Probabilis-tic Estimation of Whole Body Contacts for Multi-Contact Robot Control” Proc. of IEEE Interna-tional Conference on Robotics and Automation,pp.568-573, 2007.

7) T. Yoshikawa, “Dynamic Hybrid Position/Forcecontrol of Robot Manipulators—Description ofHand Constraints and Calculation of Joint Driv-ing Force” IEEE J. on Robotics and Automation,Vol.RA-3, No.5, pp.386-392, 1987.

8) K. Yamane, Y. Nakamura, “Forward DynamicsComputation of Open Kinematic Chains Based onthe Principle of Virtual Work” Proc. of IEEE Int.

Conf. on Robotics and Automation, pp.2824-2831,2001.

9) K. Yamane, Y. Nakamura, “Dynamics Filter -Concept and Implementation of On-Line MotionGenerator for Human Figures” IEEE Transactionson Robotics and Automation, vol.19, no.3, pp.421-432, 2003.

10) H. West, H. Asada, “A Method for the Designof Hybrid Position/Force Controllers for Manipu-lators Constrained by Contact with the Environ-ment” Proc. of IEEE Int. Conf. on Robotics andAutomation, pp.251-260, 1985.

11) H. Hemami, B. F. Wyman, “Modeling and Con-trol of Constrained Dynamic Systems with Appli-cation to Biped Locomotion in the Frontal Plane”IEEE Trans. on Automatic Control, Vol.AC-24,No.4, pp.526-535, 1979.

12) Z. X. Peng, N. Adachi, “Position and Force Con-trol of Manipulators without Using Force Sen-sors” (in Japanese) Trans. of the Japan Societyof Mechanical Engineers(C), Vol.57, pp.1625-1630,1991.

13) M. Minami, K. Adachi, S. Sasaki, A. Yanou, “Im-provement of Accuracy to Grind by Changing Po-sition Control Gain for Shape-grinding” AppliedMechanics and Materials, Vol. 555, pp.186-191,2014 .

14) Y. Washino, M. Minami, H. Kataoka, T. Mat-suno, A. Yanou, M. Itoshima, Y. Kobayashi,“Hand- Trajectory Tracking Control with Brac-ing Utilization of Mobile Redundant Manipulator”SICE Annual Conference, pp.219-224, 2012.

15) D. Kondo, M. Itosima, M. Minami, A. Yano,“Proposal of Bracing Controller Utilizing Con-straint Redundancy and Optimization of BracingPosition” Proceedings of SICE Annual Conference2013, pp.2732-2737, 2013.

16) Xiang Li, Hiroki Imanishi, Mamoru Minami,Takayuki Matsuno and Akira Yanou, ”DynamicalModeling of Humanoid with Nonlinear Floor Fric-tion”, 21st International Symposium on ArtificialLife and Robotics, B-Con Plaza Beppu, January20-22, 2016

17) D. Kondo, X. Li, A. Yanou, M. Minami, “Energy-efficient and precise trajectory-tracking with brac-ing manipulator”, The 20th International Sym-posium on Artificial Life and Robotics, OS2-7,pp.563-568, 2015.


Recommended