Automated synthesis of an FPGA-based controller for vehicle lateral ...

1 downloads 0 Views 127KB Size Report
of a PID controller for the automatic lateral control of a highway vehicle. ..... (4). Equation (4) can be efficiently solved as follows: 1. For. 1 5 i ! compute. 1. 1. 1.
MATEC Web of Conferences 41, 0 2 0 0 4 (2016 ) DOI: 10.1051/ m atecconf/ 2016 4 1 0 2 0 0 4  C Owned by the authors, published by EDP Sciences, 2016

           

 

&KULVWRIRURV(FRQRPDNRVD*HRUJH(FRQRPDNRV0LFKDHO6NDUSHWLVDQG0DULD7]DPW]L 1

Technol. Educ. Inst. of Central Greece, Department of Automation Engineering, GR34400 Psahna Evias, Greece Nat. Techn. Univ. of Athens, School of Electr. and Comp. Eng., Microprocessors Lab, GR17580 Athens, Greece

2

$EVWUDFW                                         !"#    

   #  $               %       

   #    &    $'     

   

$               !"#   (       )*+#),+ -      ).+ )/+#),+   % #01  2%013       4                         

 

 # 

  #           $  ),+          !"#   1# #  213        4               $'   &&   $              %01#     #    &         $'                    

    

  

     5             

   2 )6#*7+      3 1         8  

    

                     2     #   3        4   

                (               $                     #  

            

 

          * )*9+                

                x(t )  A(q )x (t ) bu f (t ) d Sref (t ) E (q )fw (t ) 2*3  y(t )  cx (t ) T  x (t )   ¡ C r %Z y Ef ¯°  u f      ¢ ± 



  Sref  1 / Rref  

     u              2 3     C       

 r      

 %Z  

         

       Ef      



 y 2 3     

      ls ,*.     fw     4    

      lw  0.1 m  2 *3

  a11 a12 0 0 b11 ¯ ¡ ° ¡a ° a 0 0 b 21 22 21 ¡ ° ¡ 1 0 0 0 °°  A(q )  ¡ 0 ¡ u ls u 0 0 °° ¡ ¡ ° 0 0 0 0 ° ¡¢ 0 ±



T T b   ¡ 0 0 0 0 1 ¯°  d   ¡ 0 0 u 0 0 ¯°  ¢ ± ¢ ±

a11

  1 lw ¯T E (q )  ¡ 0 0 0 °  c   ¡ 0 0 0 1 0 ¯°  ¢ ± ¡ mu J ° ¢ ± (c f cr ) (cr lr  c f l f ) cf   a12  1  b11   2 mu mu mu



 

   

This is an Open Access article distributed under the terms of the Creative Commons Attribution License 4.0, which permits XQUHVWULFWHGXVH distribution, and reproduction in any at medium, provided the original workor is http://dx.doi.org/10.1051/matecconf/20164102004 properly cited. Article available http://www.matec-conferences.org

?"@B  

a21  cf

(cr lr  c f l f )

 a22 

J /7D77EF   

(cr lr2 c f l f2 ) cr

 b21 

cf lf



J Ju 99,77EF   

 

                l f *79D    lr *DG*               J .6H9I  .      "   q1  u ‰  ¢ umin , umax ¯±  2    3  q 2  m ‰  ¢ mmin , mmax ¯± 2 m  m / N 

m     P      3

       q   ¢ q1, q 2 ¯±       B  u */F  u4 D7F  m *997   m4 *669  ls

ff

o

u

CG

lr

E

lf

)LJXUH1

#  



Gf y



  #        

  

 $'    2*3  ¬ K  U f (s )  žž K p i sKd ­­­  ¡¢ Rref (s )  Y (s ) ¯°± 2.3 ­® žŸ s $      K p  Ki    K d        (         )**+ )*.+            &  #                                   (   

 !        

 

""   # 

'

               #              

   $        

         

        '

                            $               

  !"            1# # 213

      1      ),+  1                     #  

 

                     !"            #                    #          

                        #                      

  %01                                       $               

 

     

                                                                 .#       e t yref t  y t       K p  Ki  K d    q  -           

 *     (            q  . $                 

       2      #   

    3 K p  Ki   K d  9





 

K p  Ki  K d 



          

  D "                         / $     

                                u              !"          2"F'  3     m    P             " 4     ),+           

      "           !"         (         !"  "                              " $  !%

    e ˜      K p  Ki  .

K d    q  (        #   (      

02004-p.2

MCEEA ’15

x cl t



y t

Acl xcl t  bcl y ref  Dcl J t c xcl t T cl

. 1  ,4,  293

 yref        y t  2    3 J

ª¬ f w U ref º¼   Acl  bcl  ccl   Dcl                      J              $      y t cclT e Acl t xcl 7  xcl f  yf 

 xcl f





 Acl* bcl yref  DclJ    yf

cclT xcl f  

67

K 77  ¦ j * K 7 j 6 j   V 7 /

6 7[7

V 7  

N 7  ¦ j * K 7 jV j  /

9 i *! /   [i Ki[7  N i            

  Kij   N i       &          Di   * $                    ?    4               

  xcl t   y t    

" & ' # ( 

           #            $'  & # yf yref 

                     !"

   M  4 2N   %01 @   '   I  M  4  1    1 '   I 3$   ? K&    %'02    3 

    4 P 6  (     "J? #        N  %01     ?                    2   M  4   3 "                  "4          

              $'   

              &                             1   9.            

  "       

   Acl* Dcl    ,  &          $'                                 4          /   *           !"                             4        (                  &  2       ( 3       "                    (         Q                            -          

         .    

    &            2       '1    3                    $                              !"   



  e t

e ˜

. .

f

cclT e Acl t xcl f  xcl 7 % 

³ e t

.

dt

x

 xcl 7 X xcl f  xcl 7    T

cl  f

7

f

X

³e

AclT t

ccl cclT e Acl t dt         

 

7

0   (   AclT X  XAcl  ccl cclT  yref /

7   xcl 7

7   e ˜

7  E   . .

J T /J 

DclT AclT XAcl* Dcl  .4. 4@4   

   Acl* Dcl     

 xcl 7   293 

 # xcl f 1   X    e ˜ .      J        "               /        e ˜ d O4 / J T J J #J & . .

$              T xclT ª¬ x T G f º¼  4                   0   (       .*  (                     K

     

 *G        2D3    & [i  i 7! /  ,D9*9.    Di  i 7! /        ª K 77 K 7* K 7. K 79 K 7D K 7/ º ª[7 º ªN 7 º «K 7 7 7 7 »» «« [* »» «« N* »» « *7 D* «K K .* D. 7 7 7 » «[. » «N . »  « .7 » « » « » 2D3 7 7 » «[9 » «N 9 » « K 97 K 9* K 9. D9 « K D7 K D* K D. K D9 DD 7 » «[D » «N D » « »« » « » «¬ K /7 K/* K /. K/9 K/D D/ »¼ «¬[/ »¼ «¬N / »¼ @(  2D3     

* i *! /    V i   6i





 Di* Ki 7  ¦ j * Kij 6 j  i *





Di* N i  ¦ j * KijV j  i *

02004-p.3

?"@B  

                         2    3 4       .77?%&   

          '1 $        (      2   KJ"?3      20R3   '1        

     2 

3  

4    !" 7DEOH"    !"

0 2Q3

 N 46#46.777*77?%& N 46#46.777*77?%&  N 46#46.777.77?%& N 46#46.777.77?%&  I 46#46DH7*77?& I 46#46DH7*77?&  I 46#46DH7.77?& I 46#46DH7.77?&  " 46#46.77*77?& " 46#46.77*77?&  " 46#46.77.77?& " 46#46.77.77?&  P (#46&*77*77?& P (#46&*77*77?&  P (#46&*77.77?& P (#46&*77.77?&  N 4,#4,46,7*77?& N 4,#4,46,7*77?&  N 4,#4,46,7.77?& N 4,#4,46,7.77?&  1  ,4,4*/7*77?& 1  ,4,4*/7*77?&  1  ,4,4*/7.77?& 1  ,4,4*/7.77?&  

?  /G, ,H* /,* ,9D /6H ,D /.9 /6D ,6D 6G ,,, H79/ 6D* G. ,HH H9, ,9/ 6/. ,DH 6H9 GD9 *.// HH/ **,9 

 !" N 46#46.777*77?%& N 46#46.777*77?%&  N 46#46.777.77?%& N 46#46.777.77?%&  I 46#46DH7*77?& I 46#46DH7*77?&  I 46#46DH7.77?& I 46#46DH7.77?&  " 46#46.77*77?& " 46#46.77*77?&  " 46#46.77.77?& " 46#46.77.77?&  P (#46&*77*77?& P (#46&*77*77?&  P (#46&*77.77?& P (#46&*77.77?&  N 4,#4,46,7*77?& N 4,#4,46,7*77?&  N 4,#4,46,7.77?& N 4,#4,46,7.77?&  1  ,4,4*/7*77?& 1  ,4,4*/7*77?&  1  ,4,4*/7.77?& 1  ,4,4*/7.77?& 

0R . 9 . . , 6 , , ./ .6 .9 .6 */ */ *D *, , 6 , 6 /9 ,7 /9 /,

4 G7. ,H* 6G. .9H HGD ,D 69G /6D *7* 6G G6. H79/ **76 G. G6D 9*D GD* 6/. HGD 6H9 *97G *.// *.H* **,9 

7DEOHJ   7 * * * 9 / D / 6 *7 *7 *D D , / 6 . 9 9 D *H ., .G 99

   2Q3   4 /G6  G79 .6, .6, /,* 6G. ,9D .9H /6G HH/ .,. .,. /.9 69G .*H .*H ,6/ *7** 976 976 ,,, G6. 9 9 6D. **7H 9, 9, ,HH G6D H9, 9*D ,9, GD. .G, .G, ,DH HGD .G* .G* GDD *9* DG/ DG/ HH, *.H. D/ D/   '1  6 / 6 9 H , , . .* G *D 6 H D 6 6 *6 *. *H , G9 // *7. D,

KJ"? 7 7 7 7 7 7 7 7 7 . 7 . 7 7 7 7 7 * 7 * * / * /

) ' ( 

      #      @   R   2@   1    8 @13   !         -      S@      0 



0

S   E   1  J   2E1J3 # J 

   "J%$?@'@1 $$$ $ 

          @   1    2"J%$?@'@1 $$$#1J@E!%@E$E! J@1@"J% !J-R 1$E@%E-0-!$"0@'R"$-EE1J.776# .7*93

* 

* 1!U"  !"       4   $'          V IEEE International Conference on Computer Communication and Informatics2.7*93 . ' E   U% #     

   !"          # 

         V $@@@   $  $    *96*8*96G2.7*93 9 @ ?   ? E   U !"            #   V $@@@     $  @  *H.D8 *HD.2.7763 D 1K- "IK1%"  1K 1  U? 1       !"#        V IEEE Internat. Conf. on Indust. Technology *9D8*9G2.7*.3 / @ %1  !@ S J  

  '    

  !"   @10F%01 '  ?  S 19th IEEE Int. Conf. Autom. and Computing.2.7*93 ,  @  ? &&  ? 1   ! @  S   $     ?   %  '  @        "    SIEEE Int. Conf, Ind. Technol.2.7*/3 6 W "

   B '   U"     V IFAC Theory Rep. Benchmark Problems Contr. Syst. Design2*GG73 H W"

W! B1  J1    N $ R  U0               

V $@@@    1 * *9.8*D92*GG/3 G W"

W! B1  J1    N $ R  U0               

V $@@@    1 * *9.8*D92*GG/3 *7  E I  ? ! 1     !    UJ'  J5    #' 1   8 @4   0  I

  %  N S   $   ?  X  2.77/3 ** I B  K   J K  U?

     % &       V$ W   *7./#*79H2*GHG3 *.  E I    ? ! 1   UJ       " 

 1   "



  (V IEEE MED 2.7*93 *9 ?! 1   E I    "1 E  SJ 

   '   "       "  1

S IEEE MED 2.77G3

02004-p.4

Suggest Documents