,,

130033
:
/e Co
(
a- ) S
e
s
;,,
,,
, Co
s,
:;;;;

:
TM301.
2;
TM383.
6DOI:
10.
3969/
i
s
sn.
1004-132X.
2012.
16.
004
j.
Re
s
e
a
r
chonOpe
r
a
t
i
onSmo
o
t
hne
s
sandNo
i
s
eo
fS
t
e
i
ng Mo
t
o
rBa
s
e
don
pp
NewTypeAc
c
e
l
e
r
a
t
i
on/De
c
e
l
e
r
a
t
i
onCu
r
v
eandRe
a
l-t
imeCon
t
r
o
lS
cheme
L
iXi
aohuWang HeXuJ
i
a
l
i
n
ChangchunI
ns
t
i
t
u
t
eo
fOp
t
i
c
s,
F
i
neMe
chan
i
c
sandPhys
i
c
s,
Ch
i
ne
s
eAc
ademyo
fSc
i
enc
e
s,
Changchun,
130033
Ab
s
t
r
a
c
t:
Ba
s
edona
c
c
e
l
e
r
a
t
i
on/de
c
e
l
e
r
a
t
i
oncu
r
ve
sandc
on
t
r
o
ls
cheme,
t
heope
r
a
t
i
onsmoo
t
hne
s
s
andno
i
s
eo
fs
t
epp
i
ng mo
t
o
rwe
r
eana
l
edands
t
ud
i
ed.
Ac
c
o
r
d
i
ngt
ot
her
e
l
a
t
i
onbe
twe
enangu
l
a
ra
c
yz

/e-t
c
e
l
e
r
a
t
i
onandangu
l
a
rve
l
o
c
i
t
a- equa
t
i
on),
t
heS-t
e
c
c
e
l
e
r
a
t
i
on/
y(
ype,
ypeandCos-t
ypea
de
c
e
l
e
r
a
t
i
oncu
r
ve
swe
r
ec
ons
t
ruc
t
edr
e
spe
c
t
i
ve
l
i
nwh
i
cht
hef
l
ex
i
b
l
eimpa
c
tc
anbeavo
i
ded.
Then,
y,
,
t
hec
on
t
r
o
ls
chemeo
fs
t
epp
i
ng mo
t
o
r wa
sop
t
imi
z
ed i
nc
l
ud
i
ng t
ha
tt
hesmoo
t
hne
s
so
fs
t
epp
i
ng
mo
t
o
r
sspe
edt
r
ans
i
t
i
onwa
simp
r
oved,
t
ha
tt
hecon
t
r
o
l
l
e
r
sc
a
l
cu
l
a
t
i
onspe
edwa
senhanc
edbe
c
aus
e
o
fc
a
l
cu
l
a
t
i
on
ss
imp
l
i
f
i
c
a
t
i
onbyi
t
e
r
a
t
i
vea
l
r
i
t
hm,
andt
ha
ts
t
o
r
ager
e
s
ou
r
c
e
swe
r
es
avedt
hr
ough
go
r
e
a
l-t
imec
a
l
cu
l
a
t
i
on.
Theno
i
s
eexpe
r
imen
t
a
lr
e
su
l
t
sshowt
ha
tc
ompa
r
edwi
t
ht
het
r
ad
i
t
i
ona
ld
r
i
ve
s
cheme,
t
hes
t
epp
i
ngmo
t
o
rs
t
em,
wh
i
chadop
t
sCos-t
c
c
e
l
e
r
a
t
i
on/de
c
e
l
e
r
a
t
i
oncu
r
veandr
e
a
lys
ypea
t
imec
on
t
r
o
ls
cheme,
ope
r
a
t
e
ssmoo
t
h
l
sl
e
s
s
e
rno
i
s
edu
r
i
ngs
t
a
r
t
upp
r
oc
e
s
s.
yandha
Ke
r
d
s:
s
t
epp
i
ng mo
t
o
r;
a
c
c
e
l
e
r
a
t
i
on/de
c
e
l
e
r
a
t
i
oncu
r
ve;
i
t
e
r
a
t
i
vea
l
r
i
t
hm;
r
e
a
l-t
imec
on
go
ywo

t
r
o
l;
no
i
s
e

,
,
,

:
20111019

220

226.

[
P].
1992

05

03.

[
7] , .

[
13] , , .
FRP

[
8] Guo Xi
uan,L
i
uShuang,WangZhenchun.An
l
s
i
s
j
y

[
14] ,, , .

[
J].,
2002,
13(
24):
2087

2091.

f
o
rDynami
c
sPe
r
f
o
rmanc
eI
nd
i
c
e
so
f4-RR(
RR)
R

Pa
r
a
l
l
e
lMe
chan
i
sm[
J].
I
n
t
e
r
na
t
i
ona
lJ
ou
r
na
lo
fI
n

nova
t
i
veCompu
t
i
ngI
n
f
o
rma
t
i
onandCon
t
r
o
l,
2006,

2(
4):
849

862.

[
9] , , , .
[
J].,
2005,
27(
5):
38

40.

[
10]Ri
cha
r
d M,,
Shanka
rS.
[M].:,
1998.

[
J].,
2003,
25(
2):
54

56.

[
J]. ,
2010,
31(
6):

842

848.

[
15] . [M]. :
,
2005.

( )

:,,
1978
,
8 ,,

[
11] . [
D]. :

1963

[
12]Van
i
l
i
aM M.
F
i
be
rP
l
a
c
emen
tHe
ad:
US,
5110395
g

,,
1981

,
2004.

,,
1977

1907

 23 16 2012 8

[
1

3]

,,

1.
1S
1a,
a- ,
[4,9]

:
[4]

S
,

a=

k1 0< 1
d
(
1 < 2
2)
= amax
dt
(
)
2 < max
-k2 -max

,
k1
k2 amax ,
(
1)1bmax

, , ,

(
a)
a-

,
,
,, S
,
,

,, [49]
[
7

9]
,

(
b)
1S

,
,
,,
,,

,:
,,
:

; ,, 0,

a 0; ,
, =max ,
a 0,
:

(
1)

,
J ;
a
;
;
t;
Tm
;
Tz ;

/e
a- , S
e
Co
s
1908

e1 -1

(
= amaxt
3)

-k2t
max (
1-e )
/e
1.
2e
/ea-
2a,
e
kt

a=

amax (
d 4
max -)] 0< < max
= 2 [
dt
max

(
4):

d
Ja = J
T m -Tz
dt

(
2):

(
t-c)

maxe
(
t-c)
1+e

(
4)
(
5)

4
amax ,
,
=
amax (
1)2b,
max
max c,
ctacc,
tacc max
2
/e
e
3,tcon ,
tdec

(
5),,tacc ,
max

f ,
f f f max ,
f f max, max,
tacc

(
a)
a-

5Co
s

,,
,,

(
b)

/e
2e

,,

,
,

,
,

/e
3e

1.
3Co
s
4a,
Cosa-

2 -max )
2
2
(a )
6)
+(
=1 0< max (
amax
max

:
t=0 =0,(
4):
=

2
amax )]
max [
1-c
o
s(
t
2
max

(
7)

2
amax
,
t [
0,
],
amax (
1)
max
4b ,
max
,
Co
s
5

,
,
(
3) (
5)

(
7) , ,
,
6,i

ti, i
ti ,
, i i+1
, ,

i
ai,ai =

ani,
i =t
, i ai
[1011],
(
a)
a-

(
b)
4Co
s

= i
ti

i+1 = i +ai
ti

(
8)

1909

 23 16 2012 8

,(
8)
ti f,
(
8)

= i/f

T m -Tz
amax =
0081r
ad/s2
=1.
J

i+1 = i +ai/f

,
a-
( -t)a- ,
-t,

(
2)(
4)(
6), (
8) S
:
0< 1

k1

1 < 2

ai = amax

-max ) 2 < max

-k2 (

i+1 = i +ai
ti

ti+1 =

i+1

/e
e
ai =

4
amax [ (

i max -i)]
2
max

i+1 = i +ai
ti

ti+1 =

i+1

(
9)

i+1 = i +ai
ti

ti+1

=
i+1

Ja - ,7,
amax max
(
6),
a-

-5)
2
2
( a )
+(
=1
1.
0081
5

1
8
, 20 ,

=/2000
(
11)

DSPTMS320F2812,
150MIPS IQma
t
h
(

t 50s,

(
10)

2i )
2

1- (
1 max

Cos , (
6)

F2812 ,

Cos
ai = amax

, T m =2
3
Nm,(
1)

(
11)

F2812 50s,
)

t0 = 0
05s,
0 =
/100r
ad/s,
tm =50s m =
10r
ad/s,,
489485 , ,
956kB ,
,,
,
,;

1 ,

( ),

34HS300DZ ,
, 7
1

/mi
nmax(
r
n)

J(
kgm2)

Tz(
Nm)

300

1.
23

1.
06

( AR824)

: ;Cos
/e
;e
,
50s,
, 8 ,
9 , 10 2

1910

(
4) , Cos

,,

:
[
1]Ma
r
t
i
ne
zS,
He
r
nande
zL,
Reye
sD,
e
ta
l.
Fa
s
t,
Sma
l
l

andLow Vi
b
r
a
t
i
on Me
chan
i
c
a
lLa
s
e
rShu
t
t
e
r
s[
J].

Re
v
i
ew o
f Sc
i
en
t
i
f
i
cI
ns
t
r
umen
t
s,2011,82 (
4):

046102.

[
2]YouJ
ong-won,
KimJun-han.
De
s
i
faLowgno
Vi
b
r
a
t
i
on Mi
c
r
o-S
t
epp
i
ng Con
t
r
o
l
l
e
rf
o
r Dom -

//Pr
Came
r
a[
C]
o
c
e
ed
i
ngo
ft
he2009IEEEI
n
t
e
r
na

t
i
ona
lCon
f
e
r
enc
eon Me
cha
t
r
on
i
c
sandAu
t
oma
t
i
on.
Changchun,
2009:
296

301.

[
3]LeQuyNgo
c,
J
e
onJ
a
eWook.
AnImp
r
oved Me
t
hod

o
f Spe
ed Damp
i
ng f
o
ra S
t
eppe
r Mo
t
o
r wi
t
ha

//Pr
Smoo
t
hSpe
ed Es
t
ima
t
i
on[C]
o
c
e
ed
i
ng o
ft
he

10
2

5s

10s

dBA

68.
1

55.
3

52.
3

47.
7

74.
7
67.
3
66.
8

72.
2
58.
7
65.
3

72.
9

48.
1

54.
6

47.
6

63.
0

47.
5

10 2 :
(
1) 1 , 2 3

5s
12
8dBA 15
8dBA, 10s
8
6dBA 12
7dBA, 2
3
(
2),

(
3), 2
3

1,
(
4)
,,

(
/e Co
1)a- S
e
s

(
2),
,

(
3),

2008IEEEI
n
t
e
r
na
t
i
ona
lCon
f
e
r
enc
eonRobo
t
i
c
sand
B
i
omime
t
i
c
s.
Bangkok,
2009:
1438

1443.

[
4] ,, .

[
J]. ,
2011,
15(
1):
20

25.

[
5]Chen We
i,
FuZhongwe
i.
A Fa
s
tAc
c
e
l
e
r
a
t
i
onAl
go

//The5
r
i
t
hmf
o
rS
t
epp
i
ng Mo
t
o
r[
C]
t
hI
n
t
e
r
na
t
i
on

a
lCon
f
e
r
enc
eon Compu
t
e
rSc
i
enc
e & Educ
a
t
i
on.
He
f
e
i,
2010:
1179

1182.

[
6] , , , .

[
J].,
2009,
40(
8):

193

197.

[
7] ,, . S

[
J].,
2006,
26(
2):

157

159.

[
8] , , , .
[
J].,
2006,
19(
1):
122

123.

[
9] ,, .
[
J].,
2008,
15(
5):
576

579.

[
10] .
[
D].:,
2010.

[
11] , , .
[
J].,
2004,
21(
4):
20

21.

( )
:,,
1986

,,
1983
,,
1984

1911