Page 339 - Sensing, Intelligence, Motion : How Robots and Humans Move in an Unstructured World
P. 339

314    MOTION PLANNING FOR THREE-DIMENSIONAL ARM MANIPULATORS

                                                               I
                                                               3
                                                            I 3max  d      g
                           I
                            3
                          d
                       I 3max
                                       g                 e            f
                                                                     O
                     e                                                1
                                   f
                                                                 v
                               P                                  1
                                                                         I
                                                             o
                                   O f                        v 1        2max
                          J                                 v             c  I
                           1                                2                 2
                         o             c  I                    v
                                          2    O        I      3
                                      I 2max    3  V    1max  a
                                J                  2
              O                 3
              3    I    J
                   1max  2
                      a           b                    I    v   O
                                                       1
                                                             3   2
                   I
                   1         O
                              2
                        (a)
                                                                (b)
                                     I
                                   d  3
                                                        g
                                              O
                                               1
                                   O
                                   3
                            e                   f
                                   o                       I
                                                        c  2
                                            O
                                            2
                             a                   b
                            I
                            1
                                     (c)
           Figure 6.15  The physical obstacles O 1 , O 2 ,and O 3 shown in figure (a) will be effec-
           tively perceived by the arm as those in figure (b), and they will produce the rather crowded
           C-space shown in (c).

              Thus, for a joint space obstacle O J , given start and target configurations j s ,
           j t and any path p J between j s and j t in J, P c (O J ), P c (j s ), P c (j t ),and P c (p J )
           are respectively the conventional projections of O J , j s , j t ,and p J onto J p . See,
           for example, the conventional projections of three obstacles, O 1 , O 2 ,and O 3 ,
           Figure 6.15b. It is easy to see that for any nonempty sets E 1 ,E 2 ⊂ J,wehave
           P c (E 1 ∩ E 2 ) = P c (E 1 ) ∩ P c (E 2 ).


           Definition 6.3.8. Define the minimal projection P m (E) of a set of points E =
           {(j 1 ,j 2 ,l 3 )}⊆ J onto space J p as P m (E) ={(j 1 ,j 2 ) |∀l 3 ,(j 1 ,j 2 ,l 3 ) ∈ E}.For
   334   335   336   337   338   339   340   341   342   343   344