How to Build a 2 DOF Robotic Arm

cover-robotic-arm-2dof

In this section, we’ll take a look at how to build a two degree of freedom robotic arm. The robot we’ll develop will be an early prototype of a SCARA robot.

Special shout out to Professor Angela Sodemann for this project idea. She is an excellent teacher (She runs a course on RoboGrok.com).  While she uses the PSoC in her work, I use Arduino since I’m more comfortable with this platform. Angela is an excellent teacher and does a fantastic job explaining various robotics topics over on her YouTube channel.

2dof-robotic-arm-sweep-gif

Real-World Applications

scara-robot-packaging-cookies
A SCARA robot packaging cookies into trays. Photo Credit: Gfycat.

SCARA robots are popular in small-scale manufacturing and logistics applications. They are some of the fastest and cheapest robots for pick and place tasks (picking up an object in one location and placing it in another). You can find lots of videos on the Internet showing SCARA robots in action.

The motors we’ll use in this project have a range from 0 to 180 degrees. We want to be able to send commands to the robotic arm so that the servos move to specific angles within this range. This project will be used in my future tutorials on forward kinematics and inverse kinematics.

Forward kinematics asks the question: Where is the end effector of a robot (e.g. gripper, hand, vacuum suction cup, etc.) located in space given that we know the angles of the servo motors? The opposite of forward kinematics is inverse kinematics. 

Inverse kinematics asks, what should the angles of the servo motors be if we want the end effector to be located at a particular point in space? In a future tutorial, we’ll also learn about inverse kinematics.

Prerequisites

You Will Need

This section is the complete list of components you will need for this project.

Set Up the Initial Hardware

Lay out all the parts out on the table like this:

1-lay-out-all-parts-out-on-table

Grab your centimeter grid dry erase board and the two C-clamps.

2-grab-centimeter-grid-dry-erase-board

Clamp down the dry erase board on a hard surface, like a table.

3-clamp-down

Mark four holes on the dry erase board using a screwdriver or some other sharp object.

Using the drill, make four 3MM diameter holes like this.

4-four-3mm-diameter-holes

Draw 10 lines on your board…5 lines on one side and 5 lines on the other side. Each line needs to be 15 degrees apart (use the protractor to measure the angle).

5-draw-10-lines

You can use some tape and a permanent marker to make sure the lines are permanently on there and are straight.

Grab four M3 x 10mm screws.

Put the screws up through the bottom of the board via the holes.

6-up-through-bottom

Grab four 20mm standoffs and screw them on top of the screws.

7-screw-standoffs-on-top
8-screws-standoffs

Take one 35kg  servo motor and place it on top of the standoffs.

Grab four 20mm M3 screws and use these screws to secure the servo motor into the standoffs. The screws don’t need to be super tight…just tight enough so that the servo stays in one place.

9-add-servo-motor
10-add-servo-motor

Grab a servo horn and attach it to the servo gear. 

11-add-servo-horn

Grab the 6 Channel Digital Servo Tester and either a DC Variable Power Supply or 4 AA Batteries with Battery holder.

12-digital-servo-tester

Plug the negative (black) lead of the power supply into the negative (-) socket of the 6 Channel Digital Servo Tester. I connected the black alligator clip coming from the power supply to a male-to-male jumper wire. You will have to unscrew the screw in the blue dongle from the top, and then slip the male-to-male jumper wire in the bottom. Then retighten the screw.

Plug the positive (red) lead of the power supply into the positive (+) socket of the 6 Channel Digital Servo Tester.

13-setup-digital-servo-tester

Plug the servo motor into one of the 3 header pin units on top of the 6 Channel Digital Servo Tester. The yellow wire should plug into S, red wire should plug into positive (+), and brown wire should plug into negative (-).

14-plug-in-servo-to-tester

Turn on the DC power supply and set the voltage to 6V and the current limit to 1A.

Using the corresponding knob on the Digital Servo Tester, Rotate the servo horn as far as it can go in the clockwise direction. This is the 0 degree position (Note: if you press the little button under the knob, the servo will go to the 90 degree (center) position).

Take the servo horn off.

Place the servo horn back on the servo gear so that the two holes on either side of the servo horn are just a bit beyond perfectly horizontal.

15-just-beyond-horizontal

Grab a servo screw and secure the servo horn on to the servo gear.

Grab a beam mount.

Attach the beam mount (i.e. robot arm “link”) to the servo horn using two small M3 x 4mm screws.

16-attach-beam-mount

This motor, Joint 1 (also known as Servo 0), is now calibrated and complete. If you want to, you can add two more screws to the servo horn so that there are 4 screws that secure the beam mount to the servo horn.

17-is-now-calibrated

Now, let’s add the second servo motor. We’ll call this second joint Servo 1.

Grab a multi-functional servo bracket.

Grab two M3 x 6mm screws and two M3 nuts.

Secure the multi-functional servo bracket into the beam mount.

18-secure-multifunctional-servo-bracket

Grab a 35kg servo and place it into the multi-functional servo bracket.

Grab four M3 x 8mm screws and four M3 nuts.

Secure the servo into the multi-functional servo bracket.

19-secure-servo

Grab a servo horn, and place it on the gear of the servo.

Secure the servo horn with a servo screw.

Grab a beam mount and two M3 x 4mm screws. Secure the beam mount to the servo horn.

20-secure-beam-mount

Place the three pins of this second servo into the corresponding pins of the 6 Channel Digital Servo Tester.

Adjust the position of the beam mount so that when the servo is in the middle of its range, the beam mount points straight to the right (i.e. when you press the center button under the corresponding knob on the 6 Channel Digital Servo Tester, the beam mount should point straight to the right).

21-beam-mount-pointing-right

Once you’re happy with the alignment, use two M3 x 4mm screws to secure the beam mount to the horn even further.

22-beam-mount-pointing-right
23-beam-mount-pointing-right

Our robotic arm now has the following components (two joints and four links):

  • Joint 1 – The bottom servo motor (goes from 0 degrees to 180 degrees).
  • Link 1 – Extends from the top of the dry erase board to the top of the servo horn of Joint 0.
  • Link 2 – Extends from the middle of the servo horn of Joint 1 to the end of the beam mount (i.e. specifically, to the center of the big central circle on the end of the beam mount).
  • Joint 2 – The top servo motor (goes from -90 degrees to 90 degrees…I’ll explain why we define the angle range like this when we learn about drawing kinematic diagrams in a future tutorial).
  • Link 3 – Extends from the beam mount to the top of the servo horn of Joint 2.
  • Link 4 – Extends from the middle of the servo horn of Joint 2 to the end of the beam mount 

Here is the kinematic diagram for this robot. Don’t worry if you don’t understand it. We’ll learn how to create this in a future post.

24-kinematic-diagram

Move Servos

In this section, we’ll get the servos moving. We’ll use the setup in the kinematic diagram above.

Wire the Servos

Follow this pdf diagram to wire up your servos.

Turn on your DC power supply and set it to 6V with a 2A current limit (i.e. 1A per servo). 

Plug the red and black leads of the power supply into the red and blue power rails of the breadboard. If you’re using 4xAA batteries, you can plug the leads into the breadboard now.

Write the Code for the Arduino Mega

Write the following code and load it to your Arduino. This code sweeps the two servos 180 degrees, going from the most clockwise position to the most counterclockwise position over and over again.

/*
Program: Sweep 2 Servos Using Arduino
File: sweep_servos_2dof.ino
Description: This program sweeps two servos (i.e. joints) 180 degrees, going from
  the most clockwise position to the most counterclockwise position.
  Note that Servo 0 = Joint 1 and Servo 1 = Joint 2.
Author: Addison Sears-Collins
Website: https://automaticaddison.com
Date: August 16, 2020
*/
 
#include <VarSpeedServo.h> 

// Define the number of servos
#define SERVOS 2

// Create the servo objects.
VarSpeedServo myservo[SERVOS]; 

// Speed of the servo motors
// Speed=1: Slowest
// Speed=255: Fastest.
const int desired_speed = 75;

// Attach servos to digital pins on the Arduino
int servo_pins[SERVOS] = {3,5};

void setup() {
  
  // Attach the servos to the servo object 
  // attach(pin, min, max  ) - Attaches to a pin 
  //   setting min and max values in microseconds
  //   default min is 544, max is 2400  
  // Alter these numbers until both servos have a 
  //   180 degree range.
  myservo[0].attach(servo_pins[0], 544, 2475);  
  myservo[1].attach(servo_pins[1], 500, 2475); 

  // Set initial servo positions 
  myservo[0].write(0, desired_speed, true);  
  myservo[1].write(calc_servo_1_angle(90), desired_speed, true);

  // Wait one second to let servos get into position
  delay(1000);
}
 
void loop() {  

    // To most counterclockwise position
    myservo[0].write(180, desired_speed, true); 

    // Go to clockwise position
    myservo[1].write(calc_servo_1_angle(-90), desired_speed, true); 
    
    // Go to counterclockwise position
    myservo[1].write(calc_servo_1_angle(90), desired_speed, true); 

    // To most clockwise position
    myservo[0].write(0, desired_speed, true); 

    // Wait half a second
    delay(500);
}     

/*  This method converts the desired angle for Servo 1 into a control angle
 *  for Servo 1. It assumes that the 0 degree position on the kinematic
 *  diagram for Servo 1 is actually 90 degrees on the actual servo.
 *  The angle range for Servo 1 on the kinematic diagram is
 *  -90 to 90 degrees, with 0 degrees being the center position. 
 *  The actual servo range for the physical motor
 *  is 0 to 180 degrees. We convert the desired angle 
 *  to a value within that range.
 */
int calc_servo_1_angle (int input_angle) {
  
  int result;

  result = map(input_angle, -90, 90, 0, 180);

  return result;
}  

Sweep and Calibrate the Servos

Run the code so that your servos start moving. Servo 0 (i.e. Joint 1) will rotate counterclockwise from 0 degrees to 180 degrees, then Servo 1 (i.e. Joint 2) will rotate clockwise from 90 degrees to -90 degrees. Then Servo 0 will rotate clockwise, back to the 0 degree position where it started. 

You should see the same motion as in the animated gif image at the beginning of this tutorial.

You need to calibrate the servos so that the servos are aligned with the 0 degrees (i.e. +x axis) and 180 degrees (-x axis) on the dry erase board. In order to do that, you need to alter the minimum value of 544 microseconds and/or maximum value of 2400 microseconds of the pulse width for each servo until you align with the axes on the board. I recommend starting with the first servo (i.e. servo 0 which is attached to the board), and then calibrate the second servo (i.e. servo 1).

As the robotic arm sweeps back and forth, you see that the end-effector (the top beam mount) changes position (x and y coordinate) and orientation (i.e. the angle that the end-effector makes with the positive x-axis).

Position + orientation are known collectively as pose

With a robotic arm, it is not enough to know where the end of the robotic arm (e.g. gripper) is located in space via its x, y, and z coordinates…you also need to know the direction the end of the robotic arm is pointing towards (i.e. orientation). 

Consider, for example, a robotic arm with a paint sprayer at the end. We want the robotic arm to paint a car. We need to direct the arm to the appropriate position, and we need to make sure the angle of the arm is oriented in a way that directs the sprayer towards the place on the car’s surface you want to paint. 

painting-robot

In a future post, we will learn how to calculate the position and orientation of a robotic arm, so stay tuned!