Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

feat(freespace_planning_algorithms): use distance to nearest obstacle to improve path planning #8089

Commits on Jul 1, 2024

  1. refactor freespace planning algorithms

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 1, 2024
    Configuration menu
    Copy the full SHA
    4d28815 View commit details
    Browse the repository at this point in the history

Commits on Jul 2, 2024

  1. fix error

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 2, 2024
    Configuration menu
    Copy the full SHA
    5ed5426 View commit details
    Browse the repository at this point in the history
  2. use vector instead of map for a-star node graph

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 2, 2024
    Configuration menu
    Copy the full SHA
    efdb10d View commit details
    Browse the repository at this point in the history
  3. remove unnecessary parameters

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 2, 2024
    Configuration menu
    Copy the full SHA
    95a323b View commit details
    Browse the repository at this point in the history
  4. Configuration menu
    Copy the full SHA
    597bcff View commit details
    Browse the repository at this point in the history
  5. precompute average turning radius

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 2, 2024
    Configuration menu
    Copy the full SHA
    9cbfb42 View commit details
    Browse the repository at this point in the history

Commits on Jul 3, 2024

  1. add threshold for minimum distance between direction changes

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 3, 2024
    Configuration menu
    Copy the full SHA
    502c5ea View commit details
    Browse the repository at this point in the history
  2. apply curvature weight and change in curvature weight

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 3, 2024
    Configuration menu
    Copy the full SHA
    d67861b View commit details
    Browse the repository at this point in the history
  3. store total cost instead of heuristic cost

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 3, 2024
    Configuration menu
    Copy the full SHA
    3e94c40 View commit details
    Browse the repository at this point in the history
  4. fix reverse weight application

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 3, 2024
    Configuration menu
    Copy the full SHA
    9d46b07 View commit details
    Browse the repository at this point in the history

Commits on Jul 4, 2024

  1. fix parameter description in README

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 4, 2024
    Configuration menu
    Copy the full SHA
    be2368c View commit details
    Browse the repository at this point in the history
  2. implement edt map to store distance to nearest obstacle for each grid…

    … cell
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 4, 2024
    Configuration menu
    Copy the full SHA
    2b3173e View commit details
    Browse the repository at this point in the history
  3. use obstacle edt in collision check

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 4, 2024
    Configuration menu
    Copy the full SHA
    be3589f View commit details
    Browse the repository at this point in the history
  4. add cost for distance to obstacle

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 4, 2024
    Configuration menu
    Copy the full SHA
    a98c07b View commit details
    Browse the repository at this point in the history

Commits on Jul 5, 2024

  1. Merge branch 'awf-latest' into RT1-6959-refactor-astar-planning-algor…

    …ithm
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 5, 2024
    Configuration menu
    Copy the full SHA
    a9a572a View commit details
    Browse the repository at this point in the history
  2. fix formats

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 5, 2024
    Configuration menu
    Copy the full SHA
    99fef5f View commit details
    Browse the repository at this point in the history
  3. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 5, 2024
    Configuration menu
    Copy the full SHA
    216780c View commit details
    Browse the repository at this point in the history
  4. add missing include

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 5, 2024
    Configuration menu
    Copy the full SHA
    3a23aab View commit details
    Browse the repository at this point in the history
  5. refactor functions

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 5, 2024
    Configuration menu
    Copy the full SHA
    3440d06 View commit details
    Browse the repository at this point in the history
  6. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 5, 2024
    Configuration menu
    Copy the full SHA
    34190f1 View commit details
    Browse the repository at this point in the history
  7. add missing include

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 5, 2024
    Configuration menu
    Copy the full SHA
    548b761 View commit details
    Browse the repository at this point in the history

Commits on Jul 8, 2024

  1. precompute number of margin cells to reduce out of range vertices che…

    …ck necessity
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 8, 2024
    Configuration menu
    Copy the full SHA
    578ccee View commit details
    Browse the repository at this point in the history
  2. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 8, 2024
    Configuration menu
    Copy the full SHA
    a960280 View commit details
    Browse the repository at this point in the history
  3. add reset data function

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 8, 2024
    Configuration menu
    Copy the full SHA
    c60107d View commit details
    Browse the repository at this point in the history
  4. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 8, 2024
    Configuration menu
    Copy the full SHA
    fa42d14 View commit details
    Browse the repository at this point in the history
  5. add member function set() to AstarNode struct

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 8, 2024
    Configuration menu
    Copy the full SHA
    8eed3bb View commit details
    Browse the repository at this point in the history
  6. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 8, 2024
    Configuration menu
    Copy the full SHA
    0f8ab5b View commit details
    Browse the repository at this point in the history

Commits on Jul 9, 2024

  1. implement adaptive expansion distance

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 9, 2024
    Configuration menu
    Copy the full SHA
    5e7e018 View commit details
    Browse the repository at this point in the history
  2. remove unnecessary code

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 9, 2024
    Configuration menu
    Copy the full SHA
    3331d62 View commit details
    Browse the repository at this point in the history
  3. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 9, 2024
    Configuration menu
    Copy the full SHA
    612f95d View commit details
    Browse the repository at this point in the history
  4. Configuration menu
    Copy the full SHA
    8a1d045 View commit details
    Browse the repository at this point in the history
  5. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 9, 2024
    Configuration menu
    Copy the full SHA
    48d8b64 View commit details
    Browse the repository at this point in the history

Commits on Jul 10, 2024

  1. interpolate nodes with large expansion distance

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 10, 2024
    Configuration menu
    Copy the full SHA
    74394e9 View commit details
    Browse the repository at this point in the history
  2. minor refactor

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 10, 2024
    Configuration menu
    Copy the full SHA
    e0c1cb6 View commit details
    Browse the repository at this point in the history
  3. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 10, 2024
    Configuration menu
    Copy the full SHA
    5ece1b8 View commit details
    Browse the repository at this point in the history

Commits on Jul 11, 2024

  1. ensure expansion distance is larger than grid cell diagonal

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 11, 2024
    Configuration menu
    Copy the full SHA
    06eeeb7 View commit details
    Browse the repository at this point in the history
  2. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 11, 2024
    Configuration menu
    Copy the full SHA
    5ab43b4 View commit details
    Browse the repository at this point in the history
  3. compute collision free distance to goal map

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 11, 2024
    Configuration menu
    Copy the full SHA
    f1baaaa View commit details
    Browse the repository at this point in the history
  4. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 11, 2024
    Configuration menu
    Copy the full SHA
    ccf5729 View commit details
    Browse the repository at this point in the history
  5. use obstacle edt when computing collision free distance map

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 11, 2024
    Configuration menu
    Copy the full SHA
    d856ad6 View commit details
    Browse the repository at this point in the history
  6. minor refactor

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 11, 2024
    Configuration menu
    Copy the full SHA
    018c67f View commit details
    Browse the repository at this point in the history
  7. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 11, 2024
    Configuration menu
    Copy the full SHA
    b5c4ef2 View commit details
    Browse the repository at this point in the history

Commits on Jul 12, 2024

  1. fix expansion cost function

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 12, 2024
    Configuration menu
    Copy the full SHA
    6fa451e View commit details
    Browse the repository at this point in the history
  2. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 12, 2024
    Configuration menu
    Copy the full SHA
    24126f7 View commit details
    Browse the repository at this point in the history
  3. set distance map before setting start node

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 12, 2024
    Configuration menu
    Copy the full SHA
    fc2aea2 View commit details
    Browse the repository at this point in the history
  4. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 12, 2024
    Configuration menu
    Copy the full SHA
    6eb2ec6 View commit details
    Browse the repository at this point in the history

Commits on Jul 16, 2024

  1. refactor detect collision function

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 16, 2024
    Configuration menu
    Copy the full SHA
    0a3c534 View commit details
    Browse the repository at this point in the history
  2. Configuration menu
    Copy the full SHA
    3c38a52 View commit details
    Browse the repository at this point in the history
  3. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 16, 2024
    Configuration menu
    Copy the full SHA
    f93f576 View commit details
    Browse the repository at this point in the history
  4. add missing variable initialization

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 16, 2024
    Configuration menu
    Copy the full SHA
    d311167 View commit details
    Browse the repository at this point in the history
  5. remove declared but undefined function

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 16, 2024
    Configuration menu
    Copy the full SHA
    f600183 View commit details
    Browse the repository at this point in the history
  6. remove unnecessary checks

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 16, 2024
    Configuration menu
    Copy the full SHA
    fad3515 View commit details
    Browse the repository at this point in the history

Commits on Jul 17, 2024

  1. minor fix

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 17, 2024
    Configuration menu
    Copy the full SHA
    f1f18c7 View commit details
    Browse the repository at this point in the history
  2. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 17, 2024
    Configuration menu
    Copy the full SHA
    e5fdc88 View commit details
    Browse the repository at this point in the history
  3. refactor computeEDTMap function

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 17, 2024
    Configuration menu
    Copy the full SHA
    c6fdfe9 View commit details
    Browse the repository at this point in the history
  4. remove unnecessary code

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 17, 2024
    Configuration menu
    Copy the full SHA
    22f3a93 View commit details
    Browse the repository at this point in the history
  5. set min and max expansion distance after setting costmap

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 17, 2024
    Configuration menu
    Copy the full SHA
    895785d View commit details
    Browse the repository at this point in the history

Commits on Jul 18, 2024

  1. refactor detectCollision function

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 18, 2024
    Configuration menu
    Copy the full SHA
    d1e5ce4 View commit details
    Browse the repository at this point in the history
  2. remove unused function

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 18, 2024
    Configuration menu
    Copy the full SHA
    14860bf View commit details
    Browse the repository at this point in the history
  3. change default parameter values

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 18, 2024
    Configuration menu
    Copy the full SHA
    6ee0009 View commit details
    Browse the repository at this point in the history
  4. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 18, 2024
    Configuration menu
    Copy the full SHA
    6743aff View commit details
    Browse the repository at this point in the history

Commits on Jul 19, 2024

  1. fix computeEDTMap function

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 19, 2024
    Configuration menu
    Copy the full SHA
    c312d2d View commit details
    Browse the repository at this point in the history
  2. Configuration menu
    Copy the full SHA
    530a2bf View commit details
    Browse the repository at this point in the history
  3. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 19, 2024
    Configuration menu
    Copy the full SHA
    6f37063 View commit details
    Browse the repository at this point in the history

Commits on Jul 22, 2024

  1. rename parameter

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 22, 2024
    Configuration menu
    Copy the full SHA
    8488294 View commit details
    Browse the repository at this point in the history
  2. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 22, 2024
    Configuration menu
    Copy the full SHA
    4d23311 View commit details
    Browse the repository at this point in the history
  3. use linear function for obstacle distance cost

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 22, 2024
    Configuration menu
    Copy the full SHA
    f10f858 View commit details
    Browse the repository at this point in the history
  4. Merge branch 'awf-latest' into RT1-6959-refactor-astar-planning-algor…

    …ithm
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 22, 2024
    Configuration menu
    Copy the full SHA
    46c60c4 View commit details
    Browse the repository at this point in the history
  5. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 22, 2024
    Configuration menu
    Copy the full SHA
    56f8763 View commit details
    Browse the repository at this point in the history

Commits on Jul 23, 2024

  1. fix rrtstar obstacle check

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 23, 2024
    Configuration menu
    Copy the full SHA
    f326714 View commit details
    Browse the repository at this point in the history
  2. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 23, 2024
    Configuration menu
    Copy the full SHA
    3de6a13 View commit details
    Browse the repository at this point in the history
  3. Configuration menu
    Copy the full SHA
    a576783 View commit details
    Browse the repository at this point in the history
  4. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 23, 2024
    Configuration menu
    Copy the full SHA
    2b849aa View commit details
    Browse the repository at this point in the history

Commits on Jul 26, 2024

  1. remove redundant return statements

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 26, 2024
    Configuration menu
    Copy the full SHA
    1dde2b3 View commit details
    Browse the repository at this point in the history
  2. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 26, 2024
    Configuration menu
    Copy the full SHA
    701a3ec View commit details
    Browse the repository at this point in the history
  3. Configuration menu
    Copy the full SHA
    8b4ebdb View commit details
    Browse the repository at this point in the history
  4. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    mkquda committed Jul 26, 2024
    Configuration menu
    Copy the full SHA
    14c3a99 View commit details
    Browse the repository at this point in the history

Commits on Jul 29, 2024

  1. check goal pose validity before setting collision free distance map

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 29, 2024
    Configuration menu
    Copy the full SHA
    0ec7c2b View commit details
    Browse the repository at this point in the history
  2. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 29, 2024
    Configuration menu
    Copy the full SHA
    061746a View commit details
    Browse the repository at this point in the history
  3. declare variables as const where necessary

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 29, 2024
    Configuration menu
    Copy the full SHA
    8dc2425 View commit details
    Browse the repository at this point in the history
  4. Merge branch 'RT1-6959-refactor-astar-planning-algorithm' into RT1-69…

    …61-use-edt-map-to-improve-collision-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 29, 2024
    Configuration menu
    Copy the full SHA
    e8cc212 View commit details
    Browse the repository at this point in the history
  5. Merge branch 'awf-latest' into RT1-6961-use-edt-map-to-improve-collis…

    …ion-check-performance
    
    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Jul 29, 2024
    Configuration menu
    Copy the full SHA
    ba4b328 View commit details
    Browse the repository at this point in the history

Commits on Aug 5, 2024

  1. Merge branch 'awf-latest' into RT1-6961-use-edt-map-to-improve-collis…

    …ion-check-performance
    mkquda committed Aug 5, 2024
    Configuration menu
    Copy the full SHA
    4c4f9d2 View commit details
    Browse the repository at this point in the history
  2. compare front and back lengths when setting min and max dimension

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Aug 5, 2024
    Configuration menu
    Copy the full SHA
    1185bf6 View commit details
    Browse the repository at this point in the history
  3. add docstring and citation for computeEDTMap function

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Aug 5, 2024
    Configuration menu
    Copy the full SHA
    386595a View commit details
    Browse the repository at this point in the history

Commits on Aug 7, 2024

  1. Configuration menu
    Copy the full SHA
    6f218f7 View commit details
    Browse the repository at this point in the history

Commits on Aug 8, 2024

  1. Merge branch 'awf-latest' into RT1-6961-use-edt-map-to-improve-collis…

    …ion-check-performance
    mkquda committed Aug 8, 2024
    Configuration menu
    Copy the full SHA
    6fdce3c View commit details
    Browse the repository at this point in the history

Commits on Aug 13, 2024

  1. Merge branch 'awf-latest' into RT1-6961-use-edt-map-to-improve-collis…

    …ion-check-performance
    mkquda committed Aug 13, 2024
    Configuration menu
    Copy the full SHA
    ffcf80e View commit details
    Browse the repository at this point in the history
  2. suppress spell check

    Signed-off-by: mohammad alqudah <[email protected]>
    mkquda committed Aug 13, 2024
    Configuration menu
    Copy the full SHA
    38b03a9 View commit details
    Browse the repository at this point in the history
  3. Configuration menu
    Copy the full SHA
    20306db View commit details
    Browse the repository at this point in the history