diff --git a/src/gazebo/Dockerfile b/src/gazebo/Dockerfile
index 238d984..cfbf4f4 100644
--- a/src/gazebo/Dockerfile
+++ b/src/gazebo/Dockerfile
@@ -3,4 +3,6 @@
# Use official image for Gazebo 9.x
FROM gazebo:gzserver9
+COPY $PWD/gazebo_models /root/.gazebo/models
+
CMD ["/bin/bash"]
diff --git a/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_1.STL b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_1.STL
new file mode 100644
index 0000000..1cc6dee
Binary files /dev/null and b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_1.STL differ
diff --git a/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_2.STL b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_2.STL
new file mode 100644
index 0000000..7960a24
Binary files /dev/null and b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_2.STL differ
diff --git a/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_3.STL b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_3.STL
new file mode 100644
index 0000000..d81bd58
Binary files /dev/null and b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_3.STL differ
diff --git a/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_4.STL b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_4.STL
new file mode 100644
index 0000000..f764555
Binary files /dev/null and b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_4.STL differ
diff --git a/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_5.STL b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_5.STL
new file mode 100644
index 0000000..1c02f3f
Binary files /dev/null and b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_5.STL differ
diff --git a/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_6.STL b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_6.STL
new file mode 100644
index 0000000..3e2ee1c
Binary files /dev/null and b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/arm_link_6.STL differ
diff --git a/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/base_link.STL b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/base_link.STL
new file mode 100644
index 0000000..6469280
Binary files /dev/null and b/src/gazebo/gazebo_models/fanuc_robotic_arm/meshes/base_link.STL differ
diff --git a/src/gazebo/gazebo_models/fanuc_robotic_arm/model.config b/src/gazebo/gazebo_models/fanuc_robotic_arm/model.config
new file mode 100644
index 0000000..05b32ed
--- /dev/null
+++ b/src/gazebo/gazebo_models/fanuc_robotic_arm/model.config
@@ -0,0 +1,11 @@
+
+
+ Fanuc_robot_arm
+ 1.0
+ model.sdf
+
+
+
+
+ This was created using parts from a CAD model on GrabCAD
+
diff --git a/src/gazebo/gazebo_models/fanuc_robotic_arm/model.sdf b/src/gazebo/gazebo_models/fanuc_robotic_arm/model.sdf
new file mode 100644
index 0000000..ae0a2dd
--- /dev/null
+++ b/src/gazebo/gazebo_models/fanuc_robotic_arm/model.sdf
@@ -0,0 +1,902 @@
+
+
+
+
+ 0 0 0 3.14159 -0 0
+
+ 86.082
+
+ 4.3404
+ 0
+ 0.0020207
+ 2.4866
+ 0
+ 6.1574
+
+ -0.003895 -0.062844 -0.11068 0 -0 0
+
+ 1
+ 0
+ 1
+
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/base_link.STL
+ 1 1 1
+
+
+
+ 1
+
+
+ __default__
+
+ 0.3 0.3 0.3 1
+ 0.7 0.7 0.7 1
+ 0.01 0.01 0.01 1
+ 0 0 0 1
+
+ 0
+ 1
+
+
+ 0
+ 10
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/base_link.STL
+ 1 1 1
+
+
+
+
+
+ 1
+ 1
+ 0 0 0
+ 0
+ 0
+
+
+ 1
+ 0
+ 0
+ 1
+
+ 0
+
+
+
+
+ 0
+ 1e+06
+
+
+ 0
+ 1
+ 1
+
+ 0
+ 0.2
+ 1e+13
+ 1
+ 0.01
+ 0
+
+
+ 1
+ -0.01
+ 0
+ 0.2
+ 1e+13
+ 1
+
+
+
+
+
+
+ 0.001715 0.003779 0.661683 1.5708 -0 0
+
+ 266.27
+
+ 279.51
+ 0
+ 4.6477
+ 43.386
+ 34.265
+ 255.26
+
+ 0.093634 -0.51398 -0.1614 0 -0 0
+
+ 1
+ 0
+ 1
+
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_1.STL
+ 1 1 1
+
+
+
+ 1
+
+
+ __default__
+
+ 0.3 0.3 0.3 1
+ 0.7 0.7 0.7 1
+ 0.01 0.01 0.01 1
+ 0 0 0 1
+
+ 0
+ 1
+
+
+ 0
+ 10
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_1.STL
+ 1 1 1
+
+
+
+
+
+ 1
+ 1
+ 0 0 0
+ 0
+ 0
+
+
+ 1
+ 0
+ 0
+ 1
+
+ 0
+
+
+
+
+ 0
+ 1e+06
+
+
+ 0
+ 1
+ 1
+
+ 0
+ 0.2
+ 1e+13
+ 1
+ 0.01
+ 0
+
+
+ 1
+ -0.01
+ 0
+ 0.2
+ 1e+13
+ 1
+
+
+
+
+
+
+ -0.00025 -0.94659 5.45119 1.5708 -0 0
+
+ 63.612
+
+ 6.6124
+ 0.099584
+ 0
+ 5.9295
+ 0
+ 1.9517
+
+ 0.00756 -3.4862 -0.40714 0 -0 0
+
+ 1
+ 0
+ 1
+
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_3.STL
+ 1 1 1
+
+
+
+ 1
+
+
+ __default__
+
+ 0.3 0.3 0.3 1
+ 0.7 0.7 0.7 1
+ 0.01 0.01 0.01 1
+ 0 0 0 1
+
+ 0
+ 1
+
+
+ 0
+ 10
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_3.STL
+ 1 1 1
+
+
+
+
+
+ 1
+ 1
+ 0 0 0
+ 0
+ 0
+
+
+ 1
+ 0
+ 0
+ 1
+
+ 0
+
+
+
+
+ 0
+ 1e+06
+
+
+ 0
+ 1
+ 1
+
+ 0
+ 0.2
+ 1e+13
+ 1
+ 0.01
+ 0
+
+
+ 1
+ -0.01
+ 0
+ 0.2
+ 1e+13
+ 1
+
+
+
+
+
+
+ -0.068455 0.275759 0.315754 -1.571 -0 0
+
+ 60.795
+
+ 8.1939
+ 0
+ 0
+ 0.76659
+ 0
+ 8.0226
+
+ 0.25344 -1.009 -0.57114 0 -0 0
+
+ 1
+ 0
+ 1
+
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_2.STL
+ 1 1 1
+
+
+
+ 1
+
+
+ __default__
+
+ 0.3 0.3 0.3 1
+ 0.7 0.7 0.7 1
+ 0.01 0.01 0.01 1
+ 0 0 0 1
+
+ 0
+ 1
+
+
+ 0
+ 10
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_2.STL
+ 1 1 1
+
+
+
+
+
+ 1
+ 1
+ 0 0 0
+ 0
+ 0
+
+
+ 1
+ 0
+ 0
+ 1
+
+ 0
+
+
+
+
+ 0
+ 1e+06
+
+
+ 0
+ 1
+ 1
+
+ 0
+ 0.2
+ 1e+13
+ 1
+ 0.01
+ 0
+
+
+ 1
+ -0.01
+ 0
+ 0.2
+ 1e+13
+ 1
+
+
+
+
+
+
+ -0.000257 -3.97477 2.07064 -1.5708 7e-06 3.14159
+
+ 6.6264
+
+ 0.089718
+ 0
+ 0.017666
+ 0.092881
+ 3e-08
+ 0.028564
+
+ -0.028814 0 -2.454 0 -0 0
+
+ 1
+ 0
+ 1
+
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_4.STL
+ 1 1 1
+
+
+
+ 1
+
+
+ __default__
+
+ 0.3 0.3 0.3 1
+ 0.7 0.7 0.7 1
+ 0.01 0.01 0.01 1
+ 0 0 0 1
+
+ 0
+ 1
+
+
+ 0
+ 10
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_4.STL
+ 1 1 1
+
+
+
+
+
+ 1
+ 1
+ 0 0 0
+ 0
+ 0
+
+
+ 1
+ 0
+ 0
+ 1
+
+ 0
+
+
+
+
+ 0
+ 1e+06
+
+
+ 0
+ 1
+ 1
+
+ 0
+ 0.2
+ 1e+13
+ 1
+ 0.01
+ 0
+
+
+ 1
+ -0.01
+ 0
+ 0.2
+ 1e+13
+ 1
+
+
+
+
+
+
+ 0.000743 -4.767 2.06498 -1.5708 7e-06 3.14159
+
+ 5.1229
+
+ 0.038195
+ 4e-07
+ 0
+ 0.066675
+ 6e-07
+ 0.04821
+
+ -0.010371 1e-06 -3.0669 0 -0 0
+
+ 1
+ 0
+ 1
+
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_5.STL
+ 1 1 1
+
+
+
+ 1
+
+
+ __default__
+
+ 0.3 0.3 0.3 1
+ 0.7 0.7 0.7 1
+ 0.01 0.01 0.01 1
+ 0 0 0 1
+
+ 0
+ 1
+
+
+ 0
+ 10
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_5.STL
+ 1 1 1
+
+
+
+
+
+ 1
+ 1
+ 0 0 0
+ 0
+ 0
+
+
+ 1
+ 0
+ 0
+ 1
+
+ 0
+
+
+
+
+ 0
+ 1e+06
+
+
+ 0
+ 1
+ 1
+
+ 0
+ 0.2
+ 1e+13
+ 1
+ 0.01
+ 0
+
+
+ 1
+ -0.01
+ 0
+ 0.2
+ 1e+13
+ 1
+
+
+
+
+
+
+ -2.06426 -5.37015 4.13075 1.88426 1.57078 0.313465
+
+ 0.72893
+
+ 0.00131
+ 0
+ 0
+ 0.0012978
+ 0
+ 0.0024341
+
+ 2.0657 2.0642 -3.5441 0 -0 0
+
+ 1
+ 0
+ 1
+
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_6.STL
+ 1 1 1
+
+
+
+ 1
+
+
+ __default__
+
+ 0.3 0.3 0.3 1
+ 0.7 0.7 0.7 1
+ 0.01 0.01 0.01 1
+ 0 0 0 1
+
+ 0
+ 1
+
+
+ 0
+ 10
+ 0 0 0 0 -0 0
+
+
+ /root/.gazebo/models/fanuc_robotic_arm/meshes/arm_link_6.STL
+ 1 1 1
+
+
+
+
+
+ 1
+ 1
+ 0 0 0
+ 0
+ 0
+
+
+ 1
+ 0
+ 0
+ 1
+
+ 0
+
+
+
+
+ 0
+ 1e+06
+
+
+ 0
+ 1
+ 1
+
+ 0
+ 0.2
+ 1e+13
+ 1
+ 0.01
+ 0
+
+
+ 1
+ -0.01
+ 0
+ 0.2
+ 1e+13
+ 1
+
+
+
+
+
+
+ link_3
+ link_4
+ 0 0 -2.7 0 -0 0
+
+ 0 0 1
+ 0
+
+ -1.79769e+308
+ 1.79769e+308
+ -2000
+ -1
+
+
+ 0
+ 0
+ 0
+ 0
+
+
+
+
+
+ 0
+ 0.2
+
+
+ 0
+ 0.2
+
+
+
+
+
+ link_1
+ link_2
+ 0 -0.41 -0.61 0 -0 0
+
+ 1 0 0
+ 0
+
+ -1.79769e+308
+ 1.79769e+308
+ -2000
+ -1
+
+
+ 0
+ 0
+ 0
+ 0
+
+
+
+
+
+ 0
+ 0.2
+
+
+ 0
+ 0.2
+
+
+
+
+
+ link_2
+ link_3
+ 0 -3.65 -0.6 0 -0 0
+
+ 1 0 0
+ 0
+
+ -1.79769e+308
+ 1.79769e+308
+ -2000
+ -1
+
+
+ 0
+ 0
+ 0
+ 0
+
+
+
+
+
+ 0
+ 0.2
+
+
+ 0
+ 0.2
+
+
+
+
+
+ link_4
+ link_5
+ 0 0 -3.15 0 -0 0
+
+ 1 0 0
+ 0
+
+ -1.79769e+308
+ 1.79769e+308
+ -2000
+ -1
+
+
+ 0
+ 0
+ 0
+ 0
+
+
+
+
+
+ 0
+ 0.2
+
+
+ 0
+ 0.2
+
+
+
+
+
+ base
+ link_1
+ 0 0 0 0 -0 0
+
+ 0 1 0
+ 0
+
+ -1.79769e+308
+ 1.79769e+308
+ -2000
+ -1
+
+
+ 0
+ 0
+ 0
+ 0
+
+
+
+
+
+ 0
+ 0.2
+
+
+ 0
+ 0.2
+
+
+
+
+
+ link_5
+ link_6
+ 2.065 2.065 -3.5 0 -0 0
+
+ 0 0 1
+ 0
+
+ -1.79769e+308
+ 1.79769e+308
+ -2000
+ -1
+
+
+ 0
+ 0
+ 0
+ 0
+
+
+
+
+
+ 0
+ 0.2
+
+
+ 0
+ 0.2
+
+
+
+
+
+ world
+ base
+
+ 0
+ 0
+
+
diff --git a/src/run_rrrobot_image.sh b/src/run_rrrobot_image.sh
index 1aef38e..03739a6 100755
--- a/src/run_rrrobot_image.sh
+++ b/src/run_rrrobot_image.sh
@@ -1,5 +1,5 @@
#docker run -i -h rrrobot-env -t eecs467:rrrobot bash
xhost +local:docker #rrrobot-env
-docker run -it --rm --device=/dev/input/event4 --device=/dev/dri:/dev/dri -e DISPLAY=$DISPLAY -v /tmp/.X11-unix:/tmp/.X11-unix -h rrrobot-env eecs467:rrrobot
+docker run -it --rm --device=/dev/input/event4 --device=/dev/dri:/dev/dri -e DISPLAY=$DISPLAY -v /tmp/.X11-unix:/tmp/.X11-unix -v$PWD/gazebo_models:/root/.gazebo/models -h rrrobot-env eecs467:rrrobot
xhost -local:docker #rrrobot-env