\documentclass[a4paper,10pt]{report} \title{User Manual \\ Kinematics \& Dynamics Library} \author{Ruben Smits, Herman Bruyninckx} \usepackage{listings} \usepackage{amsmath} \usepackage{url} \usepackage{todo} \usepackage{hyperref} \begin{document} \lstset{language=c++} \maketitle \chapter{Introduction to KDL} \label{cha:introduction-kdl} \section{What is KDL?} \label{sec:what-kdl} Kinematics \& Dynamics Library is a c++ library that offers \begin{itemize} \item classes for geometric primitives and their operations \item classes for kinematic descriptions of chains (robots) \item (realtime) kinematic solvers for these kinematic chains \end{itemize} \section{Getting support - the Orocos community} \label{sec:gett-supp-oroc} \begin{itemize} \item This document! \item The website : \url{http://www.orocos.org/kdl}. \item The mailinglist. \todo{add link to mailinglist} \end{itemize} \section{Getting Orocos KDL} \label{sec:getting-orocos-kdl} First off all you need to successfully install the KDL-library. This is explained in the \textbf{Installation Manual}, it can be found on \url{http://www.orocos.org/kdl/Installation_Manual} \chapter{Tutorial} \label{cha:tutorial} \paragraph{Important remarks} \label{sec:important-remarks} \begin{itemize} \item All geometric primitives and there operations can be used in realtime. None of the operations lead to dynamic memory allocations and all of the operations are deterministic in time. \item All values are in [m] for translational components and [rad] for rotational components. \end{itemize} \section{Geometric Primitives} \label{sec:geometric-primitives} \paragraph{Headers} \label{sec:headers} \begin{itemize} \item \lstinline$frames.hpp$: Definition of all geometric primitives and there transformations/operators. \item \lstinline$frames_io.hpp$: Definition of the input/output operators. \end{itemize} The following primitives are available: \begin{itemize} \item Vector~\ref{sec:vector} \item Rotation~\ref{sec:rotation} \item Frame~\ref{sec:frame} \item Twist~\ref{sec:twist} \item Wrench~\ref{sec:wrench} \end{itemize} \subsection{Vector} \label{sec:vector} Represents the 3D position of a point/object. It contains three values, representing the X,Y,Z position of the point/object with respect to the reference frame: $\mathrm{Vector} = \left[\begin{array}{c} x \\ y \\ z \end{array} \right]$ \paragraph{Creating Vectors} \label{sec:creating-vectors} There are different ways to create a vector: \begin{lstlisting} Vector v1; //The default constructor, X-Y-Z are initialized to zero Vector v2(x,y,z); //X-Y-Z are initialized with the given values Vector v3(v2); //The copy constructor Vector v4=Vector::Zero(); //All values are set to zero \end{lstlisting} \paragraph{Get/Set individual elements} \label{sec:gets-indiv-elem} The operators \lstinline$[]$ and \lstinline$()$ use indices from 0..2, index checking is enabled/disabled by the DEBUG/NDEBUG definitions: \begin{lstlisting} v1[0]=v2[1];//copy y value of v2 to x value of v1 v2(1)=v3(3);//copy z value of v3 to y value of v2 v3.x( v4.y() );//copy y value of v4 to x value of v3 \end{lstlisting} \paragraph{Multiply/Divide with a scalar} \label{sec:mult-with-scal} You can multiply or divide a Vector with a double using the operator \lstinline$*$ and \lstinline$/$: \begin{lstlisting} v2=2*v1; v3=v1/2; \end{lstlisting} \paragraph{Add and subtract vectors} \label{sec:add-subtract-vectors} You can add or subtract a vector with another vector: \begin{lstlisting} v2+=v1; v3-=v1; v4=v1+v2; v5=v2-v3; \end{lstlisting} \paragraph{Cross and scalar product} \label{sec:cross-scalar-product} You can calculate the cross product of two vectors, which results in new vector or calculate the scalar(dot) product of two vectors: \begin{lstlisting} v3=v1*v2; //Cross product double a=dot(v1,v2)//Scalar product \end{lstlisting} \paragraph{Resetting} \label{sec:resetting} You can reset the values of a vector to zero: \begin{lstlisting} SetToZero(v1); \end{lstlisting} \paragraph{Comparing vectors} \label{sec:comparing-vectors} With or without giving an accuracy: \begin{lstlisting} v1==v2; v2!=v3; Equal(v3,v4,eps);//with accuracy eps \end{lstlisting} \subsection{Rotation} \label{sec:rotation} Represents the 3D rotation of an object wrt the reference frame. Internally it is represented by a 3x3 matrix which is a non-minimal representation: $\mathrm{Rotation} = \left[\begin{array}{ccc} Xx&Yx&Zx\\ Xy&Yy&Zy\\ Xz&Yz&Zz \end{array}\right] $ \paragraph{Creating Rotations} \label{sec:creating-rotations} \subparagraph{Safe ways to create a Rotation} \label{sec:safe-ways-create} The following result always in consistent Rotations. This means the rows/columns are always normalized and orthogonal: \begin{lstlisting} Rotation r1; //The default constructor, initializes to an 3x3 identity matrix Rotation r1 = Rotation::Identity();//Identity Rotation = zero rotation Rotation r2 = Rotation::RPY(roll,pitch,yaw); //Rotation build out off Roll-Pitch-Yaw angles Rotation r3 = Rotation::EulerZYZ(alpha,beta,gamma); //Rotation build out off Euler Z-Y-Z angles Rotation r4 = Rotation::EulerZYX(alpha,beta,gamma); //Rotation build out off Euler Z-Y-X angles Rotation r5 = Rotation::Rot(vector,angle); //Rotation build out off an equivalent axis(vector) and an angle. \end{lstlisting} \subparagraph{Other ways} \label{sec:other-ways} The following should be used with care, they can result in inconsistent rotation matrices, since there is no checking if columns/rows are normalized or orthogonal \begin{lstlisting} Rotation r6( Xx,Yx,Zx,Xy,Yy,Zy,Xz,Yz,Zz);//Give each individual element (Column-Major) Rotation r7(vectorX,vectorY,vectorZ);//Give each individual column \end{lstlisting} \paragraph{Getting values} \label{sec:getting-values} Individual values, the indices go from 0..2: \subsection{Frame} \label{sec:frame} \subsection{Twist} \label{sec:twist} \subsection{Wrench} \label{sec:wrench} \section{Kinematic Structures} \label{sec:kinematic-structures} \subsection{Joint} \label{sec:joint} \subsection{Segment} \label{sec:segment} \subsection{Chain} \label{sec:chain} \section{Kinematic Solvers} \label{sec:kinematic-solvers} \subsection{Forward position kinematics} \label{sec:forw-posit-kinem} \subsection{Forward velocity kinematics} \label{sec:forw-veloc-kinem} \subsection{Jacobian calculation} \label{sec:jacobian-calculation} \subsection{Inverse velocity kinematics} \label{sec:inverse-veloc-kinem} \subsection{Inverse position kinematics} \label{sec:inverse-posit-kinem} \section{Motion Specification Primitives} \label{sec:moti-spec-prim} \subsection{Path} \label{sec:path} \subsection{Velocity profile} \label{sec:velocity-profile} \subsection{Trajectory} \label{sec:trajectory} \end{document} %%% Local Variables: %%% mode: latex %%% TeX-master: t %%% End: