This project provides a 2D simulation environment designed for the development and testing of path planning algorithms. It offers a flexible and interactive platform for researchers, developers, and hobbyists to experiment with various path planning strategies in a controlled virtual space.
Project description
AutoNavSim2D
This project provides a 2D simulation environment designed for the development and testing of path planning algorithms. It offers a flexible and interactive platform for researchers, developers, and hobbyists to experiment with various path planning strategies in a controlled virtual space.
This project is being maintained by Clinton Anani.
Table of Contents
- Installation
- Usage
- Features
- Demo
- Configuration
- Requirements
- Custom Planner
- Contributing
- License
- Acknowledgments
- Contact
Installation
Follow these steps to install and set up the simulation environment on your system:
pip install autonavsim2D
Usage
To use the simulation environment for basic path planning and navigation with the default Djikstra algorithm path planner, create a main.py
file, and import the package:
from autonavsim2d.autonavsim2d import AutoNavSim2D
nav = AutoNavSim2D(
custom_planner='default',
custom_motion_planner='default',
window='amr'
)
nav.run()
To use the GUI, there are three steps involved to set the robot up, set a goal location, and generate obstacles:
- The first left-click is to place the robot in any location of your choosing. You can click
reset
to clear the map. - The second left-click sets your goal location. The cell you left-click on as your goal location will be green. To remove that location, right-click on the cell.
- And lastly, to create obstacles (colored black), left-click on anywhere on the map and drag, after setting the robot and choosing your goal location. To remove an obstacle from the map, simply right-click on it.
These steps must be followed one after the other in order to set the robot, set your goal location, and create obstacles. Check out the video below for a demo:
https://github.com/yendiDev/autonavsim2d/assets/57093800/6d96191d-1a85-4c3a-a542-0d29c1232b96
Configuration
AutoNavSim2D can be customized in numerous ways. To launch the simulation environment with a starting page, set the window
parameter to default
:
nav = AutoNavSim2D(
custom_planner='default',
custom_motion_planner='default',
window='default'
)
To launch the simulation environment in map mode where you can begin visualization, set the window
parameter to amr
:
nav = AutoNavSim2D(
custom_planner='default',
custom_motion_planner='default',
window='amr'
)
Features
Currently, AutoNavSim2D has the following features:
- 2D path planning
- Reactive autonomous navigation
- Dynamic map generation
- Support for custom graph-based path planning algorithms such as
A*
,Djiktra
orD*
Demo
See a video demo of the simulation environment in action here or check out the screenshots below:
Requirements
AutoNavSim2D is designed to be lightweight and memory efficient, so no dedicated hardware is required to run it. It is built on the pygame python package. To install pygame:
pip install pygame
Custom Planner
Writing your own path planning algorithm to be used in AutoNavSim2D is really simple. First, the map (1147x872) is represented as shown below:
Next the 2D matrix representation of the map, where 1 represents a free path and 0 represents an obstable is shown below. You will receive this matrix when writing your custom planner:
[
[1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1],
[1,1,1,1,1,1,0,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1],
[1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,0,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1],
[1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1],
[1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,0,1,1,1,1,1,1,1,1,1,1,1,1],
[1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1],
...
[1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1]
]
To use your custom path planner in AutoNavSim2D, write it in a function or class, return the optimal path as well as the time taken to calculate the path, and set it to the custom_planner
parameter as seen below:
from autonavsim2d import AutoNavSim2D
def my_planner(grid, matrix, start_loc, goal_loc):
# your own custom path planning algorithm here
path = []
runtime = ''
return (path, runtime)
nav = AutoNavSim2D(
custom_planner=my_planner,
custom_motion_planner='default',
window='amr'
)
nav.run()
Also, to use your custom motion planner or waypoint generator in AutoNavSim2D, write it in a function or class, return the appropriate set of waypoints in a list, and set it to the custom_motion_planner
parameter as seen below:
from autonavsim2d import AutoNavSim2D
from utils.pose import Pose, Point, Orientation
from utils.pose_stamped import PoseStamped, Header
def custom_motion_planner(grid, path, start, end):
# write your custom algorithm to generate waypoints here
robot_pose = None
waypoints = []
# 1. ROBOT POSE
# Robot pose must be a PoseStamp containing the robot's current location:
# start_cell = start[0]
# rect_x = start_cell.x
# rect_y = start_cell.y
# rect_center_x = rect_x + start_cell.width // 2
# rect_center_y = rect_y + start_cell.height // 2
# robot_position = Point(x=rect_center_x, y=rect_center_y, z=0)
# robot_orientation = Orientation(0, 0, 0, math.pi/2)
# robot_pose = Pose(position=robot_position, orientation=robot_orientation)
# 2. NAVIGATION WAYPOINTS
# Each element inside the waypoints list must return a PoseStamp:
# waypoint = PoseStamp(header=Header(...), pose=Pose(...))
# Where the elements of the PoseStamp include:
# Point(x, y, z=0)
# Orientation(x=0, y=0, z=0, w=theta)
# Pose(position=Point(...), orientation=Orientation(...))
# Header(stamp='0', frame_id='')
return(robot_pose, waypoints)
nav = AutoNavSim2D(
custom_planner='default',
custom_motion_planner=custom_motion_planner,
window='amr'
)
nav.run()
Contributing
To contribute, please email me at kceequan01@gmail.com. We welcome contributions from the community!
License
This project is licensed under the MIT License - see the LICENSE file for details.
Acknowledgments
AutoNavSim was built on Pygame. Thank you to the Pygame community for making this available :)
Contact
For inquiries or feedback, feel free to reach out:
- Email: kceequan01@gmail.com
- Twitter: https://twitter.com/oxncgen
- Linkedin: https://www.linkedin.com/in/clinton-anani-56a125196/
Project details
Download files
Download the file for your platform. If you're not sure which to choose, learn more about installing packages.
Source Distribution
Built Distribution
Hashes for autonavsim2D-1.0.0-py3-none-any.whl
Algorithm | Hash digest | |
---|---|---|
SHA256 | d641c6cf48eeb32e8a0586514886a2c370e2fede5f25733fec1d939e2d07f951 |
|
MD5 | f5481ce364171d5bc4b195d4b8d91428 |
|
BLAKE2b-256 | 334328123826d612f1f37f92aeea1904ff2d3e3aeaac6e8e4ec96466887d83ab |