Published December 21, 2018 © MIT

Arduino Robot Arm Follow Your Movement with Tactigon

We wanted to use The Tactigon ONE and T-Skin to move a Arduino One base robot arm and have it follow our movements. Rasberry is central unit

AdvancedFull instructions providedOver 6 days2,845

Things used in this project

Hardware components

The Tactigon One

The Tactigon Skin (T-SKIN)

Arduino UNO

ARDUINO UNO REV3 CON ATMEGA328

Raspberry Pi 3 Model B

Arduino MotorShield Rev3

SHIELD ARDUINO CONTROLLO SERVO RC

Bluetooth Low Energy (BLE) Module (Generic)

The Arduino UNO, on its side, does not have Bluetooth Low Energy communication, so we used an HC-05 module for this purpose.

Software apps and online services

Arduino IDE

Story

Introduction

Hello! We made this project since we wanted to use The Tactigon ONE and T-Skin to move a robotic arm and have it follow our movements, like a shadow. By using two Tactigon ONEs (one on the arm and another on the forearm) along with a T-Skin (worn on the hand), we made this possible! Other devices we used are a Raspberry Pi 3, an Arduino UNO, a BLE and a servo shield, and obviously, a robotic arm.

Tactigon Skin Product is compatible with Arduino SDK

Hardware Architecture

Lots of devices are connected here, so a little picture helps this:

Hardware Architecture: Robotic Arm with Arduino UNO, BLE Module and RC shield.

Simple Arduino UNO board. We used to control Robot Arm made in Italy

The Raspberry Pi 3 plays a fundamental role: it runs handle inputs from the human arms, translates it in servos' positions and then send the new position to the robotic arm. Nice!

The Arduino UNO, on its side, does not have Bluetooth Low Energy communication, so we used an HC-05 module for this purpose.

The robotic arm is equipped with Arduino UNO board and a Bluetooth Low Energy shield, with whom receives new servos positions, and a "servo shield" which allows to uncouple Arduino UNO power supply from servos power supply, and so use high torque servos without draining current over the microcontroller's limit.

First Integration

The first step was to assemble few cardboards to resemble an arm: 2 joints to emulate elbow and wrist. This was to speed up tests, and avoid unwanted movement of the arm.

A simple Robot Arm with Arduino UNO board and Bluetooth Low Energy

After this step, we designed a little case with our favourite CAD and printed it out.

Our 3D Printed (half) Case

Fabiano working on the system

Software Architecture

Now that we know how our nodes are linked, we can analyze the software running on each of them.

Tactigon ONE and T-Skin

They run an Arduino Sketch which process IMU's data and transform to Quaternions. This data is then published over Bluetooth Low Energy.

Raspberry Pi

The Raspberry Pi is running a Python script which uses 3 threads to communicate with Tactigon ONEs and T-Skin (T1, T2 and T3), a thread (T4) to handle all connections (and reconnect if needed), one for the UI (T5), and one (T6) to send servo positions to the robotic arm. T1 to T3 process data from quaternions to an angle, the new position of the arm.

Thread structure of Python Script running on Raspberry Pi

Arduino UNO and Robotic Arm

The board Arduino UNO installed in Robotic arm is running an Arduino Sketch too, which receives servo positions and applies to its servos We used Arduino RC servo shield board compatible with Arduino UNO.

Conclusions

This shadow robotic arm based on Arduino UNO is awesome since it can replicate human's movements with an higher torque (well, not the small unit we used in this test tho!).

Next step is to make it able to learn the movements, optimize them and replicate endlessly for Industry 4.0 purpose.

Robot Arm

#include <Braccio.h>
#include <Servo.h>



#define pump  2
#define valve 4


Servo base;
Servo shoulder;
Servo elbow;
Servo wrist_rot;
Servo wrist_ver;
Servo gripper;



// the setup function runs once when you press reset or power the board
void setup() {
  // initialize digital pin LED_BUILTIN as an output.
  pinMode(pump, OUTPUT);
  pinMode(valve, OUTPUT);

  digitalWrite(pump, HIGH);
  digitalWrite(valve, HIGH); //HIGH SUCCHIO  LOW RILASCIO

  //For each step motor this set up the initial degree


  Braccio.begin();
}

void loop() {
  //vado in posizione A
  Braccio.ServoMovement(40, 120, 110, 90, 100, 90, 90); 
  Braccio.ServoMovement(40, 120, 60, 90, 100, 90, 90);
  delay(500);
  Braccio.ServoMovement(40, 120, 60, 90, 100, 90, 90);
  Braccio.ServoMovement(40, 120, 60, 100, 100, 90, 90);
  //mi abbasso e dico no no  
  Braccio.ServoMovement(10, 120, 60, 100, 50, 90, 90);      //no no
  Braccio.ServoMovement(10, 120, 60, 100, 150, 90, 90); 
  Braccio.ServoMovement(10, 120, 60, 100, 50, 90, 90); 
  Braccio.ServoMovement(10, 120, 60, 100, 90, 90, 90);   
  delay(1000);
  // vado in posizione B e mi abbasso
  Braccio.ServoMovement(40, 120, 110, 90, 100, 90, 90); 
  Braccio.ServoMovement(40, 70, 60, 90, 90, 90, 90);  
  Braccio.ServoMovement(40, 70, 60, 110, 90, 90, 90); 
  //faccio partire la pompa
  digitalWrite(valve, HIGH);
  digitalWrite(pump, LOW);
  delay(1000);
  //mi alzo
  Braccio.ServoMovement(40, 70, 60, 90, 90, 90, 90);  
  Braccio.ServoMovement(40, 70, 110, 90, 90, 90, 90); 
  Braccio.ServoMovement(40, 70, 110, 90, 50, 90, 90);

  //Vado in posizione A  
  delay(1000);
  Braccio.ServoMovement(40, 120, 110, 90, 100, 90, 90); 
  Braccio.ServoMovement(40, 120, 60, 90, 100, 90, 90);
  delay(500);
  // mi abbasso
  Braccio.ServoMovement(40, 120, 60, 110, 100, 90, 90);
  //spengo la pompa 
  digitalWrite(valve, LOW);
  digitalWrite(pump, HIGH);
  delay(1000);
  //mi alzo
  Braccio.ServoMovement(40, 120, 90, 90, 100, 90, 90);
  Braccio.ServoMovement(40, 120, 90, 90, 90, 90, 90);

  //Vado in posizione B
  delay(1000);
  Braccio.ServoMovement(40, 70, 60, 80, 90, 90, 90);  
  Braccio.ServoMovement(40, 70, 60, 100, 90, 90, 90); 
  //Mi abbasso
  delay(1000);
  //e dico no no
  Braccio.ServoMovement(10, 70, 60, 100, 50, 90, 90);   //no no
  Braccio.ServoMovement(10, 70, 60, 100, 150, 90, 90);
  Braccio.ServoMovement(10, 70, 60, 100, 50, 90, 90);
  Braccio.ServoMovement(10, 70, 60, 100, 90, 90, 90);
  //Wait 1 second
  delay(1000);
  //mi rialzo e vado in posizione A
  Braccio.ServoMovement(40, 120, 110, 90, 100, 90, 90); 
  Braccio.ServoMovement(40, 120, 60, 90, 100, 90, 90);
  delay(500);
  //mi abbasso
  Braccio.ServoMovement(40, 120, 60, 90, 100, 90, 90);
  Braccio.ServoMovement(40, 120, 60, 110, 100, 90, 90);
  //e faccio partire la pompa
  digitalWrite(valve, HIGH);
  digitalWrite(pump, LOW);
  delay(1000);
  //mi alzo
  Braccio.ServoMovement(40, 120, 90, 90, 100, 90, 90);
  Braccio.ServoMovement(40, 120, 90, 90, 90, 90, 90);
  

  //Wait 1 second
  delay(1000);
  //vado in pos B
  Braccio.ServoMovement(40, 70, 60, 90, 90, 90, 90);  
  Braccio.ServoMovement(40, 70, 60, 110, 90, 90, 90); 
  digitalWrite(valve, LOW);
  digitalWrite(pump, HIGH);
  //dico no no
  delay(1000);
  Braccio.ServoMovement(40, 70, 60, 90, 90, 90, 90);  
  Braccio.ServoMovement(40, 70, 110, 90, 90, 90, 90); 
  Braccio.ServoMovement(40, 70, 110, 90, 50, 90, 90);
  //Wait 1 second

}

Credits

Massimiliano

29 projects • 115 followers

I'm an engineer and I like robotics, embedded systems and linux. I spent a lot of time in automation and firmware development.

Arduino Robot Arm Follow Your Movement with Tactigon

Things used in this project

Hardware components

Software apps and online services

Story

Introduction

Hardware Architecture

First Integration

Software Architecture

Conclusions

Code

Robot Arm

Credits

Massimiliano

Comments

Embed the widget on your own site

Arduino Robot Arm Follow Your Movement with Tactigon

Arduino Robot Arm Follow Your Movement with Tactigon

Things used in this project

Hardware components

Software apps and online services

Story

Introduction

Hardware Architecture

First Integration

Software Architecture

Conclusions

Code

Robot Arm

Credits

Massimiliano

Comments

Related channels and tags