python-motion-planning 1.1.1__tar.gz → 2.0__tar.gz

{python_motion_planning-1.1.1 → python_motion_planning-2.0}/PKG-INFO

@@ -1,8 +1,8 @@
 Metadata-Version: 2.4
 Name: python-motion-planning
-Version: 1.1.1
+Version: 2.0
 Summary: Motion planning algorithms for Python
-Maintainer-email: Yang Haodong <913982779@qq.com>, Wu Maojia <2223942063@qq.com>
+Maintainer-email: Wu Maojia <omige@mail.nwpu.edu.cn>, Yang Haodong <913982779@qq.com>
 License: GNU GENERAL PUBLIC LICENSE
                                Version 3, 29 June 2007
         
@@ -687,14 +687,18 @@ License-File: LICENSE
 Requires-Dist: numpy
 Requires-Dist: scipy
 Requires-Dist: matplotlib
-Requires-Dist: cvxopt
 Requires-Dist: osqp
-Requires-Dist: tqdm
+Requires-Dist: gymnasium
+Requires-Dist: faiss-cpu
+Requires-Dist: pyvista
+Requires-Dist: pyvistaqt
 Dynamic: license-file
 
 
 # Introduction
 
+`Python Motion Planning` repository provides the implementations of common `Motion planning` algorithms, including path planners on N-D grid, controllers for path-tracking, curve generators, a visualizer based on matplotlib and a toy physical simulator to test controllers.
+
 `Motion planning` plans the state sequence of the robot without conflict between the start and goal. 
 
 `Motion planning` mainly includes `Path planning` and `Trajectory planning`.
@@ -702,12 +706,12 @@ Dynamic: license-file
 * `Path Planning`: It's based on path constraints (such as obstacles), planning the optimal path sequence for the robot to travel without conflict between the start and goal.
 * `Trajectory planning`: It plans the motion state to approach the global path based on kinematics, dynamics constraints and path sequence.
 
-This repository provides the implementations of common `Motion planning` algorithms. **Your stars and forks are welcome**. Maintaining this repository requires a huge amount of work. **Therefore, you are also welcome to contribute to this repository by opening issues, submitting pull requests or joining our development team**.
-
 The theory analysis can be found at [motion-planning](https://blog.csdn.net/frigidwinter/category_11410243.html).
 
 We also provide [ROS C++](https://github.com/ai-winter/ros_motion_planning) version and [Matlab](https://github.com/ai-winter/matlab_motion_planning) version.
 
+**Your stars and forks are welcome!**
+
 # Quick Start
 
 ## Overview
@@ -715,28 +719,25 @@ The source file structure is shown below
 
 ```
 python_motion_planning
-├─global_planner
+├─common
+|   ├─env
+|   |   ├─map
+|   |   ├─robot
+|   |   └─world
+|   ├─utils
+|   └─visualizer
+├─controller
+|   └─path_tracker
+├─path_planner
 |   ├─graph_search
 |   ├─sample_search
-|   └─evolutionary_search
-├─local_planner
-├─curve_generation
-└─utils
-    ├─agent
-    ├─environment
-    ├─helper
-    ├─planner
-    └─plot
+|   └─hybrid_search
+└─traj_optimizer
+|   └─curve_generator
 ```
 
-* The global planning algorithm implementation is in the folder `global_planner` with `graph_search`, `sample_search` and `evolutionary search`.
-
-* The local planning algorithm implementation is in the folder `local_planner`.
-
-* The curve generation algorithm implementation is in the folder `curve_generation`.
-
 ## Install
-*(Optional)* The code was tested in python=3.10. We recommend using `conda` to install the dependencies.
+*(Optional)* The code was tested in python=3.10, though other similar versions should also work. We recommend using `conda` to install the dependencies.
 
 ```shell
 conda create -n pmp python=3.10
@@ -750,146 +751,104 @@ pip install python-motion-planning
 ```
 
 ## Run
-Below are some simple examples.
-
-1. Run A* with discrete environment (Grid)
-```python
-import python_motion_planning as pmp
-
-# Create environment with custom obstacles
-env = pmp.Grid(51, 31)
-obstacles = env.obstacles
-for i in range(10, 21):
-    obstacles.add((i, 15))
-for i in range(15):
-    obstacles.add((20, i))
-for i in range(15, 30):
-    obstacles.add((30, i))
-for i in range(16):
-    obstacles.add((40, i))
-env.update(obstacles)
-
-planner = pmp.AStar(start=(5, 5), goal=(45, 25), env=env)   # create planner
-cost, path, expand = planner.plan()                         # plan
-planner.plot.animation(path, str(planner), cost, expand)    # animation
-```
-
-2. Run RRT with continuous environment (Map)
-```python
-import python_motion_planning as pmp
-
-# Create environment with custom obstacles
-env = pmp.Map(51, 31)
-obs_rect = [
-    [14, 12, 8, 2],
-    [18, 22, 8, 3],
-    [26, 7, 2, 12],
-    [32, 14, 10, 2]
-]
-obs_circ = [
-    [7, 12, 3],
-    [46, 20, 2],
-    [15, 5, 2],
-    [37, 7, 3],
-    [37, 23, 3]
-]
-env.update(obs_rect=obs_rect, obs_circ=obs_circ)
-
-planner = pmp.RRT(start=(18, 8), goal=(37, 18), env=env)    # create planner
-cost, path, expand = planner.plan()                         # plan
-planner.plot.animation(path, str(planner), cost, expand)    # animation
-```
 
-More examples can be found in the folder `examples` in the repository.
-
-For more details, you can refer to [online documentation](https://ai-winter.github.io/python_motion_planning/).
-
-# Version
-## Global Planner
-
-Planner      | Version                                                                                                                                                                         | Animation
------------- |---------------------------------------------------------------------------------------------------------------------------------------------------------------------------------| --------- 
-**GBFS**              | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/gbfs.py)            | ![gbfs_python.png](assets/gbfs_python.png) 
-**Dijkstra**                 | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/dijkstra.py)        | ![dijkstra_python.png](assets/dijkstra_python.png)
-**A***               | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/a_star.py)          |  ![a_star_python.png](assets/a_star_python.png) 
-**JPS**                 | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/jps.py)             | ![jps_python.png](assets/jps_python.png)
-**D***                  | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/d_star.py)          | ![d_star_python.png](assets/d_star_python.png)
-**LPA***                 | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/lpa_star.py)        | ![lpa_star_python.png](assets/lpa_star_python.png) 
-**D\* Lite**                | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/d_star_lite.py)     | ![d_star_lite_python.png](assets/d_star_lite_python.png)
-**Theta\***                | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/theta_star.py)      | ![theta_star_python.png](assets/theta_star_python.png)
-**Lazy Theta\***                | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/lazy_theta_star.py) | ![lazy_theta_star_python.png](assets/lazy_theta_star_python.png)
-**S-Theta\***                | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/s_theta_star.py)    | ![s_theta_star_python.png](assets/s_theta_star_python.png)
-**Anya**                | [![Status](https://img.shields.io/badge/develop-v1.0-red)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/anya.py)                 | ![Status](https://img.shields.io/badge/gif-none-yellow)
-**Voronoi**                | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/graph_search/voronoi.py)         | ![voronoi_python.png](assets/voronoi_python.png) 
-**RRT**                 | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/sample_search/rrt.py)            | ![rrt_python.png](assets/rrt_python.png)
-**RRT***                 | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/sample_search/rrt_star.py)       | ![rrt_star_python.png](assets/rrt_star_python.png)
-**Informed RRT**                 | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/sample_search/informed_rrt.py)   | ![informed_rrt_python.png](assets/informed_rrt_python.png)
-**RRT-Connect**                | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/sample_search/rrt_connect.py)    | ![rrt_connect_python.png](assets/rrt_connect_python.png)
-| **ACO** | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/evolutionary_search/aco.py)      | ![aco_python.png](assets/aco_python.png)
-| **GA**  | ![Status](https://img.shields.io/badge/develop-v1.0-red)                                                                                                                        | ![Status](https://img.shields.io/badge/gif-none-yellow) 
-| **PSO**  | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/global_planner/evolutionary_search/pso.py)      | ![pso_python.png](assets/pso_python.svg) ![pso_python_cost.png](assets/pso_python_cost.svg) 
-
-
-## Local Planner
-
-| Planner     | Version                                                                                                                                                | Animation                                     
-|-------------|--------------------------------------------------------------------------------------------------------------------------------------------------------| -------------------------------------------------- 
-| **PID**     | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/local_planner/pid.py)  | ![pid_python.svg](assets/pid_python.svg) 
-| **APF**     | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/local_planner/apf.py)  | ![apf_python.svg](assets/apf_python.svg) 
-| **DWA**     | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/local_planner/dwa.py)  | ![dwa_python.svg](assets/dwa_python.svg)
-| **RPP**     | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/local_planner/rpp.py)  | ![rpp_python.svg](assets/rpp_python.svg)
-| **LQR**     | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/local_planner/lqr.py)  | ![lqr_python.svg](assets/lqr_python.svg) 
-| **TEB**     | ![Status](https://img.shields.io/badge/develop-v1.0-red)                                                                                               | ![Status](https://img.shields.io/badge/gif-none-yellow) 
-| **MPC**     | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/local_planner/mpc.py)  | ![mpc_python.svg](assets/mpc_python.svg)
-| **MPPI**    | ![Status](https://img.shields.io/badge/develop-v1.0-red)                                                                                               |![Status](https://img.shields.io/badge/gif-none-yellow)
-| **Lattice** | ![Status](https://img.shields.io/badge/develop-v1.0-red)                                                                                               |![Status](https://img.shields.io/badge/gif-none-yellow)
-| **DQN**    | ![Status](https://img.shields.io/badge/develop-v1.0-red)                                                                                               |![Status](https://img.shields.io/badge/gif-none-yellow)
-| **DDPG**    | ![Status](https://img.shields.io/badge/develop-v1.0-red)                                                                                               |![Status](https://img.shields.io/badge/gif-none-yellow)
-
-## Curve Generation
-
-| Planner | Version   | Animation                                |
+Please refer to the Tutorials part of [online documentation](https://ai-winter.github.io/python_motion_planning/).
+
+# Demos
+## Path Planner
+### Graph Search
+|Planner|2D Grid|3D Grid
+|-------|-------|-------
+**Dijkstra**|![dijkstra_2d.svg](assets/dijkstra_2d.svg)|![dijkstra_3d.png](assets/dijkstra_3d.png)
+**GBFS**|![gbfs_2d.svg](assets/gbfs_2d.svg)|![gbfs_3d.png](assets/gbfs_3d.png)
+**A\***|![a_star_2d.svg](assets/a_star_2d.svg)|![a_star_3d.png](assets/a_star_3d.png)
+**JPS**|![jps_2d.svg](assets/jps_2d.svg)|![jps_3d.png](assets/jps_3d.png)
+**Theta\***|![theta_star_2d.svg](assets/theta_star_2d.svg)|![theta_star_3d.png](assets/theta_star_3d.png)
+**Lazy Theta\***|![lazy_theta_star_2d.svg](assets/lazy_theta_star_2d.svg)|![lazy_theta_star_3d.png](assets/lazy_theta_star_3d.png)
+**D\***|Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+**LPA\***|Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+**D\* Lite**|Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+**Anya**|Not implemented|Not implemented
+
+### Sample Search
+|Planner|2D Grid|3D Grid
+|-------|-------|-------
+**RRT**|![rrt_2d.svg](assets/rrt_2d.svg)|![rrt_3d.png](assets/rrt_3d.png)
+**RRT\***|![rrt_star_2d.svg](assets/rrt_star_2d.svg)|![rrt_star_3d.png](assets/rrt_star_3d.png)
+**RRT-Connect**|![rrt_connect_2d.svg](assets/rrt_connect_2d.svg)|![rrt_connect_3d.png](assets/rrt_connect_3d.png)
+**Informed RRT**|Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+**PRM**|Not implemented|Not implemented
+
+### Evolutionary Search
+|Planner|2D Grid|3D Grid
+|-------|-------|-------
+| **ACO** |Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+| **GA**  |Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+| **PSO**  |Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+
+### Hybrid Search
+|Planner|2D Grid|3D Grid
+|-------|-------|-------
+**Voronoi Planner**|![voronoi_planner_2d.svg](assets/voronoi_planner_2d.svg)|![voronoi_planner_3d.png](assets/voronoi_planner_3d.png)
+
+## Controller
+
+We provide a toy simulator with simple physical simulation to test controllers (path-trakcers). The toy simulator supports multi-agents/multi-robots. The available robots include `CircularRobot` (Omnidirectional) and `DiffDriveRobot` (Only support moving forward and backward). Currently only 2D simulator is provided. 3D simulator has not been implemented.
+
+In the following demos, the blue robot 1 is the `CircularRobot`, and the orange robot 2 is the `DiffDriveRobot`.
+
+|Controller|2D|3D
+|-------|-------|-------
+|**Path Trakcer**|![path_tracker_2d.gif](assets/path_tracker_2d.gif)|Not implemented
+| **Pure Pursuit**     |![pure_pursuit_2d.gif](assets/pure_pursuit_2d.gif)|Not implemented
+| **PID**     |![pid_2d.gif](assets/pid_2d.gif)|Not implemented
+| **APF**     |![apf_2d.gif](assets/apf_2d.gif)|Not implemented
+| **DWA**     |![dwa_2d.gif](assets/dwa_2d.gif)|Not implemented
+| **RPP**     |![rpp_2d.gif](assets/rpp_2d.gif)|Not implemented
+| **LQR**     |Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+| **MPC**     |Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+| **MPPI**    |Not implemented|Not implemented
+| **TEB**     |Not implemented|Not implemented
+| **Lattice** |Not implemented|Not implemented
+| **DQN**    |Not implemented|Not implemented
+| **DDPG**    |Implemented in [V1.0](https://github.com/ai-winter/python_motion_planning/tree/v1.0), not migrated|Not implemented
+
+## Curve Generator
+
+|Generator|2D|3D|
 | ------- | -------------------------------------------------------- | -------------------------------------------------------- 
-| **Polynomia** | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/curve_generation/polynomial_curve.py) | ![polynomial_curve_python.gif](assets/polynomial_curve_python.gif)
-| **Bezier** | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/curve_generation/bezier_curve.py) | ![bezier_curve_python.png](assets/bezier_curve_python.png)
-| **Cubic Spline** | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/curve_generation/cubic_spline.py) | ![cubic_spline_python.png](assets/cubic_spline_python.png)
-| **BSpline** | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/curve_generation/bspline_curve.py) | ![bspline_curve_python.png](assets/bspline_curve_python.png)
-| **Dubins** | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/curve_generation/dubins_curve.py) | ![dubins_curve_python.png](assets/dubins_curve_python.png)
-| **Reeds-Shepp** | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/curve_generation/reeds_shepp.py) | ![reeds_shepp_python.png](assets/reeds_shepp_python.gif)
-| **Fem-Pos Smoother** | [![Status](https://img.shields.io/badge/done-v1.0-brightgreen)](https://github.com/ai-winter/python_motion_planning/blob/master/curve_generation/fem_pos_smooth.py) | ![fem_pos_smoother_python.png](assets/fem_pos_smoother_python.png)
+| **Polynomia** | ![polynomial_2d.svg](assets/polynomial_2d.svg)|Not implemented
+| **Bezier** |![bezier_2d.svg](assets/bezier_2d.svg)|Not implemented
+| **Cubic Spline** |![cubic_spline_2d.svg](assets/cubic_spline_2d.svg)|Not implemented
+| **BSpline** |![bspline_2d.svg](assets/bspline_2d.svg)|Not implemented
+| **Dubins** |![dubins_2d.svg](assets/dubins_2d.svg)|Not implemented
+| **Reeds-Shepp** |![reeds_shepp_2d.svg](assets/reeds_shepp_2d.svg)|Not implemented
+
+# Future Works
+
+* N-D controllers (path-trackers).
+
+* Path planning for robotic arms.
 
+* Path planning on topological map.
 
+* Sample search with Dubins or Reeds-Shepp curves.
 
+* Application on ROS2.
 
-# Papers
-## Global Planning
+* Application in mainstream robot simulation environments (e.g. Gazebo, Carla, Airsim, PyBullet, MuJoCo, Issac Sim).
 
-* [A*: ](https://ieeexplore.ieee.org/document/4082128) A Formal Basis for the heuristic Determination of Minimum Cost Paths
-* [JPS:](https://ojs.aaai.org/index.php/AAAI/article/view/7994) Online Graph Pruning for Pathfinding On Grid Maps
-* [Lifelong Planning A*: ](https://www.cs.cmu.edu/~maxim/files/aij04.pdf) Lifelong Planning A*
-* [D*: ](http://web.mit.edu/16.412j/www/html/papers/original_dstar_icra94.pdf) Optimal and Efficient Path Planning for Partially-Known Environments
-* [D* Lite: ](http://idm-lab.org/bib/abstracts/papers/aaai02b.pdf) D* Lite
-* [Theta*: ](https://www.jair.org/index.php/jair/article/view/10676) Theta*: Any-Angle Path Planning on Grids
-* [Lazy Theta*: ](https://ojs.aaai.org/index.php/AAAI/article/view/7566) Lazy Theta*: Any-Angle Path Planning and Path Length Analysis in 3D
-* [S-Theta*: ](https://link.springer.com/chapter/10.1007/978-1-4471-4739-8_8) S-Theta*: low steering path-planning algorithm
-* [Anya: ](http://www.grastien.net/ban/articles/hgoa-jair16.pdf) Optimal Any-Angle Pathfinding In Practice
-* [RRT: ](http://msl.cs.uiuc.edu/~lavalle/papers/Lav98c.pdf) Rapidly-Exploring Random Trees: A New Tool for Path Planning
-* [RRT-Connect: ](http://www-cgi.cs.cmu.edu/afs/cs/academic/class/15494-s12/readings/kuffner_icra2000.pdf) RRT-Connect: An Efficient Approach to Single-Query Path Planning
-* [RRT*: ](https://journals.sagepub.com/doi/abs/10.1177/0278364911406761) Sampling-based algorithms for optimal motion planning
-* [Informed RRT*: ](https://arxiv.org/abs/1404.2334) Optimal Sampling-based Path Planning Focused via Direct Sampling of an Admissible Ellipsoidal heuristic
-* [ACO: ](http://www.cs.yale.edu/homes/lans/readings/routing/dorigo-ants-1999.pdf) Ant Colony Optimization: A New Meta-Heuristic
+* More mainstream motion planning algorithms.
 
-## Local Planning
+* Performance optimization.
 
-* [DWA: ](https://www.ri.cmu.edu/pub_files/pub1/fox_dieter_1997_1/fox_dieter_1997_1.pdf) The Dynamic Window Approach to Collision Avoidance
-* [APF: ](https://ieeexplore.ieee.org/document/1087247) Real-time obstacle avoidance for manipulators and mobile robots
-* [RPP: ](https://arxiv.org/pdf/2305.20026.pdf) Regulated Pure Pursuit for Robot Path Tracking
-* [DDPG: ](https://arxiv.org/abs/1509.02971) Continuous control with deep reinforcement learning
+Contributors are welcome! For trivial modification, please directly contribute to `dev` branch. For big modification, please [contact](#contact) us before you contribute.
 
-## Curve Generation
+# Contact
 
-* [Dubins: ]() On curves of minimal length with a constraint on average curvature, and with prescribed initial and terminal positions and tangents
+Long-term maintainers:
 
-# Acknowledgment
+* [@omigeft](https://github.com/omigeft) (Wu Maojia)
+* [@ai-winter](https://github.com/ai-winter) (Yang Haodong)
 
-* Our visualization and animation framework of Python Version refers to [https://github.com/zhm-real/PathPlanning](https://github.com/zhm-real/PathPlanning). Thanks sincerely.
+You can contact us via the information provided on our profile.

python_motion_planning-2.0/README.md

@@ -0,0 +1,158 @@
+
+# Introduction
+
+`Python Motion Planning` repository provides the implementations of common `Motion planning` algorithms, including path planners on N-D grid, controllers for path-tracking, curve generators, a visualizer based on matplotlib and a toy physical simulator to test controllers.
+
+`Motion planning` plans the state sequence of the robot without conflict between the start and goal. 
+
+`Motion planning` mainly includes `Path planning` and `Trajectory planning`.
+
+* `Path Planning`: It's based on path constraints (such as obstacles), planning the optimal path sequence for the robot to travel without conflict between the start and goal.
+* `Trajectory planning`: It plans the motion state to approach the global path based on kinematics, dynamics constraints and path sequence.
+
+The theory analysis can be found at [motion-planning](https://blog.csdn.net/frigidwinter/category_11410243.html).
+
+We also provide [ROS C++](https://github.com/ai-winter/ros_motion_planning) version and [Matlab](https://github.com/ai-winter/matlab_motion_planning) version.
+
+**Your stars and forks are welcome!**
+
+# Quick Start
+
+## Overview
+The source file structure is shown below
+
+```
+python_motion_planning
+├─common
+|   ├─env
+|   |   ├─map
+|   |   ├─robot
+|   |   └─world
+|   ├─utils
+|   └─visualizer
+├─controller
+|   └─path_tracker
+├─path_planner
+|   ├─graph_search
+|   ├─sample_search
+|   └─hybrid_search
+└─traj_optimizer
+|   └─curve_generator
+```
+
+## Install
+*(Optional)* The code was tested in python=3.10, though other similar versions should also work. We recommend using `conda` to install the dependencies.
+
+```shell
+conda create -n pmp python=3.10
+conda activate pmp
+```
+
+To install the repository, please run the following command in shell.
+
+```shell
+pip install python-motion-planning
+```
+
+## Run
+
+Please refer to the Tutorials part of [online documentation](https://ai-winter.github.io/python_motion_planning/).
+
+# Demos
+## Path Planner
+### Graph Search
+|Planner|2D Grid|3D Grid
+|-------|-------|-------
+**Dijkstra**|![dijkstra_2d.svg](assets/dijkstra_2d.svg)|![dijkstra_3d.png](assets/dijkstra_3d.png)
+**GBFS**|![gbfs_2d.svg](assets/gbfs_2d.svg)|![gbfs_3d.png](assets/gbfs_3d.png)
+**A\***|![a_star_2d.svg](assets/a_star_2d.svg)|![a_star_3d.png](assets/a_star_3d.png)
+**JPS**|![jps_2d.svg](assets/jps_2d.svg)|![jps_3d.png](assets/jps_3d.png)
+**Theta\***|![theta_star_2d.svg](assets/theta_star_2d.svg)|![theta_star_3d.png](assets/theta_star_3d.png)
+**Lazy Theta\***|![lazy_theta_star_2d.svg](assets/lazy_theta_star_2d.svg)|![lazy_theta_star_3d.png](assets/lazy_theta_star_3d.png)
+**D\***|Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+**LPA\***|Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+**D\* Lite**|Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+**Anya**|Not implemented|Not implemented
+
+### Sample Search
+|Planner|2D Grid|3D Grid
+|-------|-------|-------
+**RRT**|![rrt_2d.svg](assets/rrt_2d.svg)|![rrt_3d.png](assets/rrt_3d.png)
+**RRT\***|![rrt_star_2d.svg](assets/rrt_star_2d.svg)|![rrt_star_3d.png](assets/rrt_star_3d.png)
+**RRT-Connect**|![rrt_connect_2d.svg](assets/rrt_connect_2d.svg)|![rrt_connect_3d.png](assets/rrt_connect_3d.png)
+**Informed RRT**|Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+**PRM**|Not implemented|Not implemented
+
+### Evolutionary Search
+|Planner|2D Grid|3D Grid
+|-------|-------|-------
+| **ACO** |Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+| **GA**  |Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+| **PSO**  |Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+
+### Hybrid Search
+|Planner|2D Grid|3D Grid
+|-------|-------|-------
+**Voronoi Planner**|![voronoi_planner_2d.svg](assets/voronoi_planner_2d.svg)|![voronoi_planner_3d.png](assets/voronoi_planner_3d.png)
+
+## Controller
+
+We provide a toy simulator with simple physical simulation to test controllers (path-trakcers). The toy simulator supports multi-agents/multi-robots. The available robots include `CircularRobot` (Omnidirectional) and `DiffDriveRobot` (Only support moving forward and backward). Currently only 2D simulator is provided. 3D simulator has not been implemented.
+
+In the following demos, the blue robot 1 is the `CircularRobot`, and the orange robot 2 is the `DiffDriveRobot`.
+
+|Controller|2D|3D
+|-------|-------|-------
+|**Path Trakcer**|![path_tracker_2d.gif](assets/path_tracker_2d.gif)|Not implemented
+| **Pure Pursuit**     |![pure_pursuit_2d.gif](assets/pure_pursuit_2d.gif)|Not implemented
+| **PID**     |![pid_2d.gif](assets/pid_2d.gif)|Not implemented
+| **APF**     |![apf_2d.gif](assets/apf_2d.gif)|Not implemented
+| **DWA**     |![dwa_2d.gif](assets/dwa_2d.gif)|Not implemented
+| **RPP**     |![rpp_2d.gif](assets/rpp_2d.gif)|Not implemented
+| **LQR**     |Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+| **MPC**     |Implemented in [V1.1.1](https://github.com/ai-winter/python_motion_planning/tree/v1.1.1), not migrated|Not implemented
+| **MPPI**    |Not implemented|Not implemented
+| **TEB**     |Not implemented|Not implemented
+| **Lattice** |Not implemented|Not implemented
+| **DQN**    |Not implemented|Not implemented
+| **DDPG**    |Implemented in [V1.0](https://github.com/ai-winter/python_motion_planning/tree/v1.0), not migrated|Not implemented
+
+## Curve Generator
+
+|Generator|2D|3D|
+| ------- | -------------------------------------------------------- | -------------------------------------------------------- 
+| **Polynomia** | ![polynomial_2d.svg](assets/polynomial_2d.svg)|Not implemented
+| **Bezier** |![bezier_2d.svg](assets/bezier_2d.svg)|Not implemented
+| **Cubic Spline** |![cubic_spline_2d.svg](assets/cubic_spline_2d.svg)|Not implemented
+| **BSpline** |![bspline_2d.svg](assets/bspline_2d.svg)|Not implemented
+| **Dubins** |![dubins_2d.svg](assets/dubins_2d.svg)|Not implemented
+| **Reeds-Shepp** |![reeds_shepp_2d.svg](assets/reeds_shepp_2d.svg)|Not implemented
+
+# Future Works
+
+* N-D controllers (path-trackers).
+
+* Path planning for robotic arms.
+
+* Path planning on topological map.
+
+* Sample search with Dubins or Reeds-Shepp curves.
+
+* Application on ROS2.
+
+* Application in mainstream robot simulation environments (e.g. Gazebo, Carla, Airsim, PyBullet, MuJoCo, Issac Sim).
+
+* More mainstream motion planning algorithms.
+
+* Performance optimization.
+
+Contributors are welcome! For trivial modification, please directly contribute to `dev` branch. For big modification, please [contact](#contact) us before you contribute.
+
+# Contact
+
+Long-term maintainers:
+
+* [@omigeft](https://github.com/omigeft) (Wu Maojia)
+* [@ai-winter](https://github.com/ai-winter) (Yang Haodong)
+
+You can contact us via the information provided on our profile.

{python_motion_planning-1.1.1 → python_motion_planning-2.0}/pyproject.toml

@@ -4,11 +4,11 @@ build-backend = "setuptools.build_meta"
 
 [project]
 name = "python-motion-planning"
-version = "1.1.1"
+version = "2.0"
 description = "Motion planning algorithms for Python"
 maintainers = [
-    {name = "Yang Haodong", email = "913982779@qq.com"},
-    {name = "Wu Maojia", email = "2223942063@qq.com"}
+    {name = "Wu Maojia", email = "omige@mail.nwpu.edu.cn"},
+    {name = "Yang Haodong", email = "913982779@qq.com"}
 ]
 readme = "README.md"
 license = {file = "LICENSE"}
@@ -17,9 +17,11 @@ dependencies = [
     "numpy",
     "scipy",
     "matplotlib",
-    "cvxopt",
     "osqp",
-    "tqdm"
+    "gymnasium",
+    "faiss-cpu",
+    "pyvista",
+    "pyvistaqt"
 ]
 classifiers = [
     "License :: OSI Approved :: GNU General Public License v3 (GPLv3)",

python_motion_planning-2.0/src/python_motion_planning/__init__.py

@@ -0,0 +1,4 @@
+from .common import *
+from .path_planner import *
+from .controller import *
+from .traj_optimizer import *

python_motion_planning-2.0/src/python_motion_planning/common/__init__.py

@@ -0,0 +1,3 @@
+from .utils import *
+from .env import *
+from .visualizer import *

python_motion_planning-2.0/src/python_motion_planning/common/env/__init__.py

@@ -0,0 +1,6 @@
+# from .world import *
+from .node import *
+from .types import *
+from .map import *
+from .world import *
+from .robot import *

python_motion_planning-2.0/src/python_motion_planning/common/env/map/__init__.py

@@ -0,0 +1,2 @@
+from .base_map import *
+from .grid import *