justagist / panda_robot

A ROS python interface for using the franka robot (requires franka_ros_interface). Simplified control and management API.
https://justagist.github.io/panda_robot
Apache License 2.0
85 stars 17 forks source link
franka-panda-api franka-panda-python franka-ros panda-robot panda-robot-api

Panda Robot Python 2.7, 3.6+ ROS Version

PyPI Codacy Badge

A Python interface package built over the Franka ROS Interface package, combining its different classes to provide a unified interface for controlling and handling the Franka Emika Panda robot. Also works directly with Panda Simulator.

The package provides an extensive and unified API for controlling and managing the Franka Emika Robot (and gripper) using pre-defined low-level controllers (position, velocity, torque, joint impedance), MoveIt planners, and JointTrajectory action service.

NOTE: This version requires Franka ROS Interface v0.7.1 ('master'/'v0.7.1-dev' branch) to be installed. For usage with older versions, use Panda Robot branch v0.6.0 from Github.

Features

DOCUMENTATION: https://justagist.github.io/panda_robot/

vid Watch video here

vid Watch video here

Installation

NOTE: This branch should work with ROS Melodic and ROS Noetic. Tested on:

ROS Version Required Python Version
Melodic 2.7+
Noetic 3.6+

The following dependencies have to be met before installing PandaRobot:

Once the dependencies are installed, the package can be installed either from pypi, or by building from source. Note that the installation may be successful even if the above dependencies are not met, but the package cannot be used until the dependencies are installed.

Install with pip

PyPI

pip install panda-robot

NOTE: This will not check for the required ROS dependencies. They have to be installed as described in the previous section.

Build from source

If you want to install the package from source, you can either clone this repository and run python setup.py install, or build it as a catkin package in your ROS workspace. To build as catkin package:

 catkin build
 source devel/setup.bash

Note: This package is written to be compatible with both Python 2 and 3, so make sure you have the Python future module installed (pip install future).

Usage

Note: If using with a real physical Franka Emika Panda robot, the franka_ros_interface 'driver' should be running in the 'master' environment in one terminal (See Franka ROS Interface instructions for details). Then, any code which uses PandaRobot or Franka ROS Interface should be run in 'master' or 'remote' environment (as appropriate). When using with Panda Simulator, this package can be used directly without the need for any specific environment as long as this package, the simulator package, and Franka ROS Interface packages are in the same ROS workspace, and correctly sourced.

Example: Testing interface in terminal

>> python # or `python3` # start interactive python session; make sure the correct ros workspace is sourced.
>> import rospy
>> from panda_robot import PandaArm
>> rospy.init_node("panda_demo") # initialise ros node

>> r = PandaArm() # create PandaArm instance

>> r.move_to_neutral() # moves robot to neutral pose; uses moveit if available, else JointTrajectory action client

>> pos,ori = r.ee_pose() # get current end-effector pose (3d position and orientation quaternion of end-effector frame in base frame)

>> r.get_gripper().home_joints() # homes gripper joints
>> r.get_gripper().open() # open gripper

>> r.move_to_joint_position([-8.48556818e-02, -8.88127666e-02, -6.59622769e-01, -1.57569726e+00, -4.82374882e-04,  2.15975946e+00,  4.36766917e-01]) # move robot to the specified pose

>> r.move_to_cartesian_pose(pos,ori) # move the robot end-effector to pose specified by 'pos','ori'

See script (test/test_pos_controllers.py) to see how the robot can be controlled using low-level joint controllers.

See script (scripts/env.py), and run it interactively (python -i env.py) for testing other available functionalities.

See other files in the tests and demos directories for more usage examples.

Learn about all available functionalities in the Documentation.

License

License

Copyright (c) 2019-2021, Saif Sidhik

If you use this software for research, please considering citing using DOI.