|Continuous control functions:||2|
|Interior point equalities:||2|
The Industrial robot problem focuses on the KUKA LWR IV drawing a pre-defined curve on a white board, which results in a path-following problem. This means that a system should be steered along a given path while there are no constraints regarding the position at a specific time . This concept arises often where autonomous vehicles or steering of robots are involved. The source for this problem can be found online on arXiv "Implementation of Nonlinear Model Predictive Path-Following Control for an Industrial Robot".
As the robot should follow a geometric curve but is not constrained as to when it has to be where, a path-following problem arises. The path is given by where “ is called path parameter and is a parametrization of ”. The path parameter does depend on the time however the exact timing is not known beforehand but rather integrated into the optimization problem by making use of a virtual system.
A virtual system is introduced to take care of the timing of the robot. This is an additional degree of freedom which is used here as an input into an integrator. This additional optimization variable, the virtual input, is integrated twice to produce the virtual state which is used as the time parameter for the path (i.e. ).
The virtual state and input are constrained by the sets and respectively.
The system for the motions of the robot are given by the function :
where are given in the Parameters section.
The objective function will be the integral over the so-called cost function , i.e. where is the prediction horizon and the function is given by with positive semi definite matrix and positive definite matrix , which can be found in the original paper cited above.
The path-following is introduced into the problem by optimizing the error measuring the deviation of the robot from the path:
where is the parametrization of as above and is the position of the robot given by:
where and with being the lengths of the links of the robot and is the length of the pen and tool. These values can be found in the Parameters section as well.
The optimization problem which is solved repetitively is given by
The matlab script which implements the implicit formulation for , i.e. can be found on Parameters for Industrial Robot.
The Implementation Parameters for the MPFC scheme are as follows.
There were no citations found in the article.