How to Build a Simulated Robot Arm Using ROS

In the previous tutorial, we built a simulated mobile robot base from scratch. Now I want to create a robotic arm that I will eventually attach to this base so that I have a complete mobile manipulator. Here is what we will build:

robot-arm-gif

This tutorial would not have been possible without Ramkumar Gandhinathan and Lentin Joseph’s awesome book ROS Robotics Projects Second Edition (Disclosure: As an Amazon Associate I earn from qualifying purchases). I highly recommend it if you want to learn ROS 1. Many of the files (URDF, configuration, and STL files), come from their book’s public GitHub page.

Real-World Applications

This project has a number of real-world applications: 

  • Indoor Delivery Robots
  • Order Fulfillment
  • Factories
  • Warehouses
  • Space Exploration
  • Power Plants

Let’s get started!

Prerequisites

  • You have completed this tutorial where you learned how to create a mobile robot base.

Build the Robot Arm

Open a new terminal window.

Move to the urdf folder of your package.

roscd mobile_manipulator_body/urdf/

Now create a file named robot_arm.urdf.

gedit robot_arm.urdf

Add the robot_arm.urdf code inside there.

Save and close the file.

Test the Robot Arm

Now let’s launch the robot arm.

Open a new terminal window, and go to the package.

roscd mobile_manipulator_body/urdf/
roslaunch urdf_tutorial display.launch model:=robot_arm.urdf

Change the Fixed Frame to world.

Here is how the robot looks.

1-robot-arm-launch-test-1

Move the arm using the sliders. 

2-sliders

Here are the active ROS topics.

rostopic list
1a-rostopic-list

Press CTRL + C in all open terminal windows to close everything down.

Now, let’s set up the configuration parameters for the controllers.

Open a new terminal window.

Go to the config file of your package.

roscd mobile_manipulator_body/config/

Now create a file named arm_control.yaml.

gedit arm_control.yaml

Add the arm_control.yaml code inside there.

Save and close the file.

Now create a file named joint_state_controller.yaml.

gedit joint_state_controller.yaml

Add the joint_state_controller.yaml code inside there.

Save and close the file.

Launch the Robot Arm

Now let’s launch the robot arm.

Open a new terminal window, and go to the package.

roscd mobile_manipulator_body/launch/

Create a new launch file.

gedit arm_gazebo_control.launch

Add the arm_gazebo_control.launch code inside there.

Save and close the file.

Now let’s launch the robot in Gazebo.

Open a new terminal window.

Move to your catkin workspace.

cd ~/catkin_ws/
roslaunch mobile_manipulator_body arm_gazebo_control.launch

Here is how the robot arm looks.

4-robot-arm-gazebo

Here are the active ROS topics.

rostopic list
5-ros-topic-list

Open a new terminal, and type this command to move the robot arm a little bit:

rostopic pub /arm_controller/command trajectory_msgs/JointTrajectory '{joint_names: ["arm_base_joint","shoulder_joint", "bottom_wrist_joint", "elbow_joint","top_wrist_joint"], points: [{positions: [-0.1, 0.5, 0.02, 0, 0], time_from_start: [1,0]}]}' -1
6-after-publishing-command

Type this command to bring the robot back to the home position.

rostopic pub /arm_controller/command trajectory_msgs/JointTrajectory '{joint_names: ["arm_base_joint","shoulder_joint", "bottom_wrist_joint", "elbow_joint","top_wrist_joint"], points: [{positions: [0, 0, 0, 0, 0], time_from_start: [1,0]}]}' -1

References

ROS Robotics Projects Second Edition


How to Build a Simulated Mobile Robot Base Using ROS

In this tutorial, we will build a mobile robot base from scratch using ROS. In a future post, I will add a robotic arm to this base so that we have a complete mobile manipulator. By the end of this post, you will have a robot that looks like this:

6-robot-base-gif

This tutorial would not have been possible without Ramkumar Gandhinathan and Lentin Joseph’s awesome book ROS Robotics Projects Second Edition (Disclosure: As an Amazon Associate I earn from qualifying purchases). I highly recommend it if you want to learn ROS 1. Many of the files (URDF, configuration, and STL files), come from their book’s public GitHub page.

Real-World Applications

This project has a number of real-world applications: 

  • Indoor Delivery Robots
  • Order Fulfillment
  • Factories
  • Warehouses
  • Space Exploration
  • Power Plants

Let’s get started!

Prerequisites

Install ROS Packages

Let’s begin by installing some packages that we will need to accomplish our objective.

sudo apt-get install ros-noetic-ros-control
sudo apt-get install ros-noetic-ros-controllers
sudo apt-get install ros-noetic-gazebo-ros-control

Create a ROS Package

Create a ROS package.

In a new terminal window, move to the src (source) folder of your workspace.

cd ~/catkin_ws/src

Now create the package.

catkin_create_pkg mobile_manipulator_body std_msgs roscpp rospy
cd ~/catkin_ws/
catkin_make --only-pkg-with-deps mobile_manipulator_body

Create Folders

Open a new terminal window.

Move to your package.

roscd mobile_manipulator_body

Create these four folders.

mkdir config launch meshes urdf

Build the Base of the Robot

Now move to your meshes folder.

cd meshes

Go to this link, and download all the mesh files. 

Put the mesh files into your meshes folder inside your mobile_manipulator_body package.

Check to see all the files are in there.

dir
1-dir-mesh-files

Move to the urdf folder.

cd ..
cd urdf

Create a file named robot_base.urdf. In this file, we will define the four wheels of the robot and the base (i.e. five different “links”. Links are the rigid parts of the robot).

gedit robot_base.urdf

Copy this code for robot_base.urdf into that file. 

Save and close the file.

Now, let’s launch RViz to see what our robot looks like so far.

roscd mobile_manipulator_body/urdf/
roslaunch urdf_tutorial display.launch model:=robot_base.urdf
2-robot-base

Move the wheels using the sliders. 

3-gui

Press CTRL + C in all open terminal windows to close everything down.

Now, let’s set up the configuration parameters for the controllers.

Open a new terminal window.

Go to the config file of your package.

roscd mobile_manipulator_body/config/

Now create a file named control.yaml.

gedit control.yaml

Add the control.yaml code inside there.

Save and close the file.

Launch the Base of the Robot

Now let’s launch the base of the robot.

Open a new terminal window, and go to the package.

roscd mobile_manipulator_body/launch/

Create a new launch file.

gedit base_gazebo_control.launch

Add the code for base_gazebo_control.launch inside there.

Save and close the file.

Now let’s launch the robot in Gazebo.

Open a new terminal window.

Move to your catkin workspace.

cd ~/catkin_ws/
roslaunch mobile_manipulator_body base_gazebo_control.launch

Here is how the robot looks.

4-robot-base

Here are the active ROS topics.

rostopic list

You can steer the robot by opening a new window and typing:

rosrun rqt_robot_steering rqt_robot_steering

You will need to change the topic inside the GUI to:

/robot_base_velocity_controller/cmd_vel

6-rqt-steering

To see the velocity messages, open a new window and type:

rostopic echo /robot_base_velocity_controller/cmd_vel
7-ros-topic-list-velocity-cmd

References

ROS Robotics Projects Second Edition

What is an Occupancy Grid Map?

In this tutorial, I will teach you what an occupancy grid map is. If you work in ROS long enough, you will eventually learn how to build an occupancy grid map

In this post, I built an occupancy grid map from scratch to enable a robot to navigate safely around a room.

Real-World Applications

This project has a number of real-world applications: 

  • Indoor Delivery Robots
  • Mapping of Underground Mines, Caves, and Hard-to-Reach Environments
  • Robot Vacuums
  • Order Fulfillment
  • Factories

What is a Grid Map?

Imagine you want to create a robot to navigate across a factory floor. In order to navigate from one point to another with precision, the robot needs to have a map of the floor. We can represent the factory floor as a grid composed of, for example, 1 meter x 1 meter cells. The grid has a horizontal axis (i.e. x axis) and a vertical axis ( y axis).

The image below is an example grid map of a factory floor. The big objects within the grid are obstacles (e.g. shelves). 

1-grid-mapJPG
An overhead view of a factory floor represented abstractly as a grid map with 1 meter x 1 meter cells.

The cool thing about a grid map is that we can determine what is in each cell by looking up the coordinate. For example, we can see in the image above that a shelf is located at (x=6, y=8). Therefore, that cell is occupied. However, open factory floor is located at (x=3, y=3). That cell is not occupied.

We can use a grid map to abstractly represent any indoor environment, including a house, apartment, and office. A robot’s position in the environment at any given time is relative to the corner of the map (x=0, y=0). 

Knowing what part of a factory floor is open space and what part of a factory floor contains obstacles helps a robot properly plan the shortest, collision-free path from one point to another.

One other thing we need to keep in mind is that I assumed the map above has 1 meter spacing between each grid cell. For example, let’s say a robot’s location in the real world is recorded as (3.5, 4.3). On the grid cell, this location would correspond to cell (x=3, y=4) because the grid map is 1 meter resolution. 

But what if we wanted to change the map resolution to 0.1 meter spacing between each grid cell? Let’s suppose the robot reported its location as (3.5, 4.3). What would the corresponding location be on the grid map?

(3.5 * (1 cell/0.1 meters), 4.3 * (1 cell/0.1 meters)) = (35, 43)

Thus, for a 0.1 resolution grid map, a robot that reports its position as (3.5, 4.3) corresponds to a grid map location of (35, 43).  

What is an Occupancy Grid Map?

In an occupancy grid map, each cell is marked with a number that indicates the likelihood the cell contains an object. The number is often 0 (free space) to 100 (100% likely occupied). Unscanned areas (i.e. by the LIDAR, ultrasonic sensor, or some other object detection sensor) would be marked -1.

For example, consider the map below.

2-grid-mapJPG

An occupancy grid map might look like the image below. Note the robot is in blue, and the LIDAR is the red square. The black lines are laser beams.

3-occupancy-grid-mapJPG

That’s it. Keep building!