Visual Servoing Platform  version 3.6.1 under development (2024-10-15)
vpPioneer.h
1 /*
2  * ViSP, open source Visual Servoing Platform software.
3  * Copyright (C) 2005 - 2023 by Inria. All rights reserved.
4  *
5  * This software is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation; either version 2 of the License, or
8  * (at your option) any later version.
9  * See the file LICENSE.txt at the root directory of this source
10  * distribution for additional information about the GNU GPL.
11  *
12  * For using ViSP with software that can not be combined with the GNU
13  * GPL, please contact Inria about acquiring a ViSP Professional
14  * Edition License.
15  *
16  * See https://visp.inria.fr for more information.
17  *
18  * This software was developed at:
19  * Inria Rennes - Bretagne Atlantique
20  * Campus Universitaire de Beaulieu
21  * 35042 Rennes Cedex
22  * France
23  *
24  * If you have questions regarding the use of this file, please contact
25  * Inria at visp@inria.fr
26  *
27  * This file is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING THE
28  * WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
29  *
30  * Description:
31  * Common features for Pioneer unicycle mobile robots.
32  */
33 #ifndef VPPIONEER_H
34 #define VPPIONEER_H
35 
36 #include <visp3/core/vpConfig.h>
37 #include <visp3/core/vpRxyzVector.h>
38 #include <visp3/core/vpTranslationVector.h>
39 #include <visp3/robot/vpUnicycle.h>
40 
41 BEGIN_VISP_NAMESPACE
86 class VISP_EXPORT vpPioneer : public vpUnicycle
87 {
88 public:
93  {
94  set_cMe();
95  set_eJe();
96  }
97 
98 private:
103  void set_cMe()
104  {
105  // Position of mobile platform end effector frame in the camera frame
106  double l = 0.13; // distance between the camera frame and the mobile robot frame
107  vpTranslationVector cte; // meters
108  vpRxyzVector cre; // radian
109  cte.set(0, 0, -l);
110  cre.buildFrom(vpMath::rad(90.), 0, vpMath::rad(90.));
111  cMe_.buildFrom(cte, vpRotationMatrix(cre));
112  }
113 
135  void set_eJe()
136  {
137  eJe_.resize(6, 2); // pioneer jacobian expressed at point M
138  eJe_ = 0;
139  eJe_[0][0] = 1; // vx
140  eJe_[5][1] = 1; // wz
141  }
142 };
143 END_VISP_NAMESPACE
144 #endif
static double rad(double deg)
Definition: vpMath.h:129
Generic functions for Pioneer mobile robots.
Definition: vpPioneer.h:87
vpPioneer()
Definition: vpPioneer.h:92
Implementation of a rotation matrix and operations on such kind of matrices.
Implementation of a rotation vector as Euler angle minimal representation.
Definition: vpRxyzVector.h:183
vpRxyzVector & buildFrom(const vpRotationMatrix &R)
Class that consider the case of a translation vector.
void set(double tx, double ty, double tz)
Generic functions for unicycle mobile robots.
Definition: vpUnicycle.h:52
void set_eJe(const vpMatrix &eJe)
Definition: vpUnicycle.h:112
void set_cMe(const vpHomogeneousMatrix &cMe)
Definition: vpUnicycle.h:102