/usr/include/Aria/ArTransform.h is in libaria-dev 2.8.0+repack-1ubuntu2.
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 151 152 153 154 155 156 | /*
Adept MobileRobots Robotics Interface for Applications (ARIA)
Copyright (C) 2004, 2005 ActivMedia Robotics LLC
Copyright (C) 2006, 2007, 2008, 2009, 2010 MobileRobots Inc.
Copyright (C) 2011, 2012, 2013 Adept Technology
This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program; if not, write to the Free Software
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
If you wish to redistribute ARIA under different terms, contact
Adept MobileRobots for information about a commercial version of ARIA at
robots@mobilerobots.com or
Adept MobileRobots, 10 Columbia Drive, Amherst, NH 03031; +1-603-881-7960
*/
#ifndef ARTRANSFORM_H
#define ARTRANSFORM_H
#include "ariaTypedefs.h"
#include "ariaUtil.h"
/// Perform transforms between different coordinates
/** @ingroup UtilityClasses
*/
class ArTransform
{
public:
/// Constructor
ArTransform()
{
myX = 0;
myY = 0;
myTh = 0;
myCos = ArMath::cos(myTh);
mySin = ArMath::sin(myTh);
}
/// Constructor, Sets the transform so points in this coord system
/// transform to abs world coords
ArTransform(ArPose pose)
{
setTransform(pose);
}
/// Constructor, sets the transform so that pose1 will be
/// transformed to pose2
ArTransform(ArPose pose1, ArPose pose2)
{
setTransform(pose1, pose2);
}
/// Destructor
virtual ~ArTransform() {}
/// Take the source pose and run the transform on it to put it into abs
/// coordinates
/**
@param source the parameter to transform
@return the source transformed into absolute coordinates
*/
ArPose doTransform(ArPose source)
{
ArPose ret;
ret.setX(myX + myCos * source.getX() + mySin * source.getY());
ret.setY(myY + myCos * source.getY() - mySin * source.getX());
ret.setTh(ArMath::addAngle(source.getTh(),myTh));
return ret;
}
/// Take the source pose and run the transform on it to put it into abs
/// coordinates
/**
@param source the parameter to transform
@return the source transformed into absolute coordinates
*/
ArPoseWithTime doTransform(ArPoseWithTime source)
{
ArPoseWithTime ret;
ret.setX(myX + myCos * source.getX() + mySin * source.getY());
ret.setY(myY + myCos * source.getY() - mySin * source.getX());
ret.setTh(ArMath::addAngle(source.getTh(),myTh));
ret.setTime(source.getTime());
return ret;
}
/// Take the source pose and run the inverse transform on it, taking it from
/// abs coords to local
/**
The source and result can be the same
@param source the parameter to transform
@return the source transformed from absolute into local coords
*/
ArPose doInvTransform(ArPose source)
{
ArPose ret;
double tx = source.getX() - myX;
double ty = source.getY() - myY;
ret.setX(myCos * tx - mySin * ty);
ret.setY(myCos * ty + mySin * tx);
ret.setTh(ArMath::subAngle(source.getTh(),myTh));
return ret;
}
/// Take the source pose and run the inverse transform on it, taking it from
/// abs coords to local
/**
The source and result can be the same
@param source the parameter to transform
@return the source transformed from absolute into local coords
*/
ArPoseWithTime doInvTransform(ArPoseWithTime source)
{
ArPoseWithTime ret;
double tx = source.getX() - myX;
double ty = source.getY() - myY;
ret.setX(myCos * tx - mySin * ty);
ret.setY(myCos * ty + mySin * tx);
ret.setTh(ArMath::subAngle(source.getTh(),myTh));
ret.setTime(source.getTime());
return ret;
}
/// Take a std::list of sensor readings and do the transform on it
AREXPORT void doTransform(std::list<ArPose *> *poseList);
/// Take a std::list of sensor readings and do the transform on it
AREXPORT void doTransform(std::list<ArPoseWithTime *> *poseList);
/// Sets the transform so points in this coord system transform to abs world coords
AREXPORT void setTransform(ArPose pose);
/// Sets the transform so that pose1 will be transformed to pose2
AREXPORT void setTransform(ArPose pose1, ArPose pose2);
/// Gets the transform x value (mm)
double getX() { return myX; }
/// Gets the transform y value (mm)
double getY() { return myY; }
/// Gets the transform angle value (degrees)
double getTh() { return myTh; }
/// Internal function for setting the transform from low level data not poses
AREXPORT void setTransformLowLevel(double x, double y, double th);
protected:
double myX;
double myY;
double myTh;
double myCos;
double mySin;
};
#endif // ARTRANSFORM_H
|