diff --git a/docs/source/conf.py b/docs/source/conf.py
index 4cbec29f..0cde4765 100644
--- a/docs/source/conf.py
+++ b/docs/source/conf.py
@@ -22,7 +22,7 @@
 author = "Sebastian Castro"
 
 # The full version, including alpha/beta/rc tags
-version = release = "3.0.0"
+version = release = "3.1.0"
 
 
 # -- General configuration ---------------------------------------------------
diff --git a/pyrobosim/setup.py b/pyrobosim/setup.py
index 20463944..09ed15de 100644
--- a/pyrobosim/setup.py
+++ b/pyrobosim/setup.py
@@ -36,7 +36,7 @@ def get_files_in_folder(directory):
 
 setup(
     name=project_name,
-    version="3.0.0",
+    version="3.1.0",
     url="https://github.com/sea-bass/pyrobosim",
     author="Sebastian Castro",
     author_email="sebas.a.castro@gmail.com",
diff --git a/pyrobosim/test/test_pyrobosim.py b/pyrobosim/test/test_pyrobosim.py
index bf9f436c..9acd5039 100644
--- a/pyrobosim/test/test_pyrobosim.py
+++ b/pyrobosim/test/test_pyrobosim.py
@@ -12,4 +12,4 @@ def test_import():
 
 def test_version():
     ver = version("pyrobosim")
-    assert ver == "3.0.0", "Incorrect pyrobosim version"
+    assert ver == "3.1.0", "Incorrect pyrobosim version"
diff --git a/pyrobosim_msgs/package.xml b/pyrobosim_msgs/package.xml
index 208f592c..1b92a3bc 100644
--- a/pyrobosim_msgs/package.xml
+++ b/pyrobosim_msgs/package.xml
@@ -2,7 +2,7 @@
 <?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
 <package format="3">
   <name>pyrobosim_msgs</name>
-  <version>3.0.0</version>
+  <version>3.1.0</version>
   <description>ROS interface definitions for pyrobosim.</description>
   <maintainer email="sebas.a.castro@gmail.com">Sebastian Castro</maintainer>
   <license>MIT</license>
diff --git a/pyrobosim_ros/package.xml b/pyrobosim_ros/package.xml
index c1700695..13792542 100644
--- a/pyrobosim_ros/package.xml
+++ b/pyrobosim_ros/package.xml
@@ -2,7 +2,7 @@
 <?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
 <package format="3">
   <name>pyrobosim_ros</name>
-  <version>3.0.0</version>
+  <version>3.1.0</version>
   <description>ROS 2 wrapper around pyrobosim.</description>
   <maintainer email="sebas.a.castro@gmail.com">Sebastian Castro</maintainer>
   <license>MIT</license>
diff --git a/pyrobosim_ros/setup.py b/pyrobosim_ros/setup.py
index f1997d94..92ba3e1b 100644
--- a/pyrobosim_ros/setup.py
+++ b/pyrobosim_ros/setup.py
@@ -9,7 +9,7 @@
 
 setup(
     name=project_name,
-    version="3.0.0",
+    version="3.1.0",
     url="https://github.com/sea-bass/pyrobosim",
     author="Sebastian Castro",
     author_email="sebas.a.castro@gmail.com",