Page 453 - Automotive Engineering Powertrain Chassis System and Vehicle Body
P. 453

CHAP TER 1 4. 2       Decisional architecture


                 The final feasible accelerationrange istherefore given by  by a pair ðs; _ sÞ ˛ j0; s max j j0; _ s max j where s max is the
               the intersection of Equations 14.2.27 and 14.2.28:  arc-length of S.
                                                                    A state-time of A is defined by adding the time di-
                            q ffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffi
                      F min                                       mension to a state hence it is represented by a triple
                               2 2
                                     2 4
                 max     ;    m g   k _ s    € s
                                     s
                       m                                          ðs; _ s; tÞ ˛ j0; s max j j0; _ s max j  j0; NÞ. The set of every
                              q ffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffi         state-time is the state-time space of A; it is denoted by
                         F max
                                 2 2
                                        2 4
                     min     ;  m g   k _ s                       ST.
                                        s
                           m
                                                                    A state-time is admissible if it does not violate the
                                                                  no-collision and velocity constraints presented earlier.
               14.2.5.4.2.5 Tangential velocity constraints       Before defining an admissible state-time formally, let us
               Velocity _ s must respect Equation 14.2.26. In addition,  define T B’, the set of state-times which entail a collision
               the argument under the square roots in Equation 14.2.28  between A and a moving obstacle. T B’ is simply derived
               should be positive. When k s s0; _ s must respect the  from T B:
               following constraint:
                                                                       0
                  r ffiffiffiffiffiffiffi  r ffiffiffiffiffiffiffi                              T B ¼fðs; _ s; tÞjdi ˛ f1; .; bg; AðsÞXB i ðtÞsBg
                    mg         mg
                         _ s                          (14.2.30)
                    jk s j     jk s j                               Similarly we define T V’, the set of state-times which
                                                                  violate the velocity constraint Equation 14.2.31. T V’ is
                 The final feasible velocity range is therefore given by  simply derived from T V:
               the intersection of Equations 14.2.26 and 14.2.30:                                     r ffiffiffiffiffiffiffiffi
                                 r ffiffiffiffiffiffiffi                          T V ¼                                mg
                                                                       0
                                   mg                                       ðs; _ s; tÞ 0 > _ s or _ s > min _ s max ;  jK s j
                 0   _ s   min _ s max ;              (14.2.31)
                                   jk s j
                                                                    Accordingly a state-time q is admissible if and only if:
                 The latter constraint can be expressed as a set of
                                                                                     0
                                                                               0
               forbidden states, i.e. points of the s _ s plane. Let T V be  q ˛ ST =ðT B W T V Þ
               this set of states, it is defined as:
                                                 r ffiffiffiffiffiffiffi        where E\F denotes the complement of F in E. The set of
                                                   mg             every admissible state-time is the admissible state-time

                 T V ¼   ðs; _ sÞ 0 > _ s or _ s > min _ s max ;

                                                   jk s j         space of A, it is denoted by AST and defined as:
                                                                                          0
                                                                                   0
                                                                    AST ¼ ST =ðT B W T V Þ
               14.2.5.4.3 Moving obstacles
                                          2
               A moves in a workspace W˛R which is cluttered up     Fig. 14.2-24 depicts the state-time space of A in
               with stationary and moving obstacles. The path S being  a simple case where there is only one moving obstacle
               collision-free with the stationary obstacles, only the  which crosses S.
               moving obstacles have to be considered when it comes to
               planning A’ s trajectory.
                 Let B i ; i ˛ f1; .; bg, be the set of moving obstacles.
               Let B i (t) denote the region of W occupied by B i at time
               t and A(s) the region of W occupied by A at position s
               along S. If, at time t, A is at position s and if there is an
               obstacle B i such that B i (t) intersects A(s) then a colli-
               sion occurs between A and B i . Accordingly the con-
               straints imposed by the moving obstacles on A’s motion
               can be represented by a set of forbidden points of the s
               t plane. Let T B be this set of forbidden points, it is
               defined as:

                 T B ¼fðs; tÞjdi ˛ f1; .; bg; AðsÞ X B i ðtÞsBg


               14.2.5.4.4 State-time space of A
               As mentioned earlier, the configuration of A is reduced to
               the single variable s which represents the distance trav-
               elled along S. A state of A is therefore represented  Fig. 14.2-24 ST ; the state-time space of A.


                    460
   448   449   450   451   452   453   454   455   456   457   458