Kinematics and Path Planning for Franka Panda Robot Arm

This repo has the implementation of basic forward/inverse kinematics, and the RRT path planning for the Franka Robot Arm.

Kinematics: It contains the URDF & DH forward kinematics and the inverse kinematics algorithm for the Franka Robot Arm. It also has the implementation of the separating axis theorem to avoid collision.
Path Planning: It contains the Rapidly-exploring Random Trees (RRT) for the Franka robot to reach the target pose without collision with the obstacles. It also has the implementation of the planning with constraints using Projection Sampling.

This is the rViz Visualization of Franka robot, surrounding walls, and an obstacle. You will see this visualization after RRT has found a plan

The Constrained RRT planning algorithm is as below:

Here shows the demo video of both RRT and Constrained RRT for the Franka Robot in the simulation.

Installation

For Ubuntu 16.04:

Install ROS Kinetic on your computer following instructions here: [http://wiki.ros.org/ kinetic/Installation/Ubuntu.](http://wiki.ros.org/ kinetic/Installation/Ubuntu. ) (Make sure to install the Desktop-Full Install version of ROS Kinetic.)
Install libfranka and franka_ros using the following command:

sudo apt install ros-kinetic-libfranka ros-kinetic-franka-ros
Install all requirements.

pip install -r requirements.txt
Change the path argument in visualize.launch to the path to your working folder.