frankapy

This is a software package used for controlling and learning skills on the Franka Emika Panda Research Robot Arm.

Installation Instructions and Network Configuration Instructions are also available here: https://iamlab-cmu.github.io/frankapy

To join the Discord community, click the link here.

Requirements

A computer with the Ubuntu 18.04 / 20.04.
ROS Melodic / Noetic
Protocol Buffers

Computer Setup Instructions

This library is intended to be installed on any computer in the same ROS network with the computer that interfaces with the Franka (we call the latter the Control PC). FrankaPy will send commands to franka-interface, which actually controls the robot.

Install ProtoBuf

This is only needed if you plan to modify the proto messages. You don't need to install or compile protobuf for using frankapy

We use both C++ and Python versions of protobufs so you would need to install Protobufs from source.

Do nproc to find out how many cores you have, and use that as the N number in the make command below:

sudo apt-get install autoconf automake libtool curl make g++ unzip
wget https://github.com/protocolbuffers/protobuf/releases/download/v3.11.4/protobuf-all-3.11.4.zip
unzip protobuf-all-3.11.4.zip
cd protobuf-3.11.4
./configure
make -jN
make check -jN
sudo make install
sudo ldconfig

See detailed instructions here

Installation

Clone Repo and its Submodules:

git clone --recurse-submodules git@github.com:iamlab-cmu/frankapy.git

All directories below are given relative to /frankapy.

First source into your virtualenv or conda env (should be Python 3.6). Then:
```
pip install -e .
```
To compile the catkin_ws use the following script:
```
./bash_scripts/make_catkin.sh
```
To allow asynchronous gripper commands, we use the franka_ros package, so install libfranka and franka_ros using the following command (Change melodic to noetic if you are on Ubuntu 20.04:
```
sudo apt install ros-melodic-libfranka ros-melodic-franka-ros
```
To make the protobufs use the following script (you don't need to do this if you haven't modified the proto messages):
```
./bash_scripts/make_proto.sh
```

Configuring the network with the Control PC

Ethernet

If you have an ethernet cable directly between the Control PC and the one sending Frankapy commands, you can go into the Ubuntu Network Connections Menu on the Control PC.
Select the Ethernet connection that corresponds to the port that you plugged the ethernet cable into and then click edit.
Go to the IPv4 Settings Tab and switch from Automatic (DHCP) to Manual.
Add a static ip address like 192.168.1.3 on the Control PC with netmask 24 and then click save.
Then do the same on the FrankaPy PC but instead set the static ip address to be 192.168.1.2.

Wifi

If you are only communicating with the Control PC over Wifi, use the command ifconfig in order to get the wifi ip address of both computers and note them down.

Editing the /etc/hosts file

Now that you have the ip addresses for both the Control PC and FrankaPy PC, you will need to edit the /etc/hosts files on both in order to allow communication between the 2 over ROS.
On the Control PC, run the command: sudo gedit /etc/hosts
If you are using an Ethernet connection, then add the following above the line # The following lines are desirable for IPv6 capable hosts:
```
192.168.1.2     [frankapy-pc-name]
```
Otherwise substitute 192.168.1.2 with the ip address of the FrankaPy PC that you discovered using the command ifconfig.
Afterwards, on the FrankaPy PC, again run the command sudo gedit /etc/hosts and add the line:
```
192.168.1.3     [control-pc-name]
```
Otherwise substitute 192.168.1.3 with the ip address of the Control PC that you discovered using the command ifconfig.
Now you should be able to ssh between the FrankaPy PC and the Control PC using the command:
```
ssh [control-pc-username]@[control-pc-name]
Input password to control-pc.
```

Setting Up SSH Key to Control PC

Generate an ssh key by executing the following commands or reading the instructions here: https://help.github.com/en/articles/generating-a-new-ssh-key-and-adding-it-to-the-ssh-agent
```
ssh-keygen -t rsa -b 4096 -C "your_email@example.com"
[Press enter]
[Press enter]
[Press enter]
eval "$(ssh-agent -s)"
ssh-add ~/.ssh/id_rsa
```
Upload your public ssh key to the control pc.
1. In a new terminal, ssh to the control PC.
```
ssh [control-pc-username]@[control-pc-name]
Input password to control-pc.
```
2. Use your favorite text editor to open the authorized_keys file.
```
vim ~/.ssh/authorized_keys
```
3. In a separate terminal on your Workhorse PC, use your favorite text editor to open your id_rsa.pub file.
```
vim ~/.ssh/id_rsa.pub
```
4. Copy the contents from your id_rsa.pub file to a new line on the authorized_keys file on the Control PC. Then save.
5. Open a new terminal and try sshing to the control PC and it should no longer require a password.
(Optional) Upload your ssh key to github by following instructions here: https://help.github.com/en/articles/adding-a-new-ssh-key-to-your-github-account

Unlocking the Franka Robot

In a new terminal, ssh to the control PC with option -X.
```
ssh -X [control-pc-username]@[control-pc-name]
```
Open a web browser, either firefox or google chrome.
```
firefox
```
Go to 172.16.0.2 in the web browser.
(Optional) Input the username admin and the password to login to the Franka Desk GUI.
Unlock the robot by clicking the unlock button on the bottom right of the web interface.
If the robot has pink lights, press down on the e-stop and then release it and the robot should turn blue. If the robot is white, just release the e-stop and it should also turn blue.

Running the Franka Robot

Make sure that both the user stop and the brakes of the Franka robot have been unlocked in the Franka Desk GUI.
Open up a new terminal and go to the frankapy directory.
```
bash ./bash_scripts/start_control_pc.sh -i [control-pc-name]
```
Please see the start_control_pc.sh bash script for additional arguments, including specifying a custom directory for where franka-interface is installed on the Control PC as well as the username of the account on the Control PC. By default the username is iam-lab.
Open up a new terminal and go to the frankapy directory. Do:
```
source catkin_ws/devel/setup.bash
```
Be in the same virtualenv or Conda env that FrankaPy was installed in. Place your hand on top of the e-stop. Reset the robot pose with the following command.
```
python scripts/reset_arm.py
```

See example scripts in the examples/ and scripts/ to learn how to use the FrankaPy python package.

Citation

If this library proves useful to your research, please cite the paper below::

@article{zhang2020modular,
title={A modular robotic arm control stack for research: Franka-interface and frankapy},
author={Zhang, Kevin and Sharma, Mohit and Liang, Jacky and Kroemer, Oliver},
journal={arXiv preprint arXiv:2011.02398},
year={2020}
}

indraneelpatil/frankapy