Skip to content

A python package to solve robot arm inverse kinematics in symbolic form

License

Notifications You must be signed in to change notification settings

longjie0723/IKBT

 
 

Repository files navigation

IKBT

A python based system for generating closed-form solutions to the manipulator inverse kinematics problem using behavior trees for action selection.

Current News

May 2019

BH is working on a new implementation of the solution graph and generating the list of solutions (much trickier that it seems at first!). I've taken this work to a private repo fork to decluter this page, but will merge and commit shortly. This work is aimed at issues #15 and #18. Thanks to you new issue posters!

Aug 2018

Sum-of-Angles transform now works for the case of three angles (corresponds to three parallel axes in the mechanism). IKBT can now solve the UR5 and similar robots!

IKBT Overview

Our contributions to automate closed-form kinematics solving are:

  1. We built an autonomous inverse kinematics solver (IKBT) using a behavior tree to organize solution algorithms.
  2. We incorporated knowledge frequently used (by human experts) when solving inverse kinematics into a behavior tree. These rule-based solvers applicable to any serial-chain, non-redundant, robot arm.
  3. IKBT generates a dependency {\it graph} of joint variables after solving, generating all possible solutions.
  4. IKBT provides convenience features such as automatic documentation of the solution in \LaTeX and automatic code generation in Python and C++.
  5. Implementation in a modern open-source, cross-platform, programming language (Python) with minimal dependencies outside of the standard Python distribution ({\tt sympy}).

Videos

Details

How to cite:

Zhang, Dianmu, and Blake Hannaford. "IKBT: solving closed-form Inverse Kinematics with Behavior Tree." arXiv preprint arXiv:1711.05412 (2017).

http://arxiv.org/abs/1711.05412

Installation Dependencies

You need the following to be installed to run IKBT:

Tested robots, DH parameters & other technical details to reproduce the results

A list of all DH parameters tested in the paper: ['Puma', 'Chair_Helper', 'Wrist', 'MiniDD', 'Olson13','Stanford', 'Sims11', 'Srisuan11', 'Axtman13', 'Mackler13', 'Minder13', 'Palm13', 'Parkman13', 'Frei13', 'Wachtveitl', 'Bartell', 'DZhang', 'Khat6DOF'.]

We suggest you first run the Wrist since it is relatively fast:

python ikSolver.py Wrist

To solve your own problem open the file ikbtfunctions/ik_robots.py and create an entry for your robot. You should copy an entry for an existing robot and edit it's entries. Create an "unknown" for each joint variable and package them into the vector "variables". Enter the DH parameters in matrix form. Also, enter the name of your robot into the list of valid names (ikbtfunctions/ik_robots.py, line 31).

DH parameters explained: The vector "vv" encodes whether each joint is rotary (1) or prismatic (0). If your robot is less than 6 DOF, create empty rows: [ 0 , 0, 0, 0 ], in the DH table so that it has six rows. Many standard symbols in robot kinematics are pre-defined for you but if you use any new ones, be sure to define them using sp.var(). See "Wrist" for an example in which the three joint variables "A, B, C" are set up for sympy by sp.var('A B C'). "pvals" is where you can put in the numerical values for all parameters, for result verification purposes.

Pre-computed forward kinematics.

Sometimes computation of the forward kinematic equations (and their subsequent simplification) can be time consuming. When debugging an inverse kinematics solution (for example modifying the BT), it can slow the cycle if these have to be redone each time. Therefore, the software has a mechanism using Python "pickle" files, to cache the forward kinematics computation and not repeat it. Forward kinematics pickle files are stored in the directory fk_eqns/. This directory will be automatically created if you don't have it. In some cases you may have to delete the pickle file for your robot. To do that, >rm fk_eqns/NAME_pickle.p. IKBT will generally tell you when you should do this, but it is OK to just >rm -rf fk_eqns/ .

About

A python package to solve robot arm inverse kinematics in symbolic form

Resources

License

Stars

Watchers

Forks

Packages

No packages published

Languages

  • Python 98.5%
  • TeX 1.5%