-
Notifications
You must be signed in to change notification settings - Fork 14
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
- Loading branch information
Showing
6 changed files
with
133 additions
and
6 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,123 @@ | ||
<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "https://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd"> | ||
<html xmlns="http://www.w3.org/1999/xhtml" lang="en-US"> | ||
<head> | ||
<meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/> | ||
<meta http-equiv="X-UA-Compatible" content="IE=11"/> | ||
<meta name="generator" content="Doxygen 1.10.0"/> | ||
<meta name="viewport" content="width=device-width, initial-scale=1"/> | ||
<title>wbc: tutorials/kuka_iiwa/cart_pos_ctrl_dynamic.cpp File Reference</title> | ||
<link href="tabs.css" rel="stylesheet" type="text/css"/> | ||
<script type="text/javascript" src="jquery.js"></script> | ||
<script type="text/javascript" src="dynsections.js"></script> | ||
<script type="text/javascript" src="clipboard.js"></script> | ||
<script type="text/x-mathjax-config"> | ||
MathJax.Hub.Config({ | ||
extensions: ["tex2jax.js"], | ||
jax: ["input/TeX","output/HTML-CSS"], | ||
}); | ||
</script> | ||
<script type="text/javascript" async="async" src="https://cdn.jsdelivr.net/npm/mathjax@2/MathJax.js"></script> | ||
<link href="doxygen.css" rel="stylesheet" type="text/css" /> | ||
</head> | ||
<body> | ||
<div id="top"><!-- do not remove this div, it is closed by doxygen! --> | ||
<div id="titlearea"> | ||
<table cellspacing="0" cellpadding="0"> | ||
<tbody> | ||
<tr id="projectrow"> | ||
<td id="projectalign"> | ||
<div id="projectname">wbc | ||
</div> | ||
</td> | ||
</tr> | ||
</tbody> | ||
</table> | ||
</div> | ||
<!-- end header part --> | ||
<!-- Generated by Doxygen 1.10.0 --> | ||
<script type="text/javascript" src="menudata.js"></script> | ||
<script type="text/javascript" src="menu.js"></script> | ||
<script type="text/javascript"> | ||
/* @license magnet:?xt=urn:btih:d3d9a9a6595521f9666a5e94cc830dab83b65699&dn=expat.txt MIT */ | ||
$(function() { | ||
initMenu('',false,false,'search.php','Search'); | ||
}); | ||
/* @license-end */ | ||
</script> | ||
<div id="main-nav"></div> | ||
<div id="nav-path" class="navpath"> | ||
<ul> | ||
<li class="navelem"><a class="el" href="dir_0d353d24d0afa59909efab6593124f6d.html">tutorials</a></li><li class="navelem"><a class="el" href="dir_5d45abd4863d15c2c47de1951180b2a2.html">kuka_iiwa</a></li> </ul> | ||
</div> | ||
</div><!-- top --> | ||
<div class="header"> | ||
<div class="summary"> | ||
<a href="#func-members">Functions</a> </div> | ||
<div class="headertitle"><div class="title">cart_pos_ctrl_dynamic.cpp File Reference</div></div> | ||
</div><!--header--> | ||
<div class="contents"> | ||
<div class="textblock"><code>#include <<a class="el" href="RobotModelPinocchio_8hpp_source.html">robot_models/pinocchio/RobotModelPinocchio.hpp</a>></code><br /> | ||
<code>#include <<a class="el" href="QPOasesSolver_8hpp_source.html">solvers/qpoases/QPOasesSolver.hpp</a>></code><br /> | ||
<code>#include <<a class="el" href="AccelerationSceneTSID_8hpp_source.html">scenes/acceleration_tsid/AccelerationSceneTSID.hpp</a>></code><br /> | ||
<code>#include <<a class="el" href="JointIntegrator_8hpp_source.html">tools/JointIntegrator.hpp</a>></code><br /> | ||
<code>#include <<a class="el" href="CartesianPosPDController_8hpp_source.html">controllers/CartesianPosPDController.hpp</a>></code><br /> | ||
<code>#include <unistd.h></code><br /> | ||
</div><table class="memberdecls"> | ||
<tr class="heading"><td colspan="2"><h2 class="groupheader"><a id="func-members" name="func-members"></a> | ||
Functions</h2></td></tr> | ||
<tr class="memitem:ae66f6b31b5ad750f1fe042a706a4e3d4" id="r_ae66f6b31b5ad750f1fe042a706a4e3d4"><td class="memItemLeft" align="right" valign="top">int </td><td class="memItemRight" valign="bottom"><a class="el" href="#ae66f6b31b5ad750f1fe042a706a4e3d4">main</a> ()</td></tr> | ||
<tr class="separator:ae66f6b31b5ad750f1fe042a706a4e3d4"><td class="memSeparator" colspan="2"> </td></tr> | ||
</table> | ||
<h2 class="groupheader">Function Documentation</h2> | ||
<a id="ae66f6b31b5ad750f1fe042a706a4e3d4" name="ae66f6b31b5ad750f1fe042a706a4e3d4"></a> | ||
<h2 class="memtitle"><span class="permalink"><a href="#ae66f6b31b5ad750f1fe042a706a4e3d4">◆ </a></span>main()</h2> | ||
|
||
<div class="memitem"> | ||
<div class="memproto"> | ||
<table class="memname"> | ||
<tr> | ||
<td class="memname">int main </td> | ||
<td>(</td> | ||
<td class="paramname"><span class="paramname"></span></td><td>)</td> | ||
<td></td> | ||
</tr> | ||
</table> | ||
</div><div class="memdoc"> | ||
<p>Acceleration-based example, Cartesian position control of the KUKA iiwa robot (fixed base, no contacts). In the example the following problem is solved: </p><p class="formulaDsp"> | ||
\[ | ||
\begin{array}{ccc} | ||
minimize & \| \mathbf{J}\ddot{\mathbf{q}} - \dot{\mathbf{v}}_d + \dot{\mathbf{J}}\dot{\mathbf{q}}\|_2\\ | ||
\mathbf{\ddot{q}},\mathbf{\tau} & & \\ | ||
s.t. & \mathbf{H}\mathbf{\ddot{q}} - \mathbf{\tau} - \mathbf{J}_{c,i}^T\mathbf{f} = -\mathbf{h}, \, \forall i & \\ | ||
& \mathbf{\tau}_m \leq \mathbf{\tau} \leq \mathbf{\tau}_M& \\ | ||
\end{array} | ||
\] | ||
</p> | ||
<p> where </p><p class="formulaDsp"> | ||
\[ | ||
\dot{\mathbf{v}}_d = \dot{\mathbf{v}}_r + \mathbf{K}_d(\mathbf{v}_r-\mathbf{v}) + \mathbf{K}_p(\mathbf{x}_r-\mathbf{x}) | ||
\] | ||
</p> | ||
<p> \(\ddot{\mathbf{q}}\) - Vector of robot joint accelerations<br /> | ||
\(\dot{\mathbf{v}}_{d}\) - desired spatial acceleration / controller output <br /> | ||
\(\mathbf{\tau}\) - actuation forces/torques<br /> | ||
\(\mathbf{J}\) - task Jacobian <br /> | ||
\(\mathbf{H}\) - Joint space inertia matrix<br /> | ||
\(\mathbf{h}\) - bias forces/torques<br /> | ||
\(\mathbf{\tau}_m,\mathbf{\tau}_M\) - Joint force/torque limits<br /> | ||
\(\mathbf{x}_r, \mathbf{x}\) - Reference pose, actual pose<br /> | ||
\(\mathbf{v}_r, \mathbf{v}\) - Reference spatial velocity, actual spatial velocity<br /> | ||
\(\dot{\mathbf{v}}_r\) - Reference spatial acceleration (feed forward)<br /> | ||
\(\mathbf{K}_p, \mathbf{K}_d\) - Proportional, derivative gain matrix<br /> | ||
</p> | ||
<p>The end effector is supposed to follow a sinusoidal trajectory. The solver computes the joint accelerations and forces/torques required to generate the desired spatial accelerations given by the Cartesian controller. </p> | ||
|
||
</div> | ||
</div> | ||
</div><!-- contents --> | ||
<!-- start footer part --> | ||
<hr class="footer"/><address class="footer"><small> | ||
Generated by <a href="https://www.doxygen.org/index.html"><img class="footer" src="doxygen.svg" width="104" height="31" alt="doxygen"/></a> 1.10.0 | ||
</small></address> | ||
</body> | ||
</html> |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters