Algorithm to find the global solution to the inverse kinematics based on the KBM structure.
Work in progress.
Parameters
kbm
The already learned KBM representation of a kinematics.
lower
The lower bound of the interval in Cartesian space.
upper
The upper bound of the interval in Cartesian space. Lower and upper bounds should be a target destination plus a desired tolerance, but can be chosen with equal values.
resolution
The granularity of the found solutions (defaults to ).
Returns
The algorithm returns a list of joint angle intervals (the size is specified by the resolution parameters).
This algorithm solves the inverse kinematics globally and numerically by using an interval based version of the forward kinemtatics
which can be subdivided easily because of the linearisation emerging from the KBM model. This means that if there exist more than a single solution, a list of intervals that probably contain a solution. Specifically, this means that the target position lies within the bounding box of the control net of the subdivised kbm. If a sufficient amount of steps has been performed, the solution is garantueed to lie at least close to the desired target. The number of steps can be regulated by the resolution parameter (i.e., ). An interval-based version of this algorithm exists to define this distance in Cartesian space.