• 検索結果がありません。

Bezier Curve Optimization for Passive Neural Control

+410 - PROCESS

5.3 Bezier Curve Model for Efficient Locomotion Model This section presents Bezier curve based passive neural control applied in bio-inspired

5.3.3 Bezier Curve Optimization for Passive Neural Control

The angle value of the joints are generated from the effect of output neuron signal.

There-fore, the value of hip-x, hip-y, and knee joints are affected by the input from neuron signal in

each leg. The value of angle joint in the ith leg (0,, where p E {hip-x, hip-y, knee}) depends

on the neuron value of neuron 4 Active neuron signal is generated by mutual inhibition of

coupled neuron while angle joint is generated by an equation that describes the relationship

between signal neuron component and certain joint angle. In order to acquire the relationship

model, we record the required data from the previous model of locomotion, where all joints

5.3. BEZIER CURVE MODEL FOR EFFICIENT LOCOMOTION MODEL 133

are represented by coupled neuron [178]. Its computational cost will be reduced by using this proposed model. The relationship graph is tabulated in Fig. 5.33.

Bezier model in locomotion is usually used as the kinematics [73]. It is also proposed as the method to solve the kinematic problem of hand-eye coordination, and more specifically, tool-eye recalibration of humanoid robots [205]. Bezier curve model generates smooth signal which is easy to be adjusted into the graph reference [73]. In this proposed model, we used a 2-dimensional quadratic Bezier curve model as the optimization function in order to get the relationship equation between the .angle value of joints and motor neuron. The mathematical model of Bezier curve model is presented in Eq. (5.44), where the Bezier curve point in time t is denoted by B(t); t is from 0 to 1; n represents the number of degrees in Bezier curve and Pi is the ith selection point.

In Bezier curve, the axis value (x axis and y axis) is resulted from 2 Bezier point notations which are Bx (t) representing neural signal and By (t) representing joint angle with t as the timing control. In this case, we have to find y axis By (passive neuron) by determining the value of x axis B. Parameter t is required for relating both parameters. Therefore, in order to acquire the value of t, we invert the equation of Bx(t) to become t(Bx). Since Bx(t)

parameter is a third order polynomial equation, we used Cardano formula to solve the inverse

equation. After inversion, the Bezier point in y axis can be denoted as By (t(Bx ) ) . B(t)_ti(1—tr-1Pi(5.44)

z—o

One relationship graph represented as 3 quadratic Bezier curves is illustrated in Fig. 5.29.

We use time parameter in order to facilitate and support the model and separate it into 3 curves. In the graph generated from t = 0 to t = tmax, when 0ct < t1 curve 1 is generated, when t1 <t < t2 curve 2 is generated, when t2 Ct < t.max curve 3 is generated.

Based on the model, we have 12 two-dimensional points to be optimized. From the pre-liminary studies, we used Bacterial Memetic Algorithm (BMA) to optimize the Bezier point.

More details about the algorithm can be found in [25]. The bacterium structure has 8 genes divided into 2 parts, genes representing the point in the line of reference (G(16}, G(2b) ) and

genes representing the point supporting the curve (G(3b} - G(8b) }. G11)} represents points P3 and P4, and G(2.b) represents points P7 and P8. Other genesG3b},4), G. G(6b), G(7b),G(8b) repre-

sent points P1, P2, P5, P6, Po, P10, respectively. In the encoding process which is presented

in Eq. (5.45), parameter G(ib) and 4) aredecided depending on the point in reference graph

with certain time cycle t. Therefore, the limitation point is from 1 to the number of time cycles tmarx. Other genes are decided by the position of the point in reference line. G(3b)and

Ggb} depend on the point position of P0, G(4b)and 4} depend on the point position of P3,

134 CHAPTER 5. LOCOMOTION GENERATOR MODEL

Curve 2

• 0P

P8

Figure 5.29: The proposed Bezier curve model. There are 3 quadratic Bezier curves, where 4

points are required in each curve, Po — P3, P4 — F7, P8— P1 i represent 1st curve, 2nd curve, 3rd curve, respectively. P3, P7, P11 are equal to P4, P8, F0, respectively. Po and P11 are defined as the first point of the joint trajectory. Therefore, there are 8 genes to be optimized which consist

of 2-D parameters.

and G`(6b) and G.1') depend on the point position of P7.

G(b)=

R(t) + ar(gm.ax — gmin) — gmin t= 1+r(t.nax-1)

pp(x'u) + 8r (gatax — gmin) — grain

if1<k<2

if 3<k < 8

(5.45)

In Eq. (5.45), Pl(x'y) is a 2-dimensional point of Bezier model, where, if k equals 3 and 8 then 1 equals 0, if k equals 4 and 5 then 1 equals 3, and if k equals 6 and 7, then 1 equals 7. R(t) is a 2-dimensional coordinate of reference graphic with input t. In Eq. (5.45), r is a random value

from 0 to 1; gmin and gmax are the minimum and maximum value from {G(36) , , Gg} } set;

a and ,8 are constant values where a << 8. :

In the evaluation process, we minimize the error of the graph in each curve (Ed), where the c parameter represents the index of the cth curve as depicted in Eq. (5.46). The error ratio (E1 : E2 : Es) determines the probability of BMA operation, where e.g., if the percentage error of the 1st curve is high, then the genes representing the 1st curve has high probability for modification. The total fitness is accumulated from E1, E2. and E3

t,

Ec= E Ij

(5.46)

5.3. BEZIER CURVE MODEL FOR EFFICIENT LOCOMOTION MODEL 135

5.3.4 Experimental Result and Discussion

In the experimental result, we analyze the walking pattern of cat [10] and record the joint angles which are generated based on orbital function based swing trajectory proposed in [169]. We represent the cat having 3 joints (hip-x, hip-y, and knee) in each leg as depicted in Fig. 7.7, where the 4 sequences for 1 walking cycle is as follows: first swing is Leg 2, second is Leg 4, third is Leg 3, and the forth swing is Leg I. The reference joint angles for each leg can be seen in Fig. 5.34.

5.3.4.1 Neural Oscillator Optimization

Here, we reduce the number of neurons required for the walking pattern from 24 neurons to 4 neurons. In order to form the neural signal appropriate with the reference of the joint trajectory and to have the same phase difference, the synaptic weight values of 4 neurons representing the active signal are optimized by using BMA that has proven its capability in the preliminary tests.

The aim of this optimization is to form the suitable signal for 4 legged robot locomotion based on reference hip-x joint signal acquired from cat walldng. In this neural oscillator optimization one bacterium has 6 genes denoted by G(n) representing the neural oscillator

parameters.C1, 07.) and G3n)represent T, T1, and Tf, respectively. The other genesG4n},

Gn}, G(64) representthe synaptic weights tabulated in Table 5.9.

Table 5.8: Parameter Values of Optimization ParamsNVgf nNbac Ardcinge Ii3Ib tl t2 t3

Valuet 40( 1 100 20 I 0.0051.0 2.f 24 49 74

BMA parameters and the result of optimization are tabulated in Tables 7.1 and 5.9, re-spectively, where in Table 7.1, Ngen, NbQ,c, and Nczone are the number of generations, number of bacteria, and the number of clones respectively, b is the rate of the adaptation value of neural oscillator. We set parameter t1 — t3 based on the preliminary test. The neural

oscilla-tor signal is depicted in Fig. 5.30. Since the walking cat trajecoscilla-tory has 7r/2 phase difference in one walking cycle, the neuron oscillator also has ir/2 phase difference as designed in the

optimization evaluation. This phase difference can be changed depending on the feedback sensor from sensory neurons.

136 CHAPTER 5. LOCOMOTION GENERATOR MODEL

Table 5.9: Representation Parameters and Results

Gene Param

G1

S.

}G2r ) G37

) G(

4n)

G5n)

c(6n)

Neura param

HT

5.

TI Tf wo

,1 W1 ,2 w2,3 w3,o

wl ,0 wo ,3 W3,2 W2,1

wp ,2

wi,3 W3,1

Value 2.0 12.07.0 5 2.431 0.789 2.248

^

` 0.5

"

°"

^

= 1.

a

=

^

^

^

^

^ 1.

n

°

^,

(

'

r

-/\ H

1 IT ~

~ v U U \

—Neuron 1

—Neuron 2

—Neuron 3

V \JI I N-1\-1\J \J\J \.. —Neuron 4

0 50 100 150 200 250 300 350 400 450 500 550 600 Time cycle

Figure 5.30: Neural oscillator signal as the input of the passive neural system

5.3.4.2 Bezier Curve Optimization

After optimizing the neuron structure, we optimize the walking model. This walking model requires 3 optimization processes in each leg which represents the relationship of neu-ral signal and joint trajectories (hip-y, hip--x, and knee). There are 12 points that are required to be optimized for one optimization process. We use the same optimization parameters pre-sented in Table 7.1 as in the previous optimization process.

The evolutionary algorithm successfully decreased tle error as illustrated in Fig. 5.31.

The evolution of the Bezier curve model in certain generations can be seen in Fig. 5.32.

The comparison graph between the reference and the optimized result is shown in Fig. 5.33, where neural signal is shown as x-axis and joint angle value as y-axis. Since 3 joints have to be optimized, thus 3 graphs are shown. Based on the result in Fig. 5.33, the Bezier based optimization successfully forms the graph similar to the reference graphics.

5.3. BEZIER CURVE MODEL FOR EFFICIENT LOCOMOTION MODEL 137

4 3.5 3

Z

it 1.5

1

p.5 a

-'--Error total

• Error curve 1 -.** -Error curve 2 Error curve 3

;11^=11111MNINO

1=111111••

Po,

ri"Frst,t7"—..,

liab.,,,V="t-zwL"rv.•••,r.romrepcpp.;',41g._ meoftwompelill NOM

0 50 100 150200250

Generation Figure 5.31: Fitness evolution

300 350 400

•,

.\\,„, \VI)

2nd gen.

^ \

20Th gen.

\\

r

\

4th gen.

30th gen.

~

*

.4\

\

6th gen,

^

. '

s-

50th gen.

^

10th ten.

.4 15th ten,

.2

100th gen.

• 1

200th gen. 400th ten.

Figure 5.32: A sample of Bezier curve evolution in certain generations

138 CHAPTER 5. LOCOMOTION GENERATOR MODEL

•N

•N

a~

a~

'N

•N

JQ

`lam^

111

W eti

N co a, co CD an U)

c po

T C'7

, cu

T

C

4 C']CC) a)

C C3

U)

O a)

CO Cr) 0

C') C~

r O fl 5

0

CO ca

CV

0

C N-co

C7 C~

a) d

C'7

Ci uJ

C!]N-C7

p-O Cf1

C.

x ci 0

4C)U, 0

N-a)

N-0

[+7

0 A

ci 0 0 0 coco ci 0 oaq

O

NQ

C7 ci CJ C7 C7

cv

O COC 4

co d

o.

T

q COco a

U)Cn O

CO

C') co

C'7O

c

N-fl L7 91 Q1

coco Q1

CO c0 C)

ti CV

C+]a C, CD

C7

CoN T 6l

CC7

9 0

1

CDCti

0 0 d

C, 0

CD a

CDN 0

CD ci 8

0

N-C7

co.

0

M fl

ti a

ti N

a) ci

a) ci 0

C C3

x

O.

x cO

ra O CD 0

co O

a, O

to O

t,co ci

C O

a

C7 O

coU) O

co Q

7. C7

N-o

O C]

C'V O

N-C)

G G

coC7

O C3

N

O C) C7

Q

CO.0 C']

a Cn

c 0 a)

C)a

ci C)

CD

9

N- CD rt C, CD CU

N-ao [V

a7 rn

a, c7 N

Se ]C

O cocc O

cc L,

a, O

a, Loa, a

CD CD

9,

A

C

N-0

CD cc cc cm 00 N. N- r

a 07 LO cc r7 cc 0

C] fl d ci a ci ci C] ci

N

L7 t..

w S N-Nt ["7N a7CD cocc ccU, ccd L77 Cn ti

K ci ci ci d ci ci ci ci Li ci 6 C]

cc

6 C]

In C

cc O O

U, O

a7 Q6 C

a 0

0 C]

a7O C5ci

ccco a

N. co

0 0 C7

L77LC) C7

a, coto

O N-Lf70co

Ln 0

N-.

a

ryNry~8 C1

W

9,

cc mLOmw'f"toY T'^

N~-QI Ci

'NC]

C7

a, co

07 L) a,co

;.11 ci

a, L(7

cc

O C70

O O co C 0

co a7 u] cc cc a, c7

M O

Ca 0

cc 0

N-0 co

0, ci

('7 O

O c7 O

i7

a-T NO

cc LOcoLO Q17 07a7 a7

cc7 co

~C7 O

0 O 0 0 C] O ci O C7

0 C7 O

c7 C) C) U) m m

C C

Q

d d

a d

r

d

a O

C O

Q

O i

C) C)

O Q

C~

2 '

c7). O s

d)LLU O

Q)ti.

G coco

d d d

Lr) d

U) NdO

O coC!) O

lutod fl° rf U-U- U- D Q ii4

anana y} u

5.3. BEZIER CURVE MODEL FOR EFFICIENT LOCOMOTION MODEL 139

After the relationship graphs are optimized, the inversion process is required in order to invert t parameter as output in the Bezier equation for x-axis. Therefore, by giving the neuron signal value, we get the t parameter, then the t value is used as input in Bezier equation for y-axis. Indirectly the output of angle joint is acquired from the value of motor neuron.

After inversion process, the comparison graphs between joint references and the output joint of Bezier model were recorded. In Fig. 5.34 x-axis is the time cycle and y-axis is the joint angle values. The representation of neuron ID to leg ID is decided based on preliminary

analysis. The output of hip-y, hip-x, and knee joint is generated based on the input of neuron as the signal generator. In time based graph, the joints comparison between the reference and the output of the proposed system is not much different. Only some small ripples are occurring, such as in the knee output joint in second, third, and fourth leg. These ripples do not affect the performance of the locomotion.

In order to prove the effectiveness of the proposed model, we applied the proposed system in a small 4 legged robot which has only 16 MHz microcontroller. This neuro-locomotion is successfully implemented in the robot. We run the robot through rough terrain, in the sloped terrain with 8' and 16° slope which are shown in Fig. 7.18. The recorded oscillation body tilt robot in pitch and roll direction can be seen in Fig.5.36 and the effect of ground sensor can be seen in Fig. 5.37. In the computational cost evaluation, this proposed system can be significantly reduced by 63% from the previous neuro-locomotion design [178] from 9.744.10-3 seconds to 3.603 .10-3 seconds for 1000 times looping. Therefore, this proposed locomotion model is able to be applied to low cost 4 legged robot locomotion.

5.3.5 Discussion

The sensor system integration is required in order to realize the dynamic locomotion.

The influence of the feedback sensor to the locomotion system is designed based on the pre-liminary studies. We used simple sensor integration between body tilt angle, ground sensor, and the output of joint angle. In future, advance and complex sensor integration is required in order to reach better performance. It is important in neuro-based locomotion in order to generate the dynamic signal and to enable walking on unstructured terrain. However the com-plexity of the sensor integration will increase the computational cost. Timing control of neu-ral signal for responding sensor feedback will be implemented. Parameter gz in Eq. (5.68) is required in order to fit into the relationship graph based on Bezier model. The proposed pas-sive neural control based neuro-locomotion can be extended to 3-dimensional Bezier model, such that the signal from ground and tilt sensor can cause the changes of neural signal and can affect the joint trajectory as well.

140

oss 0.1 0

4.0S

I -O.>:

6. 4.35 2 0 .2

•0.3 a3.35

• Bezier polnt --Reforente

—$9/ziOr mcgtei

Neuron

0.1S..,..

1i

..1. .

-

0.1 ?

• T

I ;.-7.11

ans . ,• i

I1i ...—__ 0

1 : 11

0.W

, 1 ii•

i:1

4,is .,4—t . 1

;I

!I 4.2

4 •01 0 as I

Neuron 2

03%

0.0S

.0.15

es

+ Sexier point

—ete Met modef 1

3 3

1.. 1' I...

S

I f

s I~

i .0.5 00.5 1 1.6 7

I I . s

4 sa.s 0

Neuron 4

•.I

• ;

0.51

. ... ...„.,„,,...,„..,...

•Wiepoinx a,i1.• '"

: —Retarorite

15. a.o$ 1 1. i„,„ —4010 Model iv g 1

! •, a

I 1 / • . . , — ! "4

t". -0.05 1 /+ .1X I •1.

-0.1 1 ` r i.

.1,

.015 I•1

.',

4.0.5 0 0.5 1 1.5 2

NeUron 3

CHAPTER 5. LOCOMOTION GENERATOR MODEL

1-4 ,

--1 " r---T---T---1 1 I 47 1..i

.iv ! ..._1 Ii

1..3 1 1: .1 1 1•

,, 1 t,

•• 1 ,,„, -1..1 t-;

...., i

,i . "" 1 1 -La i

..

11„[1t4--

T..-1Lits.'I ).,MI111

ti

.I

1•1I

,

1

..,

;T .1--11

0.2

•H ...2.0- o.,...1

.042300 .514 -0.S005i

Neuron I.Neuron 1

(a)

1,.0.$i"" .". """''-''''''''''''' I11 1•1

VLs [ ...L.... 1 1 !11.„.1-,1 _1i.. ...4-br'''''''---"74.---.--- 1iI ii1.4.$!..

1

.,

IIbi!

:---1 i .---1i

1:-1,91

i

. , I•. :

!... l . . 1 ,1 ,.

I4a's

•1 Ii : 01

--45 '

4 43005 14At052

Neuron 2•Neuron 2

(b).

0,-'7-7- i1

I • Betier point

—atfetitno .1. ... 1.

i —iigrzier ing01.=, II I T ....

1

1..1

,

..;.,..,[...

1,1...:...4...i,

P

,.,•., .:,,..:,...2,.,_. ,;=,2 ,..

OA1.•.''f•1..::

1I , . 1

i•i1 .!. • 0 ,• .1 'i ,

-0 0.100.51 -.0./1 ..0.0 '0.4 0.2 0 0.2 0.4 0,6 MI

Neuron 4Neuron 4

(c)

,!

i • ,i 11 i Ii , 1

1.2I '!

I 1I I'•'111.3

•, .•4.0,

1:—11 H

1... . -4!i..i

,as1,..4,..14.5

.'11 x1..:, -, i,,,

0.2i,.''I4 .3--.I.i-"'1'''1

0''..1...1..a.s...1.

..1-o.i00,31..1.Alsoorsa

Neuron 3t4euron 3

(d)

|^^ -

1'

Figure 5.33: Reference and Bezier output of relationship between neuron signal and joint tra-jectories (hip-y, hip-x, and knee) (a) first leg generated by Neuron 1 (b) second leg generated by

Neuron 2 (c) third leg generated by Neuron 4 (d) fourth leg generated by Neuron 3

5.3. BEZIER CURVE MODEL FOR EFFICIENT LOCOMOTION MODEL 141

1.5

#5

Et

•Pts

-OS 1 ,8 1

-15

-2

a

:Ae Ij

rapso

lime cycle (40 ms) (a)

13

4-s aC

I

•s.~ l

.7

reference -knee

rekrence reference aaNtpi

.~ xa se

Time cycle (40 ms) (b)

-Wee

flAstPut

3.5

0 d

4 •t7,.5

a+

•1.5

-2

•2.5 is

Time cycle (40 ms) (c)

1 r.>.•

VIZ re

"at t

.1.5

-2

-2 S

a 40 50

Titre cycle (40 ms) (d)

roference,.

--Knee .•

reference -reference

1 151409t.

outPut output /flout tom}

Figure 5.34: Comparison between joint reference and Bezier output of angle joint extracted during robot walking with neural signal as the input generator in time cycle based graphic (a) first leg generated by Neuron 1 (b) second leg generated by Neuron 2 (c) third leg generated by

Neuron 4 (d) fourth leg generated by Neuron 3

142 CHAPTER 5. LOCOMOTION GENERATOR MODEL

•.,

''"--

' .1.

et*ell* ,f.f. - 'CoCt. .4`0,- I•

IV .

. , • .. ,

" -,,,i irw..::.'d,:4:,.,:,7.''Fl, .., . - ,.:;,,,.. ..:„:,; .,1.:T=-.;,-,:...•.,.... . : .. ; . _ ,. . ,.. -

, •

Allow

!tV&,.• "i ..114.1•• .,.., .44016-. .• ..,!A

e... ,AiNgi-,..,-'

xt*

,.,tic

•4 -. . *) 4,

*

L

, ,... ..

(a)

2-slat •=i x* 4

s

• ,

14.

"trit,

IS* .42 11'

et. • — ,444,4

10

(b) Figure 5.35: Four legged robot walking experiment (a

slope

) rough terrain (b) slope terrain with 16°

s. *AM 0.0fi 0.04 oa iz 0 .0.0i .0.04 .0,06

4.12 -0.14

Rough terrain

OPO1t,PA

\.1

WATAA

PiTCh

TITtiV

6; L!

fv w,r0-7A. kwaNif

100 200 300 400 Eno 600 300 600 9001000

Time cycle 0.04

0.02

•0.02 -0.04

•0.06

Fiat terrain

14\)Xil! lV~ [V,Wk",t OA\

0100 200300400 500600700 800900 1000

Time cycle

Figure 5.36: Body's tilt recorded during robot walking in rough terrain and flat terrain shows the stability can be reached by using the proposed model. In rough terrain experiment, the body tilt angle in pitch direction has big oscillation because the robot walking is uphill and downhill

on the rough terrain.