/usr/include/visp/vpForceTwistMatrix.h is in libvisp-dev 2.9.0-3+b2.
This file is owned by root:root, with mode 0o644.
The actual contents of the file can be viewed below.
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 | /****************************************************************************
*
* $Id: vpForceTwistMatrix.h 4574 2014-01-09 08:48:51Z fspindle $
*
* This file is part of the ViSP software.
* Copyright (C) 2005 - 2014 by INRIA. All rights reserved.
*
* This software is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* ("GPL") version 2 as published by the Free Software Foundation.
* See the file LICENSE.txt at the root directory of this source
* distribution for additional information about the GNU GPL.
*
* For using ViSP with software that can not be combined with the GNU
* GPL, please contact INRIA about acquiring a ViSP Professional
* Edition License.
*
* See http://www.irisa.fr/lagadic/visp/visp.html for more information.
*
* This software was developed at:
* INRIA Rennes - Bretagne Atlantique
* Campus Universitaire de Beaulieu
* 35042 Rennes Cedex
* France
* http://www.irisa.fr/lagadic
*
* If you have questions regarding the use of this file, please contact
* INRIA at visp@inria.fr
*
* This file is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING THE
* WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
*
*
* Description:
* Twist transformation matrix that allows to transform forces from one
* frame to an other.
*
* Authors:
* Fabien Spindler
*
*****************************************************************************/
#ifndef vpForceTwistMatrix_h
#define vpForceTwistMatrix_h
#include <visp/vpMatrix.h>
#include <visp/vpColVector.h>
#include <visp/vpHomogeneousMatrix.h>
#include <visp/vpRotationMatrix.h>
/*!
\class vpForceTwistMatrix
\ingroup TwistTransformation
\brief Class that consider the particular case of twist
transformation matrix that allows to transform a force/troque vector
from one frame to an other.
The vpForceTwistMatrix is derived from vpMatrix.
The twist transformation matrix that allows to transform the
force/torque vector expressed at frame \f${\cal F}_b\f$ into the
frame \f${\cal F}_a\f$ is a 6 by 6 matrix defined as
\f[
^a{\bf F}_b = \left[ \begin{array}{cc}
^a{\bf R}_b & {\bf 0}_{3\times 3}\\
{[^a{\bf t}_b]}_{\times} \; ^a{\bf R}_b & ^a{\bf R}_b
\end{array}
\right]
\f]
\f$ ^a{\bf R}_b \f$ is a rotation matrix and
\f$ ^a{\bf t}_b \f$ is a translation vector.
The code belows shows for example how to convert a force/torque skew
from probe frame to a sensor frame.
\code
#include <visp/vpColVector.h>
#include <visp/vpForceTwistMatrix.h>
int main()
{
vpForceTwistMatrix sFp; // Twist transformation matrix from sensor to probe frame
vpHomogeneousMatrix sMp; // Force/torque sensor frame to probe frame transformation
// ... sMp need here to be initialized
sFp.buildFrom(sMp);
vpColVector p_H(6); // Force/torque skew in the probe frame: fx,fy,fz,tx,ty,tz
// ... p_H should here have an initial value
vpColVector s_H(6); // Force/torque skew in the sensor frame: fx,fy,fz,tx,ty,tz
// Compute the value of the force/torque in the sensor frame
s_H = sFp * p_H;
}
\endcode
*/
class VISP_EXPORT vpForceTwistMatrix : public vpMatrix
{
friend class vpMatrix;
public:
// basic constructor
vpForceTwistMatrix() ;
// copy constructor
vpForceTwistMatrix(const vpForceTwistMatrix &F) ;
// constructor from an homogeneous transformation
vpForceTwistMatrix(const vpHomogeneousMatrix &M) ;
// Construction from Translation and rotation (ThetaU parameterization)
vpForceTwistMatrix(const vpTranslationVector &t, const vpThetaUVector &thetau) ;
// Construction from Translation and rotation (matrix parameterization)
vpForceTwistMatrix(const vpTranslationVector &t, const vpRotationMatrix &R) ;
vpForceTwistMatrix(const double tx, const double ty, const double tz,
const double tux, const double tuy, const double tuz) ;
// Basic initialisation (identity)
void init() ;
vpForceTwistMatrix buildFrom(const vpTranslationVector &t,
const vpRotationMatrix &R);
vpForceTwistMatrix buildFrom(const vpTranslationVector &t,
const vpThetaUVector &thetau);
vpForceTwistMatrix buildFrom(const vpHomogeneousMatrix &M) ;
// Basic initialisation (identity)
void setIdentity() ;
vpForceTwistMatrix operator*(const vpForceTwistMatrix &F) const ;
vpMatrix operator*(const vpMatrix &M) const ;
vpColVector operator*(const vpColVector &H) const ;
// copy operator from vpMatrix (handle with care)
vpForceTwistMatrix &operator=(const vpForceTwistMatrix &H);
} ;
#endif
/*
* Local variables:
* c-basic-offset: 2
* End:
*/
|