You are on page 1of 15



     


         
  

        

    
    
  


    
 
    

 
       
  
!!
"! #$%&
 ' ( )& *  + %  ",!   -' *' 

!  %  ./ % 0 1  %  -&% %


%  &    %
 '   ! *  !    -' *' 

/  &% %! !!


2 #$%&

 
 +& % 2  3 4 3  5  6/
/ 3 7 &%% 8%'%'3 ' ',/7 %8%'3 ' ',/

  
 
  

              
               
               
 ! "  #    #    
       #    $    
 #              
         !       
  !         %     
             

 
  3! 9  */& -%
! 0 :

     

   
     
 



  
   
  
 !    
  " 
    "
  
   !   



    
       "      
 # "  
"

  
 !$% &
'()* + )* ) *  )*
 

% '()* 
 &  
    

  )*    
"

   

" " ,% 
 & "
 
 



   
 "
 
  
 
-  

   " &  
 
   &
   
  . ""
  &   
  / 0 -

  ! 
     "
   !
 1 
  


   ,%      
 $%  
  

"" !  ."
 23

      
  4

   
 " 
 ! 5  ,   ""
  

   
 $ &   )6-7* 8 %


 2  
  

  
 
  
 

&  - 6-7   !


  9 $ :  
 
 &
       
 -
"" 
!
 %  !   
" 
     ! 0 80
;



 
  
         6-7
  
 &  
  ,%  
%


"
   
  6-7    %  
      4
   "

     &  
  
  % 
     
 "  &     6-7 
"    
"   




# 
"" %   " % & 
 
 
  "

  &  
   "  "  &  

 !  
 
      6-7 -%

  %
 
$ & 
  ).6-7*   %
   $
 & 
  ) 6-7*  ""
 -
  
   " 
9 $ :  6-7 %  
"  
       
& 
 ! % 

   
 <  "
   &
 
  
&  
   
 
 "

 6
="
   
"" >  "  ""  

 
 
"   
 ! ="
 %   & 


-
"" 
 2 
%
 - "! 

!  ?   -
 .6-7   6-7  ""
  ?  0  ?  5 
"  -
 ="
   ?  8 - "  ""  
 

  ?  @   "" 
  ?  A

  !" " # # 



     
  !B  


 -  "%   !
 6-7 
  
 ="    

    "!     
  

!
 !$% &!'! ( '!#  -$ &   

 


8<    "
  )* 

 "
%
 
 )*   )*
 
 %
 
$ )*  
  ( )*   
 )*  )*  )*  ( )* ) *
#  "
%$ 

   
   6-7 
)0*
 ( )* + )* 
 ( )* +   )* )*  
  )* )0*

% ) * 
     )
* 
  
  -   
 
 6-7 

 """  ) *  $ 

 )0* 
"  
!
>% 


 $ 
   )*
 

 

  )* )*  +  )5*





   ! 


 % 

  !  )*  
  "

  )*   -  )*  


  2    )* -

    6-7 



      % 
  !$






   
 
    

Differential estimate
Nonlinear function x2
x2
x

Input signal Signal tracking
f x1 v, 2 R 2
x1
v + R

Feedback

   -
      6-7
  )! ( #$!  - 

 
  
  @ !
   "%
 
     
)   * + ) *  C  )  *  C   )8*
%      
    

      2
  
    

   )

*  !   !

-
  
"
    "    "  !   
  ! %  "   
    6-7  
   
" "
 B  %      +   -  " "
 B 
%      +   -  
 %    -      
"  


 "  4      


  
"    
4
     )8*   $ &   
!  
)@*

 ( )* +)
*
 

( )* +    )* )*  C  )* )* )* C )* )@*



 
 
 

? 
 "%   !
 6-7   
 

   )0* 

 &    # "     6-7  "
  
 $   "
    
    &   %   
 
            
 D  
"
 
  
 -  
%
"
    
 !    
 
   6-7
0 )!$!  # 

     "%   !
 6-7
)@* 
 - "
   !  ! 
  !      


  / 

  

 !       - %


""
 % 

  !  2     &  
 
- ""
 
&   % 
  

!""# *+    

   
   

 )*

( )* +  )*  )* )A*

 
   
 
 
   )

*
    
         

 
 
  
  
 
  
 

5
f(z)= -z
4
f(z)= -z 3
3 f(z)= -z-z 3
z

0
0 1 2 3 4 5 6
Time(s)

   E    "%       
( ?  ."  
+   )*
 ) * )F*
# 

!   ) *    ) * +  -       ) * %  
"
     B  

 )A* 

 ) *  
+ ( )* )* +   )*   )* )D*

4
        
    2 -  ) * 
 ."





  #   !  2  )* + $


  +    

4!
G

$.? - 8 
   

 )A* 
!



"  
!  2 - 
)*  %   C 
!"#, *+    
   
  
 
   

!
   
   

     !   "     
 
 

   
 
  
 #
 $    %   !
   
 
    !  

  

!
      
  &!    ! !  

  
       
  
    
 

 
  
        !
!  !  

  

!
           
   
 
  !
  
    

 
- % %       & 
  % 

  !
 
 /  -    $ &   

 
 "
"! % %
"
   
  8  "    ,%  

  "     "


" 
"    
$ 

 ! 4 H  I I @ -  

 

%  ""=  J
  
 

 
""  %  %  !
 
 
 -   @
!""# *- '  
          !    


 
 
(
( )* +  )* ) * +   ) *
!
 
  
 
 
) * 

 )          ) * + 




   
 
    

*
 
 )*   "


"    ( )*  C       )* 


 
(  )* +   )*
)*  ) * +    )*


     


(   
  )*      )* 
  C*
   C !   
  
 
 


( ?""
  +    )* +  )* )* -
 

 )*

+ ( )* + ( )* ( )* +   )* )* ( )*
  
) *

- % 
( )* +  )*
 )* ()* +  )* ()* 
  )0*
4       )0*  ! %  

( )* +  )* C  )*


   )5*
%  )* +  




-  )* 

    " !

  ) * ? )* 




."
 2  


 ) * 
! 
"  
!  2  = 
 ."   

 ) * 
 -   

 )* 

  " %  ! "       .   
""= 
E! . 0  . 0   %  
! 
.!!" *+ *   
 % 

 
   
 
 
 
 
  )

*
    
+   
 )*   "


"    ( )*
 C      
!  (
 
(  )* +   )*
 )*
 )* )*   ) * +  

 )8* 

     


(   
  )*      )* 
  C*
   C !   
  
 
 


K/  )8* 


 .6-7  
 &  /  ?  )* 
  

 )* ( )* 
 
   ( )* -
& 
  

  !


 
   &    "
  !
  &  / < ( )* 


  
       )* 
!  !      ( )* 

%
  

   0 -
""
 

      " %    
6-7 % 
 "
   &  
  > % " 

  % $


 " 
B
 

!"#, *-    
 

  ,
    *
 
  "          
 
 %    
 

      "


  
  *    
      



  
   

   
  


  
 %  
   &!       
  
     "  
    +   "
  
  (  


   
 
     *   
 
     
 
 
 


  
   "
 
    ,
 
    " 
$   
  
 - . 

 



 

  
 %
  
 
  
 

   -
    .6-7
     
 
     
 
 $
  
  
 
  

 /      

,"(  
  
 

 
  
 - .   
 

   ,
 * 
 
 ,

  ,
 
   
 
 
   
 
   
%
  #  
!    

5 !!()#
$%    $ & 
   
2  
  $  &  
  !
  !$  

   #    % 

 "    
"  
"

  ""  - 

  ""

 %
  

% #   ""
 
   % 
 
!""# /+  
 
  "
 
   
   

 )*

  )*
 ( )* +  )*  )*
 ()* +  )*  C )*  )*  C )*  )@*

!

   
 
 0

 
  )

*
  0
)   * 



     )   *    1  

 
 
  )  *
( E
  ."  
)* C   )* C  C      )* C   )*
  
 
 )   * +  
)A*
C
-  )   *    )  * +  ! !
     -  
    )   * %  
"     

 )@* 

 )   *    


+    )* ( )* C ( )* )* C    )* ( )* C ( )* )*
   

+ (  )* ( )* C ( )* ( )*


)F*
+ ) * (  )* (  )* ) * ( )* ( )* C ( )* ( )*
 
+ ) * (  )* C ( )*  ( )* ( )* 




   
 
    

-  )  * 
 ."   -
 
   +  
 !  





 ( )* +
( )* + )D*

 ()* ()* +
6    ( )* +  ( )* +
 
   / 
 )D*  

   % )   * + )  * ( )*  ( )*  !  2
 
 
-  )  * $
 )   *  +  
   4!
G

$
.? - 
   )@* 
! 
"  
!  )  * 
- % 
  % . 5 
%      & 

  % 

  
 %
!""# /- '  
        )  *   !    


 
 
(
 ( )* +  )* ) * +
( )* +   )* C  )*  ) * +  

) *
!
)    * 
  
 
 0


 
0

) * 

 )          ) * + 
  
 )*   "


"   ( )*  C
*           )*


  
 ( )* +   )* )* ) * +   


(  )* +   )*


 

)* C  )* )*   ) * +   ) *


   

     


(   
  )*      )* 
  C*
   C ! )    * 
  
 
 


( .  +  


  )* +  )* )*
 )* +  )*


)*

) *
 

-
 ( )* +  )* ()*

) 0*
 


 ( )* +  )* C  )* ( )*
  

- 0 + )     *


   


0( )* +  0 )* C % )*
   ) 5*
%
0 )* +  )*  )* C  )*
   

 ) 8*
    
% )* + (   (  



 
) @*
# 1 + )   * 

   

 ) *  K/  ) *  ! %  

1( +  1)* ) A*
  
 
  
 

   -
    6-7
- ) 5* 
 " !

  ) A* # 
      


 ) *   .    ""= 
- ! . 5  . 5   %  
! 
.!!" /+ *   
 % 

   
   
 
 
+ 
 
  


    
2   
 )*   "


"    ( )*  C        )*


  

 ( )* + 
   )*

)*   )* )*   ) * +  
 ( )* + ) F*
   

 
   )*
) *   )  * )  * C (
 )  *  ) * + 

      

     


(   
  )*      )* 
  C*
   C ! )    * 
  
 
 


K/  ) F* 
 6-7 (  )* 

 
 &  
    "


  )* -


& 
  
"
  % .6-7


%    5
-  "   
.6-7 
B    
  % 2
 & 
% , 
   %      ! 
%

 "
   ,% =

  
    
  -
 
  
  &  "    
  # "   !

  ! %  8  
 "
  &  %  
   
 
-
& 
  
"

 % 

 !   / 
     &  
 
8 "!# 2#"3 !$ #   
 "   ""
 & 

 
   ="
  


 

 "
%  
     8    /
  ,2   ,2
# 

     6-7 )@* 

 "   "
 -
" 
 B
 !      

%  -!  -

" 
$ 
 
  ""
     K   

" 
  &  / 
 -    
" 
 





   
 
    

  - " 


      ""
  

; 
E  6-7 .6-7 6-7
K/  )@* K/  )8* K/  ) F*
 8  8  8 
 L L
  L L
L L 08
 0  0  0 
 0 0 0
   
  - "
 
   
/ ),2* E  6-7 ) * .6-7 ) * 6-7 ) *
 L  AA L 5 5 L  D
5 L 8850 L  F F L F
@ L F08 L 5  L  A
F L FA L 8@@ L 0@
 L0F@ L A L 58
 L AA F L5 0@ L D 
5 L88@ L F  LF
@ LF  L5D D L A
F L FD88 L88@F L08DD
  L05D @ L@D0 A L58 D

     =" %  



-! 
 
 

/ 

  "
      - "


  ""
 .6-7  6-7 
  
    
  - 6-7 


"
   - "
&  
 "
   &  
 
  8
%

   % 
 =

  "
  - " 



 %        8    /  ,2   


 ! %
  
 
  
 

   
 
  
   

 
   =
  

   "
   "
  &   

 "  
   

  



   
     &
   
  
  "     -   6-7 




 %  
 =

  
"
  % 

  "

!
   "     - 
   ""
  

  
!     6-7 ! 
    
    =   !


    &   >%  


    ""

 


  
     " %     6-7
@ ## 33 # !$!#. - ""    ""
  



    
"   
    

  -   " 

    )H>E ,


*


 

%    @ - "
 



 "    ) K6#?,J E, 5M80 * %   
    
# 


    
   " 
! !
 )7N4* A 
  !$    %     %  2
!    6-7   ""
 & 
 

"  %  
" 
 -!  - %  
   

%    A
-     
 2   .= -#  

 -
"
  
 
 - ="
 "
  % 

< 
   %
" 

    
" - "
   

" 
 
 
) 5*
 )*   
) *  )* - ="  " 

%  -! 0
Motor Encoder

   K=" 
 "
Velocity Acceleration
feedforward feedforward
NTD NTD d (Disturbance ) Real
Control Plant Position
Position + + +
value 1 response
command + +
K1 K2 Mn
+ + + Ms 2
Position gain Velocity gain

+ +
d gM n
Velocity NTD
feedback g
Velocity loop
NTD s+g
disturbance observer
+
gM n

   ""   6-7    









   
 
    

  - ="  " 

; 
>$
O
;
     

O    5 

7N4  & /  8  P

6 

 8 $

-3
x 10
feedforward (m/s)

2
Zoom in Command velocity
Velocity

Conventional NTD
0 LNTD
FNTD
-2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Time (s)
-3
x 10
feedforward (m/s2)

2
Acceleration

Command acceleration
Zoom in
Conventional NTD
0 LNTD
FNTD
-2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Time (s)
-3
x 10
2
response (m/s)

Conventional NTD Conventional NTD


Velocity

LNTD
0 FNTD

-2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Time (s)
Disturbance observer

0.2 Conventional NTD Conventional NTD


output (N)

LNTD
0 FNTD
-0.2
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Time (s)
-6
x 10
Servo error (m)

5 Conventional NTD
LNTD
0 FNTD
-5 Conventional NTD

0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5


Time (s)

   - 

 ""  ="
- 

 
     F    D K  
"
  
!
 
<     "
       "
    

"
  


 
! !
  "   
 
# 
   %
"    
%
! 
   F   



 
 
 
          "
 
 ,%  ""
 .6-7  6-7 
 "
   
  6-7 # %  6-7 "
 

&  
 
- 
!     F 
 
   
"
   



- /    &  
  
  &  ,%  

  
 
  
 

0.1
feedforward (m/s) Zoom in Command velocity
Velocity

Conventional NTD
0 LNTD
FNTD

-0.1
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5
Time (s)
feedforward (m/s2)

5
Acceleration

Command acceleration
Zoom in
Conventional NTD
0 LNTD
FNTD

-5
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5
Time (s)
0.1
response (m/s)

Zoom in Conventional NTD


Velocity

LNTD
0 FNTD

-0.1
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5
Time (s)
Disturbance observer

-3
2
Conventional NTD
output (N)

LNTD
0 FNTD

-2
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5
Time (s)
-4
x 10
2
Servo error (m)

Conventional NTD
LNTD
0 FNTD

-2
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5
Time (s)

   - 

 ""  ="
!

    
"
 
    6-7   -



!  
    
! "
     
! !

-  "   
! !
 

     
!    
F 7   "
      
   !
 
! 
1 

    6-7 -
1   
  1     



 ! 
  
      
!    
F 
  

 %  ""
  
 

# 
    
"  
"


  
    %
"
    D - "   & 

 "    ""


  

 !
 K
"    
!     D  
 

  %    ""



 -
"
 % 
"
 N    
 
   


 % 
!
  
    
 
  
" N      ""
  

   
  

          


   
%
! 
   D  "
    
  
  "   7N4 
 !
%    6-7 

 - 7N4
  
   !
   

!
 "    
F
- "
     
   

!    "  7N4




   
 
    

- "
    
   &  %$ %  % ""


 E
"  
  
F5   
)*   
%  
6-7 

 ,%  

  00   
)* % % 
  .6-7
>

   5   
)* 
 ! "  6-7 -
"  


 
&  "
A
 $$ -
"" 

 "!   "
    $
&      ""

% $
 %
 
 
  %

 $ & 
  ).6-7* 
""
 -
""
 


&  /   % " 
" %       %


 "
   
 " 
B
 
-    % 
     
   & 
  -
%
   $ & 
  ) 6-7* 
""

! "
 % .6-7
 -
  "
 "   &  
 
  
     &  
  
 %
 

 
/    " 
-  ="
  >  "  ""  
 

"  
      

    
 -
""
  

 "
 
 

 
  
  4 

 % ""
    


 
&  "
#    %$  "  %   "   % ! 
    
""
  
     ="
 " 



%  &


  ""

 
  
   
    
"
 


!
! % 
"  

 

% % 

  
    

" - =  


 "    
 % 
 
   !
B
     %$    



;< =' 1%  ' >  +' % 1 
%    
% $
& % %  
 
   % 
             $
'  ' 
//'  '
; < ' ' ? $  @' 0  &  %    ! % ? 9  &&&
  %    $
'5A  '5 //'   '
;< ' @$ * % B  9  $ %
!    C %  $
'  ' //'(
 '
;< )' >! D'   E' 4! 0 $! 9  %  %!
 / 
 C &&&   %    $
'5   ' //'((( ('
;5< 6' +  >' >!  
  3!9 
 ' ' ( $ ' $
'
 '  //'((  F %G'
;A< 4'   ' +  %!  / $  
  3! 9    
$
'   'A //'A(A5   F %G'
;(< 4'  "'  ' D!  
' % ,   !/ %     
  %:
/
  &&&    '   $
'   ' //'A( '
;< 4'  ' D!  "'     HH& - 

 : : %   


  3!
9 % && )     %  $
'5  'A //'A(5A  '
;< "' @ 4' ) 1' 0 1' >!  +' >  $  /
!    

/ 
& %&%% :
*  C% 
             $
'5
 ' F"G //'A((A  '
; < 4'  ' D! '   
'  %/
  
 $
& %    !/     

 &&&     &  $
'5   ' //'AA 5'
;< 4' @ ' )  D' @ ! %   $ 
 
 
 !
$ %%/%  %&% %
  3!9  )   *+     2!  //'A(( 
'
  
 
  
 

; < 4' =! 4' > 1' >  


'  
  3!9    $
&   %!
 /% %% &&&
   '    ' ) $
'  '
//'(A( 5 '
;< +' D! )' +! E' -!  
' 
%! +  / % ! %!  +?& 
 %
%   /
! 

    3! 9  $ $


'  '5 //'(
(A '
;< +' - >' E 6' @  
'  
 
%!   %&% :   
%   % 
:  3!9 % )      $  %  )I 
//'(((  '
;5< +' 2:&  E' "
3%/ ,    %  $- %  
% "3% " %  '
;A< "' E  D' D  . $!    3! 9  
    
$
'  ' //'A(  '
;(< 2' .% 1'   =' 13 1   
  $     % &&&.%'$&
  $ $
'  ' //'5AA( A'
;< 4'   2' 4 =' 3% =' +!: ' =' 1 ' 13 4' 3  +' D' @
= /H   

%  %$%   /
% : & /  / % %
  &! / $
'5  'FG //'55 '

33!2         $ &   


 

" ! 4 H  I I @    " "

   



2 
 %  
!""# + '  
        4   !    


 
 
(
1( )* +  1)* 1) * + 1   ) D*
!
1)* +  )* )*     )* 
,  
  0



 1)* +  )1* )1*     )1* 


   0



1 
  
 
 


 # 
    %      < 

      

%     <    


(   )1*  C
 1  C0  +
  

( C ( C    C (  )1*0 + 1  )1* 


    

  
 


  

 

*  
    3
0( )* +  0 )* C % )* 0 ) * + 0
     )0 *
!
0 )* +  )*  )*      )* 
,   0



% )* + #)* 
 
   #)* +  )*  )*      )* 
"  


   
 )*    
   +       0
 

0 ) *  , 
  !  
 

  # 


    
 0 )*  ! 
 !

 
! 




 C*



!"#, +   
  
          
@ * !
 
  !   
     #        )1*
  )1*  #  
   ,
   <   C*    C*  +   0 5   



 )1*  )1* )1* 


 )" * + C  +  



 )1*  )1* 
)1*




   
 
    

4 0 )  0  *  #      +5 !  


 
 0 

 

 !    
         4
  
 
  0  
 

'
         
    
    


   
      
  
 0    # 
 
  



 ! 
 
0 )  0  *   C*  0 )0* #  # + = )0  * 

 

 
         

      
      

    #    
  
  

 
  
 

 


 
  
 0 )   0  *   &

 

  


    
  
 
    # 
   C*   



0 )   0 * 0 0 


 

 
 !
 
0 )  0 * )  C*  0 0 ! 
 


6      


      # 
    
 0 )*  !

 !
! 

 
   C*


!"#, - * 
  
      
 

   #   
)
         
  3 7        
,
          +5
     
  

 



You might also like