#include <vpSimulatorViper850.h>

Inheritance diagram for vpSimulatorViper850:

Public Types
enum	vpDisplayRobotType { MODEL_3D, MODEL_DH }

enum	vpRobotStateType { STATE_STOP, STATE_VELOCITY_CONTROL, STATE_POSITION_CONTROL, STATE_ACCELERATION_CONTROL }

enum	vpControlFrameType { REFERENCE_FRAME, ARTICULAR_FRAME, CAMERA_FRAME, MIXT_FRAME }

enum	vpToolType { TOOL_MARLIN_F033C_CAMERA, TOOL_PTGREY_FLEA2_CAMERA, TOOL_SCHUNK_GRIPPER_CAMERA, TOOL_GENERIC_CAMERA }

Public Member Functions
	vpSimulatorViper850 ()

	vpSimulatorViper850 (bool display)

virtual	~vpSimulatorViper850 ()

void	getCameraParameters (vpCameraParameters &cam, const unsigned int &image_width, const unsigned int &image_height)

void	getCameraParameters (vpCameraParameters &cam, const vpImage< unsigned char > &I)

void	getCameraParameters (vpCameraParameters &cam, const vpImage< vpRGBa > &I)

void	getDisplacement (const vpRobot::vpControlFrameType frame, vpColVector &displacement)

void	getPosition (const vpRobot::vpControlFrameType frame, vpColVector &q)

void	getPosition (const vpRobot::vpControlFrameType frame, vpPoseVector &position)

double	getPositioningVelocity (void)

void	getVelocity (const vpRobot::vpControlFrameType frame, vpColVector &q)

vpColVector	getVelocity (const vpRobot::vpControlFrameType frame)

void	get_cMe (vpHomogeneousMatrix &cMe)

void	get_cVe (vpVelocityTwistMatrix &cVe)

void	get_eJe (vpMatrix &eJe)

void	get_fJe (vpMatrix &fJe)

void	init (vpViper850::vpToolType tool, vpCameraParameters::vpCameraParametersProjType projModel=vpCameraParameters::perspectiveProjWithoutDistortion)

void	initialiseCameraRelativeToObject (vpHomogeneousMatrix cMo)

void	initialiseObjectRelativeToCamera (vpHomogeneousMatrix cMo)

void	move (const char *filename)

void	setCameraParameters (const vpCameraParameters cam)

void	setJointLimit (vpColVector limitMin, vpColVector limitMax)

void	setPosition (const vpRobot::vpControlFrameType frame, const vpColVector &q)

void	setPosition (const vpRobot::vpControlFrameType frame, const double pos1, const double pos2, const double pos3, const double pos4, const double pos5, const double pos6)

void	setPosition (const char *filename)

void	setPositioningVelocity (const double velocity)

vpRobot::vpRobotStateType	setRobotState (const vpRobot::vpRobotStateType newState)

void	setVelocity (const vpRobot::vpControlFrameType frame, const vpColVector &velocity)

void	stopMotion ()

vpCameraParameters	getExternalCameraParameters () const

vpHomogeneousMatrix	getExternalCameraPosition () const

void	getInternalView (vpImage< vpRGBa > &I)

void	getInternalView (vpImage< unsigned char > &I)

vpHomogeneousMatrix	get_cMo ()

vpHomogeneousMatrix	get_fMo () const

void	initScene (vpSceneObject obj, vpSceneDesiredObject desiredObject)

void	initScene (const char obj, const char desiredObject)

void	initScene (vpSceneObject obj)

void	initScene (const char *obj)

void	setCameraColor (const vpColor col)

void	setConstantSamplingTimeMode (const bool _constantSamplingTimeMode)

void	setCurrentViewColor (const vpColor col)

void	setDesiredViewColor (const vpColor col)

void	setDesiredCameraPosition (const vpHomogeneousMatrix cdMo)

void	setDisplayRobotType (const vpDisplayRobotType dispType)

void	setExternalCameraPosition (const vpHomogeneousMatrix camMf)

void	setSamplingTime (const double &delta_t)

void	setSingularityManagement (const bool sm)

void	set_fMo (const vpHomogeneousMatrix &fMo)

void	getExternalImage (vpImage< unsigned char > &I)

void	getExternalImage (vpImage< unsigned char > &I, const vpHomogeneousMatrix &camMf)

void	getExternalImage (vpImage< vpRGBa > &I, const vpHomogeneousMatrix &camMf)

double	getSamplingTime () const

double	getMaxTranslationVelocity (void) const

double	getMaxRotationVelocity (void) const

vpColVector	getPosition (const vpRobot::vpControlFrameType frame)

virtual vpRobotStateType	getRobotState (void)

void	setMaxRotationVelocity (const double maxVr)

void	setMaxTranslationVelocity (const double maxVt)

void	setVerbose (bool verbose)

void	init (const char *camera_extrinsic_parameters)

vpCameraParameters::vpCameraParametersProjType	getCameraParametersProjType ()

vpToolType	getToolType ()

void	parseConfigFile (const char *filename)

vpHomogeneousMatrix	getForwardKinematics (const vpColVector &q)

unsigned int	getInverseKinematicsWrist (const vpHomogeneousMatrix &fMw, vpColVector &q)

unsigned int	getInverseKinematics (const vpHomogeneousMatrix &fMc, vpColVector &q)

vpHomogeneousMatrix	get_fMc (const vpColVector &q)

void	get_fMc (const vpColVector &q, vpHomogeneousMatrix &fMc)

void	get_fMw (const vpColVector &q, vpHomogeneousMatrix &fMw)

void	get_wMe (vpHomogeneousMatrix &wMe)

void	get_eMc (vpHomogeneousMatrix &eMc)

void	get_fMe (const vpColVector &q, vpHomogeneousMatrix &fMe)

void	get_fJw (const vpColVector &q, vpMatrix &fJw)

void	get_fJe (const vpColVector &q, vpMatrix &fJe)

void	get_eJe (const vpColVector &q, vpMatrix &eJe)

vpColVector	getJointMin ()

vpColVector	getJointMax ()

double	getCoupl56 ()

Static Public Member Functions
static bool	readPosFile (const char *filename, vpColVector &q)

static bool	savePosFile (const char *filename, const vpColVector &q)

static vpColVector	saturateVelocities (const vpColVector &v_in, const vpColVector &v_max, bool verbose=false)

Public Attributes
vpImage< vpRGBa >	I

Static Public Attributes
static const double	defaultPositioningVelocity = 25.0

static const char *const	CONST_EMC_MARLIN_F033C_WITHOUT_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_MarlinF033C_without_distortion_Viper850.cnf"

static const char *const	CONST_EMC_MARLIN_F033C_WITH_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_MarlinF033C_with_distortion_Viper850.cnf"

static const char *const	CONST_EMC_PTGREY_FLEA2_WITHOUT_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_PTGreyFlea2_without_distortion_Viper850.cnf"

static const char *const	CONST_EMC_PTGREY_FLEA2_WITH_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_PTGreyFlea2_with_distortion_Viper850.cnf"

static const char *const	CONST_EMC_SCHUNK_GRIPPER_WITHOUT_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_schunk_gripper_without_distortion_Viper850.cnf"

static const char *const	CONST_EMC_SCHUNK_GRIPPER_WITH_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_schunk_gripper_with_distortion_Viper850.cnf"

static const char *const	CONST_EMC_GENERIC_WITHOUT_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_generic_without_distortion_Viper850.cnf"

static const char *const	CONST_EMC_GENERIC_WITH_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_generic_with_distortion_Viper850.cnf"

static const char *const	CONST_CAMERA_FILENAME = "Z:/robot/Viper850/current/include/const_camera_Viper850.xml"

static const char *const	CONST_MARLIN_F033C_CAMERA_NAME = "Marlin-F033C-12mm"

static const char *const	CONST_PTGREY_FLEA2_CAMERA_NAME = "PTGrey-Flea2-6mm"

static const char *const	CONST_SCHUNK_GRIPPER_CAMERA_NAME = "Schunk-Gripper-PTGrey-Flea2-6mm"

static const char *const	CONST_GENERIC_CAMERA_NAME = "Generic-camera"

static const vpToolType	defaultTool = vpViper850::TOOL_PTGREY_FLEA2_CAMERA

static const unsigned int	njoint = 6

Protected Types
enum	vpSceneObject { THREE_PTS, CUBE, PLATE, SMALL_PLATE, RECTANGLE, SQUARE_10CM, DIAMOND, TRAPEZOID, THREE_LINES, ROAD, TIRE, PIPE, CIRCLE, SPHERE, CYLINDER, PLAN, POINT_CLOUD }

enum	vpSceneDesiredObject { D_STANDARD, D_CIRCLE, D_TOOL }

enum	vpCameraTrajectoryDisplayType { CT_LINE, CT_POINT }

Protected Member Functions
void	computeArticularVelocity ()

void	compute_fMi ()

void	findHighestPositioningSpeed (vpColVector &q)

void	getExternalImage (vpImage< vpRGBa > &I)

void	get_fMi (vpHomogeneousMatrix *fMit)

void	init ()

void	initArms ()

void	initDisplay ()

int	isInJointLimit (void)

bool	singularityTest (const vpColVector q, vpMatrix &J)

void	updateArticularPosition ()

vpCameraParameters	getExternalCameraParameters (const vpImage< unsigned char > &I) const

vpCameraParameters	getExternalCameraParameters (const vpImage< vpRGBa > &I) const

vpHomogeneousMatrix	get_cMo () const

void	initScene (const vpSceneObject &obj, const vpSceneDesiredObject &desiredObject)

void	initScene (const vpSceneObject &obj)

void	initScene (const vpSceneObject &obj, const vpSceneDesiredObject &desiredObject, const std::list< vpImageSimulator > &imObj)

void	initScene (const char obj, const char desiredObject, const std::list< vpImageSimulator > &imObj)

void	initScene (const vpSceneObject &obj, const std::list< vpImageSimulator > &imObj)

void	initScene (const char *obj, const std::list< vpImageSimulator > &imObj)

void	setCameraColor (const vpColor &col)

void	setCurrentViewColor (const vpColor &col)

void	setDesiredViewColor (const vpColor &col)

void	setDesiredCameraPosition (const vpHomogeneousMatrix &cdMo)

void	setExternalCameraPosition (const vpHomogeneousMatrix &camMf)

vpColVector	get_artCoord () const

void	set_artCoord (const vpColVector &coord)

vpColVector	get_artVel () const

void	set_artVel (const vpColVector &vel)

vpColVector	get_velocity ()

void	set_velocity (const vpColVector &vel)

void	set_displayBusy (const bool &status)

bool	get_displayBusy ()

void	deleteCameraPositionHistory ()

void	displayTrajectory (const vpImage< unsigned char > &I, const std::list< vpHomogeneousMatrix > &list_cMo, const std::list< vpHomogeneousMatrix > &list_fMo, const vpHomogeneousMatrix &camMf)

void	displayTrajectory (const vpImage< vpRGBa > &I, const std::list< vpHomogeneousMatrix > &list_cMo, const std::list< vpHomogeneousMatrix > &list_fMo, const vpHomogeneousMatrix &camMf)

vpCameraParameters	getInternalCameraParameters (const vpImage< unsigned char > &I) const

vpCameraParameters	getInternalCameraParameters (const vpImage< vpRGBa > &I) const

void	getInternalImage (vpImage< unsigned char > &I)

void	getInternalImage (vpImage< vpRGBa > &I)

void	get_cMo_History (std::list< vpHomogeneousMatrix > &cMo_history)

void	get_fMo_History (std::list< vpHomogeneousMatrix > &fMo_history)

void	setCameraPositionRelObj (const vpHomogeneousMatrix &cMo)

void	setCameraPositionRelWorld (const vpHomogeneousMatrix &fMc)

void	setCameraSizeFactor (const float factor)

void	setCameraTrajectoryColor (const vpColor &col)

void	setCameraTrajectoryDisplayType (const vpCameraTrajectoryDisplayType &camTrajType)

void	setDisplayCameraTrajectory (const bool &displayCameraTrajectory)

void	setExternalCameraParameters (const vpCameraParameters &cam)

void	setInternalCameraParameters (const vpCameraParameters &cam)

void	setNbPtTrajectory (const unsigned int nbPt)

void	display_scene (Matrix mat, Bound_scene &sc, const vpImage< vpRGBa > &I, const vpColor &color)

void	display_scene (Matrix mat, Bound_scene &sc, const vpImage< unsigned char > &I, const vpColor &color)

vpHomogeneousMatrix	navigation (const vpImage< vpRGBa > &I, bool &changed)

vpHomogeneousMatrix	navigation (const vpImage< unsigned char > &I, bool &changed)

vpImagePoint	projectCameraTrajectory (const vpImage< vpRGBa > &I, const vpHomogeneousMatrix &cMo, const vpHomogeneousMatrix &fMo)

vpImagePoint	projectCameraTrajectory (const vpImage< unsigned char > &I, const vpHomogeneousMatrix &cMo, const vpHomogeneousMatrix &fMo)

vpImagePoint	projectCameraTrajectory (const vpImage< vpRGBa > &I, const vpHomogeneousMatrix &cMo, const vpHomogeneousMatrix &fMo, const vpHomogeneousMatrix &cMf)

vpImagePoint	projectCameraTrajectory (const vpImage< unsigned char > &I, const vpHomogeneousMatrix &cMo, const vpHomogeneousMatrix &fMo, const vpHomogeneousMatrix &cMf)

vpControlFrameType	setRobotFrame (vpRobot::vpControlFrameType newFrame)

vpControlFrameType	getRobotFrame (void)

void	setToolType (vpViper850::vpToolType tool)

Deprecated functions
vp_deprecated void	initScene (vpSceneObject obj, vpSceneDesiredObject desiredObject, vpList< vpImageSimulator > &imObj)

vp_deprecated void	initScene (const char obj, const char desiredObject, vpList< vpImageSimulator > &imObj)

vp_deprecated void	initScene (vpSceneObject obj, vpList< vpImageSimulator > &imObj)

vp_deprecated void	initScene (const char *obj, vpList< vpImageSimulator > &imObj)

vp_deprecated void	displayTrajectory (const vpImage< unsigned char > &I, vpList< vpHomogeneousMatrix > &list_cMo, vpList< vpHomogeneousMatrix > &list_fMo, vpHomogeneousMatrix camMf)

vp_deprecated void	displayTrajectory (const vpImage< vpRGBa > &I, vpList< vpHomogeneousMatrix > &list_cMo, vpList< vpHomogeneousMatrix > &list_fMo, vpHomogeneousMatrix camMf)

vp_deprecated vpList< vpHomogeneousMatrix >	get_cMo_History ()

vp_deprecated vpList< vpHomogeneousMatrix >	get_fMo_History ()

Static Protected Member Functions
static DWORD WINAPI	launcher (LPVOID lpParam)

Protected Attributes
double	tcur

double	tprev

Bound_scene *	robotArms

unsigned int	size_fMi

vpHomogeneousMatrix *	fMi

vpColVector	artCoord

vpColVector	artVel

vpColVector	velocity

HANDLE	hThread

HANDLE	mutex_fMi

HANDLE	mutex_artVel

HANDLE	mutex_artCoord

HANDLE	mutex_velocity

HANDLE	mutex_display

bool	displayBusy

bool	robotStop

bool	jointLimit

unsigned int	jointLimitArt

bool	singularityManagement

vpCameraParameters	cameraParam

vpDisplayX	display

vpDisplayRobotType	displayType

bool	displayAllowed

bool	constantSamplingTimeMode

bool	setVelocityCalled

Bound_scene	scene

Bound_scene	desiredScene

Bound_scene	camera

std::list< vpImageSimulator >	objectImage

vpHomogeneousMatrix	fMo

vpHomogeneousMatrix	fMc

vpHomogeneousMatrix	camMf

vpHomogeneousMatrix	refMo

vpHomogeneousMatrix	cMo

vpHomogeneousMatrix	cdMo

vpSceneObject	object

vpSceneDesiredObject	desiredObject

vpColor	camColor

vpColor	camTrajColor

vpColor	curColor

vpColor	desColor

bool	sceneInitialized

bool	displayCameraTrajectory

std::list< vpImagePoint >	cameraTrajectory

std::list< vpHomogeneousMatrix >	poseList

std::list< vpHomogeneousMatrix >	fMoList

unsigned int	nbrPtLimit

vpImagePoint	old_iPr

vpImagePoint	old_iPz

vpImagePoint	old_iPt

bool	blockedr

bool	blockedz

bool	blockedt

bool	blocked

vpHomogeneousMatrix	camMf2

vpHomogeneousMatrix	f2Mf

double	px_int

double	py_int

double	px_ext

double	py_ext

bool	displayObject

bool	displayDesiredObject

bool	displayCamera

bool	displayImageSimulator

float	cameraFactor

vpCameraTrajectoryDisplayType	camTrajType

bool	extCamChanged

vpHomogeneousMatrix	rotz

double	delta_t_

double	maxTranslationVelocity

double	maxRotationVelocity

int	nDof

vpMatrix	eJe

int	eJeAvailable

vpMatrix	fJe

int	fJeAvailable

int	areJointLimitsAvailable

double *	qmin

double *	qmax

bool	verbose_

vpToolType	tool_current

vpCameraParameters::vpCameraParametersProjType	projModel

vpHomogeneousMatrix	eMc

vpTranslationVector	etc

vpRxyzVector	erc

double	a1

double	d1

double	a2

double	a3

double	d4

double	d6

double	c56

vpColVector	joint_max

vpColVector	joint_min

Static Protected Attributes
static const double	maxTranslationVelocityDefault = 0.2

static const double	maxRotationVelocityDefault = 0.7

Detailed Description

Simulator of Irisa's Viper S850 robot named Viper850.

Implementation of the vpRobotWireFrameSimulator class in order to simulate Irisa's Viper850 robot. This robot is an ADEPT six degrees of freedom arm.

Warning: This class uses threading capabilities. Thus on Unix-like platforms, the libpthread third-party library need to be installed. On Windows, we use the native threading capabilities.

This class allows to control the Viper850 arm robot in position and velocity:

in the joint space (vpRobot::ARTICULAR_FRAME),
in the fixed reference frame (vpRobot::REFERENCE_FRAME),
in the camera frame (vpRobot::CAMERA_FRAME),
or in a mixed frame (vpRobot::MIXT_FRAME) where translations are expressed in the reference frame and rotations in the camera frame.

All the translations are expressed in meters for positions and m/s for the velocities. Rotations are expressed in radians for the positions, and rad/s for the rotation velocities.

The direct and inverse kinematics models are implemented in the vpViper850 class.

To control the robot in position, you may set the controller to position control and then send the position to reach in a specific frame like here in the joint space:

#include <visp/vpConfig.h>
#include <visp/vpSimulatorViper850.h>
#include <visp/vpColVector.h>
#include <visp/vpMath.h>
int main()
{
  vpSimulatorViper850 robot;
  vpColVector q(6);
  // Set a joint position
  q[0] = vpMath::rad(10); // Joint 1 position, in rad
  q[1] = 0.2;             // Joint 2 position, in rad
  q[2] = 0.3;             // Joint 3 position, in rad
  q[3] = M_PI/8;          // Joint 4 position, in rad
  q[4] = M_PI/4;          // Joint 5 position, in rad
  q[5] = M_PI;            // Joint 6 position, in rad
  // Initialize the controller to position control
  robot.setRobotState(vpRobot::STATE_POSITION_CONTROL);
  // Moves the robot in the joint space
  robot.setPosition(vpRobot::ARTICULAR_FRAME, q);
  
  return 0;
}

The robot moves to the specified position with the default positioning velocity vpRobotViper850::defaultPositioningVelocity. The setPositioningVelocity() method allows to change the maximal velocity used to reach the desired position.

#include <visp/vpConfig.h>
#include <visp/vpSimulatorViper850.h>
#include <visp/vpColVector.h>
#include <visp/vpMath.h>
int main()
{
  vpSimulatorViper850 robot;
  vpColVector q(6);
  // Set q[i] with i in [0:5]
  // Initialize the controller to position control
  robot.setRobotState(vpRobot::STATE_POSITION_CONTROL);
  // Set the max velocity to 40%
  robot.setPositioningVelocity(40);
  // Moves the robot in the joint space
  robot.setPosition(vpRobot::ARTICULAR_FRAME, q);
  
  return 0;
}

To control the robot in velocity, you may set the controller to velocity control and then send the velocities. To end the velocity control and stop the robot you have to set the controller to the stop state. Here is an example of a velocity control in the joint space:

#include <visp/vpConfig.h>
#include <visp/vpSimulatorViper850.h>
#include <visp/vpColVector.h>
#include <visp/vpMath.h>
int main()
{
  vpSimulatorViper850 robot;
  vpColVector qvel(6);
  // Set a joint velocity
  qvel[0] = 0.1;             // Joint 1 velocity in rad/s
  qvel[1] = vpMath::rad(15); // Joint 2 velocity in rad/s
  qvel[2] = 0;               // Joint 3 velocity in rad/s
  qvel[3] = M_PI/8;          // Joint 4 velocity in rad/s
  qvel[4] = 0;               // Joint 5 velocity in rad/s
  qvel[5] = 0;               // Joint 6 velocity in rad/s
  // Initialize the controller to position control
  robot.setRobotState(vpRobot::STATE_VELOCITY_CONTROL);
  for ( ; ; ) {
    // Apply a velocity in the joint space
    robot.setVelocity(vpRobot::ARTICULAR_FRAME, qvel);
    // Compute new velocities qvel...
  }
  // Stop the robot
  robot.setRobotState(vpRobot::STATE_STOP);
  
  return 0;
}

It is also possible to measure the robot current position with getPosition() method and the robot current velocities with the getVelocity() method.

For convenience, there is also the ability to read/write joint positions from a position file with readPosFile() and savePosFile() methods.

Examples:: servoSimuViper850FourPoints2DCamVelocity.cpp.

Definition at line 202 of file vpSimulatorViper850.h.

Member Enumeration Documentation

enum vpWireFrameSimulator::vpCameraTrajectoryDisplayType

inherited

Enumerator
CT_LINE
CT_POINT

Definition at line 227 of file vpWireFrameSimulator.h.

enum vpRobot::vpControlFrameType

inherited

Robot control frames.

Enumerator
REFERENCE_FRAME	Corresponds to a fixed reference frame attached to the robot structure.
ARTICULAR_FRAME	Corresponds to the joint space.
CAMERA_FRAME	Corresponds to a frame attached to the camera mounted on the robot end-effector.
MIXT_FRAME	Corresponds to a "virtual" frame where translations are expressed in the reference frame, and rotations in the camera frame.

Definition at line 78 of file vpRobot.h.

enum vpRobotWireFrameSimulator::vpDisplayRobotType

inherited

Enumerator
MODEL_3D
MODEL_DH

Definition at line 94 of file vpRobotWireFrameSimulator.h.

enum vpRobot::vpRobotStateType

inherited

Robot control states.

Enumerator
STATE_STOP	Stops robot motion especially in velocity and acceleration control.
STATE_VELOCITY_CONTROL	Initialize the velocity controller.
STATE_POSITION_CONTROL	Initialize the position controller.
STATE_ACCELERATION_CONTROL	Initialize the acceleration controller.

Definition at line 66 of file vpRobot.h.

enum vpWireFrameSimulator::vpSceneDesiredObject

inherited

Type of scene used to display the object at the desired pose (in the internal view).

D_STANDARD will use the vpSceneObject used to be the object at the current position.
D_OUTIL will display a tool which is attached to the camera.

Enumerator
D_STANDARD
D_CIRCLE
D_TOOL

Definition at line 220 of file vpWireFrameSimulator.h.

enum vpWireFrameSimulator::vpSceneObject

inherited

Type of scene used to display the object at the current position.

Enumerator
THREE_PTS
CUBE
PLATE
SMALL_PLATE
RECTANGLE
SQUARE_10CM
DIAMOND
TRAPEZOID
THREE_LINES
ROAD
TIRE
PIPE
CIRCLE
SPHERE
CYLINDER
PLAN
POINT_CLOUD

Definition at line 193 of file vpWireFrameSimulator.h.

enum vpViper850::vpToolType

inherited

List of possible tools that can be attached to the robot end-effector.

Enumerator
TOOL_MARLIN_F033C_CAMERA	Marlin F033C camera.
TOOL_PTGREY_FLEA2_CAMERA	Point Grey Flea 2 camera.
TOOL_SCHUNK_GRIPPER_CAMERA	Camera attached to the Schunk gripper.
TOOL_GENERIC_CAMERA	A generic camera.

Definition at line 91 of file vpViper850.h.

Constructor & Destructor Documentation

vpSimulatorViper850::vpSimulatorViper850 ( )

Basic constructor

Definition at line 61 of file vpSimulatorViper850.cpp.

References compute_fMi(), vpRobotWireFrameSimulator::hThread, init(), initDisplay(), vpRobotWireFrameSimulator::launcher(), vpTime::measureTimeMs(), vpRobotWireFrameSimulator::mutex_artCoord, vpRobotWireFrameSimulator::mutex_artVel, vpRobotWireFrameSimulator::mutex_display, vpRobotWireFrameSimulator::mutex_fMi, vpRobotWireFrameSimulator::mutex_velocity, and vpRobotWireFrameSimulator::tcur.

vpSimulatorViper850::vpSimulatorViper850 ( bool disp )

Constructor used to enable or disable the external view of the robot.

Definition at line 103 of file vpSimulatorViper850.cpp.

References compute_fMi(), vpRobotWireFrameSimulator::hThread, init(), initDisplay(), vpRobotWireFrameSimulator::launcher(), vpTime::measureTimeMs(), vpRobotWireFrameSimulator::mutex_artCoord, vpRobotWireFrameSimulator::mutex_artVel, vpRobotWireFrameSimulator::mutex_display, vpRobotWireFrameSimulator::mutex_fMi, vpRobotWireFrameSimulator::mutex_velocity, and vpRobotWireFrameSimulator::tcur.

vpSimulatorViper850::~vpSimulatorViper850 ( )

virtual

Basic destructor

Definition at line 145 of file vpSimulatorViper850.cpp.

References vpRobotWireFrameSimulator::fMi, vpRobotWireFrameSimulator::hThread, vpRobotWireFrameSimulator::mutex_artCoord, vpRobotWireFrameSimulator::mutex_artVel, vpRobotWireFrameSimulator::mutex_display, vpRobotWireFrameSimulator::mutex_fMi, vpRobotWireFrameSimulator::mutex_velocity, vpRobotWireFrameSimulator::robotArms, and vpRobotWireFrameSimulator::robotStop.

Member Function Documentation

void vpSimulatorViper850::compute_fMi ( )

protected

Compute the pose between the robot reference frame and the frames used used to compute the Denavit-Hartenberg representation. The last element of the table corresponds to the pose between the reference frame and the camera frame.

To compute the diferent homogeneous matrices, this function needs the articular coordinates as input.

Finally the output is a table of 8 elements : $ fM1 $ , $ fM2 $ , $ fM3 $ , $ fM4 $ , $ fM5 $ , $ fM6 = fMw $ , $ fM7 = fMe $ and $ fMc $ - where w is for wrist and e for effector-.

Definition at line 553 of file vpSimulatorViper850.cpp.

References vpViper::a1, vpViper::a2, vpViper::a3, vpViper::d1, vpViper::d4, vpViper::d6, vpRobotWireFrameSimulator::fMi, vpRobotWireFrameSimulator::get_artCoord(), get_cMe(), vpViper::get_fMc(), vpHomogeneousMatrix::inverse(), and vpRobotWireFrameSimulator::mutex_fMi.

Referenced by initialiseCameraRelativeToObject(), updateArticularPosition(), and vpSimulatorViper850().

void vpSimulatorViper850::computeArticularVelocity ( )

protectedvirtual

Compute the articular velocity relative to the velocity in another frame.

Implements vpRobotWireFrameSimulator.

Definition at line 914 of file vpSimulatorViper850.cpp.

References vpRobot::ARTICULAR_FRAME, vpRobot::CAMERA_FRAME, vpRobot::eJe, vpViper::eMc, vpRobot::fJe, vpRobotWireFrameSimulator::get_artCoord(), vpViper::get_eJe(), vpViper::get_fJe(), vpRobotWireFrameSimulator::get_velocity(), vpRobot::getMaxRotationVelocity(), vpRobot::getRobotFrame(), vpRobotWireFrameSimulator::jointLimit, vpRobot::MIXT_FRAME, vpMatrix::pseudoInverse(), vpRobot::REFERENCE_FRAME, vpRobotWireFrameSimulator::set_artVel(), vpRobotWireFrameSimulator::singularityManagement, singularityTest(), and vpERROR_TRACE.

Referenced by updateArticularPosition().

void vpWireFrameSimulator::deleteCameraPositionHistory ( )

inlineinherited

Delete the history of the main camera position which are displayed in the external views.

Definition at line 301 of file vpWireFrameSimulator.h.

void vpWireFrameSimulator::display_scene	(	Matrix	mat,
		Bound_scene &	sc,
		const vpImage< vpRGBa > &	I,
		const vpColor &	color
	)

protectedinherited

Definition at line 408 of file vpWireFrameSimulator.cpp.

References vpDisplay::displayLine(), vpImage< Type >::getHeight(), and vpImage< Type >::getWidth().

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::getInternalImage(), and vpRobotWireFrameSimulator::getInternalView().

void vpWireFrameSimulator::display_scene	(	Matrix	mat,
		Bound_scene &	sc,
		const vpImage< unsigned char > &	I,
		const vpColor &	color
	)

protectedinherited

Definition at line 457 of file vpWireFrameSimulator.cpp.

References vpDisplay::displayLine(), vpImage< Type >::getHeight(), and vpImage< Type >::getWidth().

void vpWireFrameSimulator::displayTrajectory	(	const vpImage< unsigned char > &	I,
		const std::list< vpHomogeneousMatrix > &	list_cMo,
		const std::list< vpHomogeneousMatrix > &	list_fMo,
		const vpHomogeneousMatrix &	cMf
	)

inherited

Display a trajectory thanks to a list of homogeneous matrices which give the position of the camera relative to the object and the position of the object relative to the world refrence frame. The trajectory is projected into the view of an external camera whose position is given in parameter.

The two lists must have the same size of homogeneous matrices must have the same size.

Parameters

I	: The image where the trajectory is displayed.
list_cMo	: The homogeneous matrices list containing the position of the camera relative to the object.
list_fMo	: The homogeneous matrices list containing the position of the object relative to the world reference frame.
cMf	: A homogeneous matrix which gives the position of the external camera (used to project the trajectory) relative to the world refrence frame.

Definition at line 1687 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::camTrajColor, vpWireFrameSimulator::camTrajType, vpWireFrameSimulator::CT_LINE, vpWireFrameSimulator::CT_POINT, vpException::dimensionError, vpDisplay::displayLine(), vpDisplay::displayPoint(), vpWireFrameSimulator::projectCameraTrajectory(), and vpWireFrameSimulator::rotz.

void vpWireFrameSimulator::displayTrajectory	(	const vpImage< vpRGBa > &	I,
		const std::list< vpHomogeneousMatrix > &	list_cMo,
		const std::list< vpHomogeneousMatrix > &	list_fMo,
		const vpHomogeneousMatrix &	cMf
	)

inherited

Display a trajectory thanks to a list of homogeneous matrices which give the position of the camera relative to the object and the position of the object relative to the world refrence frame. The trajectory is projected into the view of an external camera whose position is given in parameter.

The two lists must have the same size of homogeneous matrices must have the same size.

Parameters

I	: The image where the trajectory is displayed.
list_cMo	: The homogeneous matrices list containing the position of the camera relative to the object.
list_fMo	: The homogeneous matrices list containing the position of the object relative to the world reference frame.
cMf	: A homogeneous matrix which gives the position of the external camera (used to project the trajectory) relative to the world refrence frame.

Definition at line 1727 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::camTrajColor, vpWireFrameSimulator::camTrajType, vpWireFrameSimulator::CT_LINE, vpWireFrameSimulator::CT_POINT, vpException::dimensionError, vpDisplay::displayLine(), vpDisplay::displayPoint(), vpWireFrameSimulator::projectCameraTrajectory(), and vpWireFrameSimulator::rotz.

void vpWireFrameSimulator::displayTrajectory	(	const vpImage< unsigned char > &	I,
		vpList< vpHomogeneousMatrix > &	list_cMo,
		vpList< vpHomogeneousMatrix > &	list_fMo,
		vpHomogeneousMatrix	cMf
	)

inherited

Deprecated:: This method is deprecated. You should use displayTrajectory(vpImage<unsigned char> &, const std::list<vpHomogeneousMatrix> &, const std::list<vpHomogeneousMatrix> &, const vpHomogeneousMatrix &); instead.

Display a trajectory thanks to a list of homogeneous matrices which give the position of the camera relative to the object and the position of the object relative to the world refrence frame. The trajectory is projected into the view of an external camera whose position is given in parameter.

The two lists must have the same size of homogeneous matrices must have the same size.

Parameters

I	: The image where the trajectory is displayed.
list_cMo	: The homogeneous matrices list containing the position of the camera relative to the object.
list_fMo	: The homogeneous matrices list containing the position of the object relative to the world reference frame.
cMf	: A homogeneous matrix which gives the position of the external camera (used to project the trajectory) relative to the world refrence frame.

Definition at line 1605 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::camTrajColor, vpWireFrameSimulator::camTrajType, vpWireFrameSimulator::CT_LINE, vpWireFrameSimulator::CT_POINT, vpException::dimensionError, vpDisplay::displayLine(), vpDisplay::displayPoint(), vpList< type >::front(), vpList< type >::nbElements(), vpList< type >::next(), vpList< type >::outside(), vpWireFrameSimulator::projectCameraTrajectory(), vpWireFrameSimulator::rotz, and vpList< type >::value().

void vpWireFrameSimulator::displayTrajectory	(	const vpImage< vpRGBa > &	I,
		vpList< vpHomogeneousMatrix > &	list_cMo,
		vpList< vpHomogeneousMatrix > &	list_fMo,
		vpHomogeneousMatrix	cMf
	)

inherited

Deprecated:: This method is deprecated. You should use displayTrajectory (vpImage<vpRGBa> &, const std::list<vpHomogeneousMatrix> &, const std::list<vpHomogeneousMatrix> &, const vpHomogeneousMatrix &); instead.

Display a trajectory thanks to a list of homogeneous matrices which give the position of the camera relative to the object and the position of the object relative to the world refrence frame. The trajectory is projected into the view of an external camera whose position is given in parameter.

The two lists must have the same size of homogeneous matrices must have the same size.

Parameters

I	: The image where the trajectory is displayed.
list_cMo	: The homogeneous matrices list containing the position of the camera relative to the object.
list_fMo	: The homogeneous matrices list containing the position of the object relative to the world reference frame.
cMf	: A homogeneous matrix which gives the position of the external camera (used to project the trajectory) relative to the world refrence frame.

Definition at line 1647 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::camTrajColor, vpWireFrameSimulator::camTrajType, vpWireFrameSimulator::CT_LINE, vpWireFrameSimulator::CT_POINT, vpException::dimensionError, vpDisplay::displayLine(), vpDisplay::displayPoint(), vpList< type >::front(), vpList< type >::nbElements(), vpList< type >::next(), vpList< type >::outside(), vpWireFrameSimulator::projectCameraTrajectory(), vpWireFrameSimulator::rotz, and vpList< type >::value().

void vpSimulatorViper850::findHighestPositioningSpeed ( vpColVector & q )

protected

Definition at line 1140 of file vpSimulatorViper850.cpp.

References vpRobot::getMaxRotationVelocity(), and getPositioningVelocity().

vpColVector vpRobotWireFrameSimulator::get_artCoord ( ) const

inlineprotectedinherited

vpColVector vpRobotWireFrameSimulator::get_artVel ( ) const

inlineprotectedinherited

Definition at line 355 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getVelocity(), getVelocity(), vpSimulatorAfma6::updateArticularPosition(), and updateArticularPosition().

void vpSimulatorViper850::get_cMe ( vpHomogeneousMatrix & cMe )

Get the geometric transformation $^c{\bf M}_e$ between the camera frame and the end-effector frame. This transformation is constant and correspond to the extrinsic camera parameters estimated by calibration.

Parameters

cMe	: Transformation between the camera frame and the end-effector frame.

Definition at line 2077 of file vpSimulatorViper850.cpp.

References vpViper::get_cMe().

Referenced by compute_fMi(), and getExternalImage().

vpHomogeneousMatrix vpRobotWireFrameSimulator::get_cMo ( )

inherited

Get the pose between the object and the robot's camera.

Returns: The pose between the object and the fixed world frame.

Definition at line 354 of file vpRobotWireFrameSimulator.cpp.

References vpWireFrameSimulator::fMo, vpRobotWireFrameSimulator::get_fMi(), vpHomogeneousMatrix::inverse(), and vpRobotWireFrameSimulator::size_fMi.

Referenced by vpSimulatorAfma6::setPosition().

vpHomogeneousMatrix vpWireFrameSimulator::get_cMo ( ) const

inlineinherited

Get the pose between the object and the camera.

Returns: The pose between between the object and the camera.

Definition at line 406 of file vpWireFrameSimulator.h.

void vpWireFrameSimulator::get_cMo_History ( std::list< vpHomogeneousMatrix > & cMo_history )

inlineinherited

Get the homogeneous matrices cMo stored to display the camera trajectory.

Parameters

cMo_history : The list of the homogeneous matrices cMo.

Definition at line 413 of file vpWireFrameSimulator.h.

vp_deprecated vpList<vpHomogeneousMatrix> vpWireFrameSimulator::get_cMo_History ( )

inlineinherited

Deprecated:: This method is deprecated. You should use get_cMo_History(std::list<vpHomogeneousMatrix> &) instead.

Get the homogeneous matrices cMo stored to display the camera trajectory.

Returns: Returns the list of the homogeneous matrices cMo.

Definition at line 587 of file vpWireFrameSimulator.h.

References vpList< type >::addRight().

void vpSimulatorViper850::get_cVe ( vpVelocityTwistMatrix & cVe )

Get the twist transformation $^c{\bf V}_e$ from camera frame to end-effector frame. This transformation allows to compute a velocity expressed in the end-effector frame into the camera frame.

Parameters

cVe	: Twist transformation.

Definition at line 2090 of file vpSimulatorViper850.cpp.

References vpVelocityTwistMatrix::buildFrom(), and vpViper::get_cMe().

bool vpRobotWireFrameSimulator::get_displayBusy ( )

inlineprotectedinherited

Definition at line 379 of file vpRobotWireFrameSimulator.h.

Referenced by vpRobotWireFrameSimulator::getInternalView(), vpSimulatorAfma6::init(), vpSimulatorAfma6::updateArticularPosition(), and updateArticularPosition().

void vpViper::get_eJe	(	const vpColVector &	q,
		vpMatrix &	eJe
	)

inherited

Get the robot jacobian ${^e}{\bf J}_e$ which gives the velocity of the origin of the end-effector frame expressed in end-effector frame.

${^e}{\bf J}_e = \left[\begin{array}{cc} {^w}{\bf R}_f & {[{^e}{\bf t}_w}]_\times \; {^w}{\bf R}_f \\ 0_{3\times3} & {^w}{\bf R}_f \end{array} \right] \; {^f}{\bf J}_w$

Parameters

q	: A six-dimension vector that contains the joint positions of the robot expressed in radians.
eJe	: Robot jacobian ${^e}{\bf J}_e$ that express the velocity of the end-effector in the robot end-effector frame.

See also: get_fJw()

Definition at line 968 of file vpViper.cpp.

References vpHomogeneousMatrix::extract(), vpViper::get_fJw(), vpViper::get_fMw(), vpViper::get_wMe(), vpRotationMatrix::inverse(), vpHomogeneousMatrix::inverse(), and vpTranslationVector::skew().

Referenced by computeArticularVelocity(), get_eJe(), vpRobotViper650::get_eJe(), vpRobotViper850::get_eJe(), and getVelocity().

void vpSimulatorViper850::get_eJe ( vpMatrix & eJe )

virtual

Get the robot jacobian expressed in the end-effector frame.

To compute $^e{\bf J}_e$ , we communicate with the low level controller to get the joint position of the robot.

Parameters

eJe	: Robot jacobian $^e{\bf J}_e$ expressed in the end-effector frame.

Implements vpRobot.

Definition at line 2108 of file vpSimulatorViper850.cpp.

References vpRobotWireFrameSimulator::get_artCoord(), vpViper::get_eJe(), and vpERROR_TRACE.

void vpViper::get_eMc ( vpHomogeneousMatrix & eMc )

inherited

Get the geometric transformation between the end-effector frame and the camera frame. This transformation is constant and correspond to the extrinsic camera parameters estimated by calibration.

Parameters

eMc	: Transformation between the the end-effector frame and the camera frame.

See also: get_cMe()

Definition at line 897 of file vpViper.cpp.

References vpViper::eMc.

Referenced by vpViper::getInverseKinematics().

void vpViper::get_fJe	(	const vpColVector &	q,
		vpMatrix &	fJe
	)

inherited

Get the robot jacobian ${^f}{\bf J}_e$ which gives the velocity of the origin of the end-effector frame expressed in the robot reference frame also called fix frame.

${^f}{\bf J}_e = \left[\begin{array}{cc} I_{3\times3} & [{^f}{\bf R}_w \; {^e}{\bf t}_w]_\times \\ 0_{3\times3} & I_{3\times3} \end{array} \right] {^f}{\bf J}_w$

Parameters

q	: A six-dimension vector that contains the joint positions of the robot expressed in radians.
fJe	: Robot jacobian ${^f}{\bf J}_e$ that express the velocity of the end-effector in the robot reference frame.

See also: get_fJw

Definition at line 1160 of file vpViper.cpp.

References vpHomogeneousMatrix::extract(), vpViper::get_fJw(), vpViper::get_fMw(), vpViper::get_wMe(), and vpHomogeneousMatrix::inverse().

Referenced by computeArticularVelocity(), get_fJe(), vpRobotViper650::get_fJe(), vpRobotViper850::get_fJe(), and getVelocity().

void vpSimulatorViper850::get_fJe ( vpMatrix & fJe )

virtual

Get the robot jacobian expressed in the robot reference frame also called fix frame.

To compute $^f{\bf J}_e$ , we communicate with the low level controller to get the joint position of the robot.

Parameters

fJe	: Robot jacobian $^f{\bf J}_e$ expressed in the reference frame.

Implements vpRobot.

Definition at line 2132 of file vpSimulatorViper850.cpp.

References vpRobotWireFrameSimulator::get_artCoord(), vpViper::get_fJe(), and vpERROR_TRACE.

void vpViper::get_fJw	(	const vpColVector &	q,
		vpMatrix &	fJw
	)

inherited

Get the robot jacobian ${^f}{\bf J}_w$ which express the velocity of the origin of the wrist frame in the robot reference frame also called fix frame.

${^f}J_w = \left(\begin{array}{cccccc} J_{11} & J_{12} & J_{13} & 0 & 0 & 0 \\ J_{21} & J_{22} & J_{23} & 0 & 0 & 0 \\ 0 & J_{32} & J_{33} & 0 & 0 & 0 \\ 0 & -s1 & -s1 & c1s23 & J_{45} & J_{46} \\ 0 & c1 & c1 & s1s23 & J_{55} & J_{56} \\ 1 & 0 & 0 & c23 & s23s4 & J_{56} \\ \end{array} \right)$

with

$\begin{array}{l} J_{11} = -s1(-c23a3+s23d4+a1+a2c2) \\ J_{21} = c1(-c23a3+s23d4+a1+a2c2) \\ J_{12} = c1(s23a3+c23d4-a2s2) \\ J_{22} = s1(s23a3+c23d4-a2s2) \\ J_{32} = c23a3-s23d4-a2c2 \\ J_{13} = c1(a3(s2c3+c2s3)+(-s2s3+c2c3)d4)\\ J_{23} = s1(a3(s2c3+c2s3)+(-s2s3+c2c3)d4)\\ J_{33} = -a3(s2s3-c2c3)-d4(s2c3+c2s3)\\ J_{45} = -c23c1s4-s1c4\\ J_{55} = c1c4-c23s1s4\\ J_{46} = (c1c23c4-s1s4)s5+c1s23c5\\ J_{56} = (s1c23c4+c1s4)s5+s1s23c5\\ J_{66} = -s23c4s5+c23c5\\ \end{array}$

Parameters

q	: A six-dimension vector that contains the joint positions of the robot expressed in radians.
fJw	: Robot jacobian ${^f}{\bf J}_w$ that express the velocity of the point w (origin of the wrist frame) in the robot reference frame.

See also: get_fJe(), get_eJe()

Definition at line 1054 of file vpViper.cpp.

References vpViper::a1, vpViper::a2, vpViper::a3, vpViper::d4, and vpMatrix::resize().

Referenced by vpViper::get_eJe(), and vpViper::get_fJe().

vpHomogeneousMatrix vpViper::get_fMc ( const vpColVector & q )

inherited

Compute the forward kinematics (direct geometric model) as an homogeneous matrix.

By forward kinematics we mean here the position and the orientation of the camera relative to the base frame given the joint positions of all the six joints.

$^f{\bf M}_c = ^f{\bf M}_e \; ^e{\bf M}_c$

This method is the same than getForwardKinematics(const vpColVector & q).

Parameters

q	: Vector of six joint positions expressed in radians.

Returns: The homogeneous matrix corresponding to the direct geometric model which expresses the transformation between the base frame and the camera frame (fMc).

See also: getForwardKinematics(const vpColVector & q), get_fMe(), get_eMc()

Examples:: testRobotViper850Pose.cpp.

Definition at line 597 of file vpViper.cpp.

Referenced by compute_fMi(), vpViper::getForwardKinematics(), getPosition(), vpRobotViper850::getVelocity(), vpRobotViper650::getVelocity(), setPosition(), vpRobotViper650::setPosition(), and vpRobotViper850::setPosition().

void vpViper::get_fMc	(	const vpColVector &	q,
		vpHomogeneousMatrix &	fMc
	)

inherited

Compute the forward kinematics (direct geometric model) as an homogeneous matrix.

By forward kinematics we mean here the position and the orientation of the camera relative to the base frame given the six joint positions.

$^f{\bf M}_c = ^f{\bf M}_e \; {^e}{\bf M}_c$

Parameters

q	: Vector of six joint positions expressed in radians.
fMc	The homogeneous matrix $^f{\bf M}_c$ corresponding to the direct geometric model which expresses the transformation between the fix frame and the camera frame.

See also: get_fMe(), get_eMc()

Definition at line 627 of file vpViper.cpp.

References vpViper::eMc, and vpViper::get_fMe().

void vpViper::get_fMe	(	const vpColVector &	q,
		vpHomogeneousMatrix &	fMe
	)

inherited

Compute the forward kinematics (direct geometric model) as an homogeneous matrix ${^f}{\bf M}_e$ .

By forward kinematics we mean here the position and the orientation of the end effector with respect to the base frame given the motor positions of all the six joints.

${^f}M_e = \left(\begin{array}{cccc} r_{11} & r_{12} & r_{13} & t_x \\ r_{21} & r_{22} & r_{23} & t_y \\ r_{31} & r_{32} & r_{33} & t_z \\ \end{array} \right)$

with

$\begin{array}{l} r_{11} = c1(c23(c4c5c6-s4s6)-s23s5c6)-s1(s4c5c6+c4s6) \\ r_{21} = -s1(c23(-c4c5c6+s4s6)+s23s5c6)+c1(s4c5c6+c4s6) \\ r_{31} = s23(s4s6-c4c5c6)-c23s5c6 \\ \\ r_{12} = -c1(c23(c4c5s6+s4c6)-s23s5s6)+s1(s4c5s6-c4c6)\\ r_{22} = -s1(c23(c4c5s6+s4c6)-s23s5s6)-c1(s4c5s6-c4c6)\\ r_{32} = s23(c4c5s6+s4c6)+c23s5s6\\ \\ r_{13} = c1(c23c4s5+s23c5)-s1s4s5\\ r_{23} = s1(c23c4s5+s23c5)+c1s4s5\\ r_{33} = -s23c4s5+c23c5\\ \\ t_x = c1(c23(c4s5d6-a3)+s23(c5d6+d4)+a1+a2c2)-s1s4s5d6\\ t_y = s1(c23(c4s5d6-a3)+s23(c5d6+d4)+a1+a2c2)+c1s4s5d6\\ t_z = s23(a3-c4s5d6)+c23(c5d6+d4)-a2s2+d1\\ \end{array}$

Parameters

q	: A 6-dimension vector that contains the 6 joint positions expressed in radians.
fMe	The homogeneous matrix ${^f}{\bf M}_e$ corresponding to the direct geometric model which expresses the transformation between the fix frame and the end effector frame.

Note that this transformation can also be computed by considering the wrist frame ${^f}{\bf M}_e = {^f}{\bf M}_w *{^w}{\bf M}_e$ .

#include <visp/vpViper.h>
int main()
{
  vpViper robot;
  vpColVector q(6); // The measured six joint positions
  vpHomogeneousMatrix fMe; // Transformation from fix frame to end-effector
  robot.get_fMe(q, fMe); // Get the forward kinematics
  // The forward kinematics can also be computed by considering the wrist frame
  vpHomogeneousMatrix fMw; // Transformation from fix frame to wrist frame
  robot.get_fMw(q, fMw);
  vpHomogeneousMatrix wMe; // Transformation from wrist frame to end-effector
  robot.get_wMe(wMe); // Constant transformation
  // Compute the forward kinematics
  fMe = fMw * wMe;
}

Examples:: testRobotViper850.cpp, and testViper850.cpp.

Definition at line 714 of file vpViper.cpp.

References vpViper::a1, vpViper::a2, vpViper::a3, vpViper::d1, vpViper::d4, and vpViper::d6.

Referenced by vpViper::get_fMc().

void vpSimulatorViper850::get_fMi ( vpHomogeneousMatrix * fMit )

inlineprotectedvirtual

Get a table of poses between the reference frame and the frames you used to compute the Denavit-Hartenberg representation

Implements vpRobotWireFrameSimulator.

Definition at line 281 of file vpSimulatorViper850.h.

Referenced by getExternalImage(), initialiseObjectRelativeToCamera(), and updateArticularPosition().

vpHomogeneousMatrix vpRobotWireFrameSimulator::get_fMo ( ) const

inlineinherited

Get the pose between the object and the fixed world frame.

Returns: The pose between the object and the fixed world frame.

Definition at line 217 of file vpRobotWireFrameSimulator.h.

References vpWireFrameSimulator::fMo.

void vpWireFrameSimulator::get_fMo_History ( std::list< vpHomogeneousMatrix > & fMo_history )

inlineinherited

Get the homogeneous matrices fMo stored to display the camera trajectory.

Parameters

fMo_history : The list of the homogeneous matrices fMo.

Definition at line 432 of file vpWireFrameSimulator.h.

vp_deprecated vpList<vpHomogeneousMatrix> vpWireFrameSimulator::get_fMo_History ( )

inlineinherited

Deprecated:: This method is deprecated. You should use get_fMo_History(std::list<vpHomogeneousMatrix> &) instead.

Get the homogeneous matrices fMo stored to display the camera trajectory.

Returns: Returns the list of the homogeneous matrices fMo.

Definition at line 602 of file vpWireFrameSimulator.h.

References vpList< type >::addRight().

void vpViper::get_fMw	(	const vpColVector &	q,
		vpHomogeneousMatrix &	fMw
	)

inherited

Compute the transformation between the fix frame and the wrist frame. The wrist frame is located on the intersection of the 3 last rotations.

Parameters

q	: A 6-dimension vector that contains the 6 joint positions expressed in radians.
fMw	The homogeneous matrix corresponding to the transformation between the fix frame and the wrist frame (fMw).

${^f}M_w = \left(\begin{array}{cccc} r_{11} & r_{12} & r_{13} & t_x \\ r_{21} & r_{22} & r_{23} & t_y \\ r_{31} & r_{32} & r_{33} & t_z \\ \end{array} \right)$

with

$\begin{array}{l} r_{11} = c1(c23(c4c5c6-s4s6)-s23s5c6)-s1(s4c5c6+c4s6) \\ r_{21} = -s1(c23(-c4c5c6+s4s6)+s23s5c6)+c1(s4c5c6+c4s6) \\ r_{31} = s23(s4s6-c4c5c6)-c23s5c6 \\ \\ r_{12} = -c1(c23(c4c5s6+s4c6)-s23s5s6)+s1(s4c5s6-c4c6)\\ r_{22} = -s1(c23(c4c5s6+s4c6)-s23s5s6)-c1(s4c5s6-c4c6)\\ r_{32} = s23(c4c5s6+s4c6)+c23s5s6\\ \\ r_{13} = c1(c23c4s5+s23c5)-s1s4s5\\ r_{23} = s1(c23c4s5+s23c5)+c1s4s5\\ r_{33} = -s23c4s5+c23c5\\ \\ t_x = c1(-c23a3+s23d4+a1+a2c2)\\ t_y = s1(-c23a3+s23d4+a1+a2c2)\\ t_z = s23a3+c23d4-a2s2+d1\\ \end{array}$

Definition at line 810 of file vpViper.cpp.

References vpViper::a1, vpViper::a2, vpViper::a3, vpViper::d1, and vpViper::d4.

Referenced by vpViper::get_eJe(), and vpViper::get_fJe().

vpColVector vpRobotWireFrameSimulator::get_velocity ( )

inlineprotectedinherited

Definition at line 365 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::computeArticularVelocity(), and computeArticularVelocity().

void vpViper::get_wMe ( vpHomogeneousMatrix & wMe )

inherited

Return the transformation between the wrist frame and the end-effector. The wrist frame is located on the intersection of the 3 last rotations.

Parameters

wMe	The homogeneous matrix corresponding to the transformation between the wrist frame and the end-effector frame (wMe).

Definition at line 876 of file vpViper.cpp.

References vpViper::d6, and vpHomogeneousMatrix::setIdentity().

Referenced by vpViper::get_eJe(), vpViper::get_fJe(), and vpViper::getInverseKinematics().

void vpSimulatorViper850::getCameraParameters	(	vpCameraParameters &	cam,
		const unsigned int &	image_width,
		const unsigned int &	image_height
	)

Get the current intrinsic camera parameters obtained by calibration.

Parameters

cam	: In output, camera parameters to fill.
image_width	: Image width used to compute camera calibration.
image_height	: Image height used to compute camera calibration.

Warning: The image size must be : 640x480 !

Definition at line 336 of file vpSimulatorViper850.cpp.

References vpViper850::CONST_MARLIN_F033C_CAMERA_NAME, vpViper850::CONST_PTGREY_FLEA2_CAMERA_NAME, vpViper850::getToolType(), vpCameraParameters::initPersProjWithoutDistortion(), vpWireFrameSimulator::px_int, vpWireFrameSimulator::py_int, vpViper850::TOOL_GENERIC_CAMERA, vpViper850::TOOL_MARLIN_F033C_CAMERA, vpViper850::TOOL_PTGREY_FLEA2_CAMERA, vpViper850::TOOL_SCHUNK_GRIPPER_CAMERA, and vpTRACE.

Referenced by getCameraParameters(), and initDisplay().

void vpSimulatorViper850::getCameraParameters	(	vpCameraParameters &	cam,
		const vpImage< unsigned char > &	I
	)

Get the current intrinsic camera parameters obtained by calibration.

Parameters

cam	: In output, camera parameters to fill.
I	: A B&W image send by the current camera in use.

Warning: The image size must be : 640x480 !

Definition at line 389 of file vpSimulatorViper850.cpp.

References getCameraParameters(), vpImage< Type >::getHeight(), and vpImage< Type >::getWidth().

void vpSimulatorViper850::getCameraParameters	(	vpCameraParameters &	cam,
		const vpImage< vpRGBa > &	I
	)

Get the current intrinsic camera parameters obtained by calibration.

Parameters

cam	: In output, camera parameters to fill.
I	: A B&W image send by the current camera in use.

Warning: The image size must be : 640x480 !

Definition at line 404 of file vpSimulatorViper850.cpp.

References getCameraParameters(), vpImage< Type >::getHeight(), and vpImage< Type >::getWidth().

vpCameraParameters::vpCameraParametersProjType vpViper850::getCameraParametersProjType ( )

inlineinherited

Get the current camera model projection type.

Definition at line 114 of file vpViper850.h.

double vpViper::getCoupl56 ( )

inherited

Return the coupling factor between join 5 and joint 6.

This factor should be only useful when motor positions are considered. Since the positions returned by the robot are joint positions which takes into account the coupling factor, it has not to be considered in the modelization of the robot.

Definition at line 1231 of file vpViper.cpp.

References vpViper::c56.

void vpSimulatorViper850::getDisplacement	(	const vpRobot::vpControlFrameType	frame,
		vpColVector &	displacement
	)

virtual

Get the robot displacement since the last call of this method.

Warning: This functionnality is not implemented for the moment in the cartesian space. It is only available in the joint space (vpRobot::ARTICULAR_FRAME).

Parameters

frame	: The frame in which the measured displacement is expressed.
displacement	: The measured displacement since the last call of this method. The dimension of displacement is always Translations are expressed in meters, rotations in radians.

In camera or reference frame, rotations are expressed with the Euler Rxyz representation.

See also: getArticularDisplacement(), getCameraDisplacement()

Implements vpRobot.

Definition at line 1834 of file vpSimulatorViper850.cpp.

References vpRobot::ARTICULAR_FRAME, vpRobot::CAMERA_FRAME, vpRobotWireFrameSimulator::get_artCoord(), vpRobot::MIXT_FRAME, vpRobot::REFERENCE_FRAME, and vpColVector::resize().

vpCameraParameters vpRobotWireFrameSimulator::getExternalCameraParameters ( ) const

inlineinherited

Get the parameters of the virtual external camera.

Returns: It returns the camera parameters.

Definition at line 186 of file vpRobotWireFrameSimulator.h.

References vpImage< Type >::getHeight(), vpImage< Type >::getWidth(), vpMath::maximum(), and vpMath::minimum().

vpCameraParameters vpWireFrameSimulator::getExternalCameraParameters ( const vpImage< unsigned char > & I ) const

inlineinherited

Get the parameters of the virtual external camera.

Parameters

I	: The image used to display the view of the camera.

Returns: It returns the camera parameters.

Definition at line 316 of file vpWireFrameSimulator.h.

References vpImage< Type >::getHeight(), vpImage< Type >::getWidth(), vpMath::maximum(), and vpMath::minimum().

Referenced by vpWireFrameSimulator::projectCameraTrajectory().

vpCameraParameters vpWireFrameSimulator::getExternalCameraParameters ( const vpImage< vpRGBa > & I ) const

inlineinherited

Get the parameters of the virtual external camera.

Parameters

I	: The image used to display the view of the camera.

Returns: It returns the camera parameters.

Definition at line 335 of file vpWireFrameSimulator.h.

References vpImage< Type >::getHeight(), vpImage< Type >::getWidth(), vpMath::maximum(), and vpMath::minimum().

vpHomogeneousMatrix vpRobotWireFrameSimulator::getExternalCameraPosition ( ) const

inlineinherited

Get the external camera's position relative to the the world reference frame.

Returns: the main external camera position relative to the the world reference frame.

Definition at line 203 of file vpRobotWireFrameSimulator.h.

References vpWireFrameSimulator::getExternalCameraPosition().

Referenced by vpSimulatorAfma6::updateArticularPosition(), and updateArticularPosition().

void vpSimulatorViper850::getExternalImage ( vpImage< vpRGBa > & I )

protected

void vpWireFrameSimulator::getExternalImage ( vpImage< unsigned char > & I )

inherited

Get the external view. It corresponds to the view of the scene from a reference frame you have to set.

Parameters

I	: The image where the external view is displayed.

Warning: : The objects are displayed thanks to overlays. The image I is not modified.

Examples:: servoSimu4Points.cpp, servoSimuCylinder.cpp, servoSimuSphere.cpp, and wireframeSimulator.cpp.

Definition at line 1395 of file vpWireFrameSimulator.cpp.

void vpWireFrameSimulator::getExternalImage	(	vpImage< unsigned char > &	I,
		const vpHomogeneousMatrix &	camMf
	)

inherited

Get an external view. The point of view is set thanks to the pose between the camera camMf and the fixed world frame.

Parameters

I	: The image where the external view is displayed.
camMf	: The pose between the point of view and the fixed world frame.

Warning: : The objects are displayed thanks to overlays. The image I is not modified.

Definition at line 1536 of file vpWireFrameSimulator.cpp.

void vpWireFrameSimulator::getExternalImage	(	vpImage< vpRGBa > &	I,
		const vpHomogeneousMatrix &	camMf
	)

inherited

Get an external view. The point of view is set thanks to the pose between the camera camMf and the fixed world frame.

Parameters

I	: The image where the external view is displayed.
camMf	: The pose between the point of view and the fixed world frame.

Warning: : The objects are displayed thanks to overlays. The image I is not modified.

Definition at line 1253 of file vpWireFrameSimulator.cpp.

vpHomogeneousMatrix vpViper::getForwardKinematics ( const vpColVector & q )

inherited

Compute the forward kinematics (direct geometric model) as an homogeneous matrix.

By forward kinematics we mean here the position and the orientation of the camera relative to the base frame given the six joint positions.

This method is the same than get_fMc(const vpColVector & q).

Parameters

q	: A six dimension vector corresponding to the robot joint positions expressed in radians.

Returns: The homogeneous matrix $^f{\bf M}_c$ corresponding to the direct geometric model which expresses the transformation between the base frame and the camera frame.

See also: get_fMc(const vpColVector & q); getInverseKinematics()

Definition at line 128 of file vpViper.cpp.

References vpViper::get_fMc().

vpCameraParameters vpWireFrameSimulator::getInternalCameraParameters ( const vpImage< unsigned char > & I ) const

inlineinherited

Get the parameters of the virtual internal camera.

Parameters

I	: The image used to display the view of the camera.

Returns: It returns the camera parameters.

Definition at line 366 of file vpWireFrameSimulator.h.

References vpImage< Type >::getHeight(), vpImage< Type >::getWidth(), vpMath::maximum(), and vpMath::minimum().

Referenced by vpWireFrameSimulator::getExternalImage(), and vpWireFrameSimulator::getInternalImage().

vpCameraParameters vpWireFrameSimulator::getInternalCameraParameters ( const vpImage< vpRGBa > & I ) const

inlineinherited

Get the parameters of the virtual internal camera.

Parameters

I	: The image used to display the view of the camera.

Returns: It returns the camera parameters.

Definition at line 385 of file vpWireFrameSimulator.h.

References vpImage< Type >::getHeight(), vpImage< Type >::getWidth(), vpMath::maximum(), and vpMath::minimum().

void vpWireFrameSimulator::getInternalImage ( vpImage< unsigned char > & I )

inherited

Get the internal view ie the view of the camera.

Parameters

I	: The image where the internal view is displayed.

Warning: : The objects are displayed thanks to overlays. The image I is not modified.

Examples:: servoSimu4Points.cpp, servoSimuCylinder.cpp, servoSimuSphere.cpp, and wireframeSimulator.cpp.

Definition at line 1317 of file vpWireFrameSimulator.cpp.

void vpWireFrameSimulator::getInternalImage ( vpImage< vpRGBa > & I )

inherited

Get the internal view ie the view of the camera.

Parameters

I	: The image where the internal view is displayed.

Warning: : The objects are displayed thanks to overlays. The image I is not modified.

Definition at line 1032 of file vpWireFrameSimulator.cpp.

void vpRobotWireFrameSimulator::getInternalView ( vpImage< vpRGBa > & I )

inherited

Get the view of the camera's robot.

According to the initialisation method you used, the current position and maybee the desired position of the object are displayed.

Parameters

I	: The image where the internal view is displayed.

Warning: : The objects are displayed thanks to overlays. The image I is not modified.

Definition at line 210 of file vpRobotWireFrameSimulator.cpp.

Referenced by vpSimulatorAfma6::setPosition().

void vpRobotWireFrameSimulator::getInternalView ( vpImage< unsigned char > & I )

inherited

Get the view of the camera's robot.

According to the initialisation method you used, the current position and maybee the desired position of the object are displayed.

Parameters

I	: The image where the internal view is displayed.

Warning: : The objects are displayed thanks to overlays. The image I is not modified.

Definition at line 283 of file vpRobotWireFrameSimulator.cpp.

unsigned int vpViper::getInverseKinematics	(	const vpHomogeneousMatrix &	fMc,
		vpColVector &	q
	)

inherited

Compute the inverse kinematics (inverse geometric model).

By inverse kinematics we mean here the six joint values given the position and the orientation of the camera frame relative to the base frame.

Parameters

fMc	: Homogeneous matrix $^f{\bf M}_c$ describing the transformation from base frame to the camera frame.
q	: In input, a six dimension vector corresponding to the current joint positions expressed in radians. In output, the solution of the inverse kinematics, ie. the joint positions corresponding to $^f{\bf M}_c$ .

Returns: The number of solutions (1 to 8) of the inverse geometric model. O, if no solution can be found.

The code below shows how to compute the inverse geometric model:

vpColVector q1(6), q2(6);
vpHomogeneousMatrix fMc;
vpViper robot;
// Get the current joint position of the robot
robot.getPosition(vpRobot::ARTICULAR_FRAME, q1);
// Compute the pose of the camera in the reference frame using the
// direct geometric model
fMc = robot.getForwardKinematics(q1);
// this is similar to  fMc = robot.get_fMc(q1);
// or robot.get_fMc(q1, fMc);
// Compute the inverse geometric model
int nbsol; // number of solutions (0, 1 to 8) of the inverse geometric model
// get the nearest solution to the current joint position
nbsol = robot.getInverseKinematics(fMc, q1);
if (nbsol == 0)
  std::cout << "No solution of the inverse geometric model " << std::endl;
else if (nbsol >= 1)
  std::cout << "Nearest solution: " << q1 << std::endl;

See also: getForwardKinematics(), getInverseKinematicsWrist

Definition at line 559 of file vpViper.cpp.

References vpViper::eMc, vpViper::get_eMc(), vpViper::get_wMe(), vpViper::getInverseKinematicsWrist(), and vpHomogeneousMatrix::inverse().

Referenced by initialiseCameraRelativeToObject(), setPosition(), vpRobotViper650::setPosition(), and vpRobotViper850::setPosition().

unsigned int vpViper::getInverseKinematicsWrist	(	const vpHomogeneousMatrix &	fMw,
		vpColVector &	q
	)

inherited

Compute the inverse kinematics (inverse geometric model).

By inverse kinematics we mean here the six joint values given the position and the orientation of the camera frame relative to the base frame.

Parameters

fMw	: Homogeneous matrix $^f{\bf M}_w$ describing the transformation from base frame to the wrist frame.
q	: In input, a six dimension vector corresponding to the current joint positions expressed in radians. In output, the solution of the inverse kinematics, ie. the joint positions corresponding to $^f{\bf M}_w$ .

Returns: The number of solutions (1 to 8) of the inverse geometric model. O, if no solution can be found.

The code below shows how to compute the inverse geometric model:

vpColVector q1(6), q2(6);
vpHomogeneousMatrix fMw;
vpViper robot;
// Get the current joint position of the robot
robot.getPosition(vpRobot::ARTICULAR_FRAME, q1);
// Compute the pose of the wrist in the reference frame using the
// direct geometric model
robot.get_fMw(q1, fMw);
// Compute the inverse geometric model
int nbsol; // number of solutions (0, 1 to 8) of the inverse geometric model
// get the nearest solution to the current joint position
nbsol = robot.getInverseKinematicsWrist(fMw, q1);
if (nbsol == 0)
  std::cout << "No solution of the inverse geometric model " << std::endl;
else if (nbsol >= 1)
  std::cout << "Nearest solution: " << q1 << std::endl;

See also: getForwardKinematics(), getInverseKinematics()

Definition at line 221 of file vpViper.cpp.

References vpViper::a1, vpViper::a2, vpViper::a3, vpViper::d1, vpViper::d4, vpMatrix::getRows(), vpViper::njoint, vpMath::rad(), vpColVector::resize(), and vpMath::sqr().

Referenced by vpViper::getInverseKinematics().

vpColVector vpViper::getJointMax ( )

inherited

Get maximal joint values.

Returns: A 6-dimension vector that contains the maximal joint values for the 6 dof. All the values are expressed in radians.

Examples:: servoViper850Point2DArtVelocity-jointAvoidance-basic.cpp, and servoViper850Point2DArtVelocity-jointAvoidance-gpa.cpp.

Definition at line 1215 of file vpViper.cpp.

References vpViper::joint_max.

vpColVector vpViper::getJointMin ( )

inherited

Get minimal joint values.

Returns: A 6-dimension vector that contains the minimal joint values for the 6 dof. All the values are expressed in radians.

Examples:: servoViper850Point2DArtVelocity-jointAvoidance-basic.cpp, and servoViper850Point2DArtVelocity-jointAvoidance-gpa.cpp.

Definition at line 1202 of file vpViper.cpp.

References vpViper::joint_min.

double vpRobot::getMaxRotationVelocity ( void ) const

inherited

Get the maximal rotation velocity that can be sent to the robot during a velocity control.

Returns: Maximum rotation velocity expressed in rad/s.

Definition at line 228 of file vpRobot.cpp.

Referenced by vpSimulatorAfma6::computeArticularVelocity(), computeArticularVelocity(), vpSimulatorAfma6::findHighestPositioningSpeed(), findHighestPositioningSpeed(), vpSimulatorAfma6::setPosition(), vpSimulatorCamera::setVelocity(), vpRobotCamera::setVelocity(), vpSimulatorPioneer::setVelocity(), vpSimulatorPioneerPan::setVelocity(), vpRobotPioneer::setVelocity(), vpSimulatorAfma6::setVelocity(), setVelocity(), vpRobotAfma4::setVelocity(), vpRobotAfma6::setVelocity(), vpRobotViper650::setVelocity(), and vpRobotViper850::setVelocity().

double vpRobot::getMaxTranslationVelocity ( void ) const

inherited

Get the maximal translation velocity that can be sent to the robot during a velocity control.

Returns: Maximum translation velocity expressed in m/s.

Definition at line 203 of file vpRobot.cpp.

Referenced by vpSimulatorAfma6::setPosition(), vpSimulatorCamera::setVelocity(), vpRobotCamera::setVelocity(), vpSimulatorPioneer::setVelocity(), vpSimulatorPioneerPan::setVelocity(), vpRobotPioneer::setVelocity(), vpSimulatorAfma6::setVelocity(), setVelocity(), vpRobotAfma4::setVelocity(), vpRobotAfma6::setVelocity(), vpRobotViper650::setVelocity(), and vpRobotViper850::setVelocity().

vpColVector vpRobot::getPosition ( const vpRobot::vpControlFrameType frame )

inherited

Return the current robot position in the specified frame.

Definition at line 171 of file vpRobot.cpp.

void vpSimulatorViper850::getPosition	(	const vpRobot::vpControlFrameType	frame,
		vpColVector &	q
	)

virtual

Get the current position of the robot.

Parameters

frame

: Control frame type in which to get the position, either :

in the camera cartesien frame,
joint (articular) coordinates of each axes
in a reference or fixed cartesien frame attached to the robot base
in a mixt cartesien frame (translation in reference frame, and rotation in camera frame)

q

: Measured position of the robot:

in camera cartesien frame, a 6 dimension vector, set to 0.
in articular, a 6 dimension vector corresponding to the joint position of each dof in radians.
in reference frame, a 6 dimension vector, the first 3 values correspond to the translation tx, ty, tz in meters (like a vpTranslationVector), and the last 3 values to the rx, ry, rz rotation (like a vpRxyzVector). The code below show how to convert this position into a vpHomogenousMatrix:

#include <visp/vpConfig.h>
#include <visp/vpSimulatorViper850.h>
#include <visp/vpColVector.h>
#include <visp/vpTranslationVector.h>
#include <visp/vpRxyzVector.h>
#include <visp/vpRotationMatrix.h>
#include <visp/vpHomogeneousMatrix.h>
int main()
{
  vpSimulatorViper850 robot;
  vpColVector position;
  robot.getPosition(vpRobot::REFERENCE_FRAME, position);
  vpTranslationVector ftc; // reference frame to camera frame translations
  vpRxyzVector frc; // reference frame to camera frame rotations
  // Update the transformation between reference frame and camera frame
  for (int i=0; i < 3; i++) {
    ftc[i] = position[i];   // tx, ty, tz
    frc[i] = position[i+3]; // ry, ry, rz
  }
  // Create a rotation matrix from the Rxyz rotation angles
  vpRotationMatrix fRc(frc); // reference frame to camera frame rotation matrix
  // Create the camera to fix frame transformation in terms of a
  // homogenous matrix
  vpHomogeneousMatrix fMc(fRc, ftc);
}

See also: setPosition(const vpRobot::vpControlFrameType frame, const vpColVector & r)

Implements vpRobot.

Definition at line 1572 of file vpSimulatorViper850.cpp.

References vpRobot::ARTICULAR_FRAME, vpRobot::CAMERA_FRAME, vpHomogeneousMatrix::extract(), vpWireFrameSimulator::fMc, vpRobotWireFrameSimulator::get_artCoord(), vpViper::get_fMc(), vpRobotException::lowLevelError, vpRobot::MIXT_FRAME, vpRobot::REFERENCE_FRAME, vpColVector::resize(), and vpERROR_TRACE.

Referenced by getPosition().

void vpSimulatorViper850::getPosition	(	const vpRobot::vpControlFrameType	frame,
		vpPoseVector &	position
	)

Get the current position of the robot.

The difference is here that the position is returned using a ThetaU representation.

See also: getPosition(const vpRobot::vpControlFrameType frame, vpColVector &)

Definition at line 1633 of file vpSimulatorViper850.cpp.

References getPosition().

double vpSimulatorViper850::getPositioningVelocity ( void )

inline

Definition at line 237 of file vpSimulatorViper850.h.

Referenced by findHighestPositioningSpeed().

vpControlFrameType vpRobot::getRobotFrame ( void )

inlineprotectedinherited

Definition at line 159 of file vpRobot.h.

Referenced by vpSimulatorAfma6::computeArticularVelocity(), and computeArticularVelocity().

virtual vpRobotStateType vpRobot::getRobotState ( void )

inlinevirtualinherited

Definition at line 139 of file vpRobot.h.

double vpRobotSimulator::getSamplingTime ( ) const

inlineinherited

Return the sampling time.

Returns: Sampling time in second used to compute the robot displacement from the velocity applied to the robot during this time.

Definition at line 83 of file vpRobotSimulator.h.

Referenced by vpSimulatorAfma6::updateArticularPosition(), and updateArticularPosition().

vpToolType vpViper850::getToolType ( )

inlineinherited

Get the current tool type.

Definition at line 126 of file vpViper850.h.

Referenced by vpViper850::getCameraParameters(), and getCameraParameters().

void vpSimulatorViper850::getVelocity	(	const vpRobot::vpControlFrameType	frame,
		vpColVector &	vel
	)

Get the robot velocities.

Parameters

frame	: Frame in wich velocities are mesured.
vel	: Measured velocities. Translations are expressed in m/s and rotations in rad/s.

Warning: In camera frame, reference frame and mixt frame, the representation of the rotation is ThetaU. In that cases, $velocity = [\dot x, \dot y, \dot z, \dot {\theta U}_x, \dot {\theta U}_y, \dot {\theta U}_z]$ .

#include <visp/vpConfig.h>
#include <visp/vpSimulatorViper850.h>
#include <visp/vpColVector.h>
int main()
{
  // Set requested joint velocities
  vpColVector q_dot(6);
  q_dot[0] = 0.1;    // Joint 1 velocity in rad/s
  q_dot[1] = 0.2;    // Joint 2 velocity in rad/s
  q_dot[2] = 0.3;    // Joint 3 velocity in rad/s
  q_dot[3] = M_PI/8; // Joint 4 velocity in rad/s
  q_dot[4] = M_PI/4; // Joint 5 velocity in rad/s
  q_dot[5] = M_PI/16;// Joint 6 velocity in rad/s
  vpSimulatorViper850 robot;
  
  robot.setRobotState(vpRobot::STATE_VELOCITY_CONTROL);
  // Moves the joint in velocity
  robot.setVelocity(vpRobot::ARTICULAR_FRAME, q_dot);
  // Initialisation of the velocity measurement
  vpColVector q_dot_mes; // Measured velocities
  for ( ; ; ) {
    robot.getVelocity(vpRobot::ARTICULAR_FRAME, q_dot_mes);
     vpTime::wait(40); // wait 40 ms
     // here q_dot_mes is equal to [0.1, 0.2, 0.3, M_PI/8, M_PI/4, M_PI/16]
  }
}

Definition at line 1045 of file vpSimulatorViper850.cpp.

References vpRobot::ARTICULAR_FRAME, vpRobot::CAMERA_FRAME, vpRobot::eJe, vpViper::eMc, vpRobot::fJe, vpRobotWireFrameSimulator::get_artCoord(), vpRobotWireFrameSimulator::get_artVel(), vpViper::get_eJe(), vpViper::get_fJe(), vpRobot::MIXT_FRAME, vpRobot::REFERENCE_FRAME, vpColVector::resize(), and vpERROR_TRACE.

Referenced by getVelocity().

vpColVector vpSimulatorViper850::getVelocity ( const vpRobot::vpControlFrameType frame )

Get the robot velocities.

Parameters

frame : Frame in wich velocities are mesured.

Returns: Measured velocities. Translations are expressed in m/s and rotations in rad/s.

#include <visp/vpConfig.h>
#include <visp/vpSimulatorViper850.h>
#include <visp/vpColVector.h>
int main()
{
  // Set requested joint velocities
  vpColVector q_dot(6);
  q_dot[0] = 0.1;    // Joint 1 velocity in rad/s
  q_dot[1] = 0.2;    // Joint 2 velocity in rad/s
  q_dot[2] = 0.3;    // Joint 3 velocity in rad/s
  q_dot[3] = M_PI/8; // Joint 4 velocity in rad/s
  q_dot[4] = M_PI/4; // Joint 5 velocity in rad/s
  q_dot[5] = M_PI/16;// Joint 6 velocity in rad/s
  vpSimulatorViper850 robot;
  
  robot.setRobotState(vpRobot::STATE_VELOCITY_CONTROL);
  // Moves the joint in velocity
  robot.setVelocity(vpRobot::ARTICULAR_FRAME, q_dot);
  // Initialisation of the velocity measurement
  vpColVector q_dot_mes; // Measured velocities
  for ( ; ; ) {
     q_dot_mes = robot.getVelocity(vpRobot::ARTICULAR_FRAME);
     vpTime::wait(40); // wait 40 ms
     // here q_dot_mes is equal to [0.1, 0.2, 0.3, M_PI/8, M_PI/4, M_PI/16]
  }
}

Definition at line 1130 of file vpSimulatorViper850.cpp.

References getVelocity(), and vpRobotWireFrameSimulator::velocity.

void vpViper850::init ( const char * camera_extrinsic_parameters )

inherited

Read files containing the constant parameters related to the robot tools in order to set the end-effector to camera transformation.

Warning: This function is only available if the macro VISP_HAVE_ACCESS_TO_NAS is defined in vpConfig.h.

Parameters

camera_extrinsic_parameters : Filename containing the camera extrinsic parameters.

Definition at line 194 of file vpViper850.cpp.

References vpViper850::parseConfigFile().

void vpSimulatorViper850::init	(	vpViper850::vpToolType	tool,
		vpCameraParameters::vpCameraParametersProjType	projModel = `vpCameraParameters::perspectiveProjWithoutDistortion`
	)

Initialize the robot kinematics with the extrinsic calibration parameters associated to a specific camera.

The eMc parameters depend on the camera.

Warning: Only perspective projection without distorsion is available!

Parameters

tool	: Tool to use.
projModel	: Projection model associated to the camera.

See also: vpCameraParameters, init()

Definition at line 282 of file vpSimulatorViper850.cpp.

References vpHomogeneousMatrix::buildFrom(), vpViper::eMc, vpViper::erc, vpViper::etc, vpViper850::projModel, vpMath::rad(), setCameraParameters(), vpViper850::setToolType(), vpViper850::TOOL_GENERIC_CAMERA, vpViper850::TOOL_MARLIN_F033C_CAMERA, vpViper850::TOOL_PTGREY_FLEA2_CAMERA, and vpViper850::TOOL_SCHUNK_GRIPPER_CAMERA.

void vpSimulatorViper850::init ( void )

protectedvirtual

Method which initialises the parameters linked to the robot caracteristics.

Set the path to the arm files (*.bnd and *.sln) used by the simulator. If the path set in vpConfig.h in VISP_ROBOT_ARMS_DIR macro is not valid, the path is set from the VISP_ROBOT_ARMS_DIR environment variable that the user has to set.

Reimplemented from vpRobotWireFrameSimulator.

Definition at line 187 of file vpSimulatorViper850.cpp.

References vpRobotWireFrameSimulator::artCoord, vpRobot::ARTICULAR_FRAME, vpRobotWireFrameSimulator::artVel, vpIoTools::checkDirectory(), defaultPositioningVelocity, vpViper850::defaultTool, vpRobotWireFrameSimulator::fMi, vpIoTools::getenv(), vpViper::joint_max, vpViper::joint_min, vpViper::njoint, vpMath::rad(), vpColVector::resize(), vpRobot::setRobotFrame(), setRobotState(), vpRobotWireFrameSimulator::size_fMi, and vpRobot::STATE_STOP.

Referenced by vpSimulatorViper850().

void vpSimulatorViper850::initArms ( )

protectedvirtual

Initialise the display of the robot's arms.

Set the path to the scene files (*.bnd and *.sln) used by the simulator. If the path set in vpConfig.h in VISP_SCENES_DIR macro is not valid, the path is set from the VISP_SCENES_DIR environment variable that the user has to set.

Implements vpRobotWireFrameSimulator.

Definition at line 2178 of file vpSimulatorViper850.cpp.

References vpWireFrameSimulator::camera, vpWireFrameSimulator::cameraFactor, vpIoTools::checkDirectory(), vpWireFrameSimulator::displayCamera, vpIoTools::getenv(), and vpRobotWireFrameSimulator::robotArms.

Referenced by initDisplay().

void vpSimulatorViper850::initDisplay ( )

protected

Method which initialises the parameters linked to the display part.

Definition at line 250 of file vpSimulatorViper850.cpp.

References vpRobotWireFrameSimulator::cameraParam, vpCameraParameters::get_px(), vpCameraParameters::get_py(), getCameraParameters(), initArms(), vpCameraParameters::initPersProjWithoutDistortion(), vpWireFrameSimulator::px_int, vpWireFrameSimulator::py_int, vpMath::rad(), vpRobotWireFrameSimulator::robotArms, vpWireFrameSimulator::sceneInitialized, vpWireFrameSimulator::setExternalCameraParameters(), and vpRobotWireFrameSimulator::setExternalCameraPosition().

Referenced by vpSimulatorViper850().

void vpSimulatorViper850::initialiseCameraRelativeToObject ( vpHomogeneousMatrix cMo )

This method enables to initialise the articular coordinates of the robot in order to position the camera relative to the object.

Before using this method it is advised to set the position of the object thanks to the set_fMo() method.

Parameters

cMo	: the desired pose of the camera.

Definition at line 2327 of file vpSimulatorViper850.cpp.

References compute_fMi(), vpWireFrameSimulator::fMc, vpWireFrameSimulator::fMo, vpRobotWireFrameSimulator::get_artCoord(), vpViper::getInverseKinematics(), vpHomogeneousMatrix::inverse(), vpRobotWireFrameSimulator::set_artCoord(), vpRobotWireFrameSimulator::set_artVel(), vpRobotWireFrameSimulator::set_velocity(), and vpERROR_TRACE.

void vpSimulatorViper850::initialiseObjectRelativeToCamera ( vpHomogeneousMatrix cMo )

This method enables to initialise the pose between the object and the refrence frame, in order to position the object relative to the camera.

Before using this method it is advised to set the articular coordinates of the robot.

Parameters

cMo	: the desired pose of the camera.

Definition at line 2355 of file vpSimulatorViper850.cpp.

References vpWireFrameSimulator::cMo, vpWireFrameSimulator::fMo, get_fMi(), vpRobotWireFrameSimulator::set_artVel(), and vpRobotWireFrameSimulator::set_velocity().

void vpRobotWireFrameSimulator::initScene	(	vpSceneObject	obj,
		vpSceneDesiredObject	desiredObject
	)

inherited

Initialize the display. It enables to choose the type of scene which will be used to display the object at the current position and at the desired position.

It exists several default scenes you can use. Use the vpSceneObject and the vpSceneDesiredObject attributes to use them in this method. The corresponding files are stored in the "data" folder which is in the ViSP build directory.

Parameters

obj	: Type of scene used to display the object at the current position.
desiredObject	: Type of scene used to display the object at the desired pose (in the internal view).

Examples:: servoMomentPoints.cpp, and servoMomentPolygon.cpp.

Definition at line 123 of file vpRobotWireFrameSimulator.cpp.

References vpWireFrameSimulator::camera, vpWireFrameSimulator::displayCamera, and vpWireFrameSimulator::initScene().

void vpRobotWireFrameSimulator::initScene	(	const char *	obj,
		const char *	desiredObject
	)

inherited

Initialize the display. It enables to choose the type of scene which will be used to display the object at the current position and at the desired position.

Here you can use the scene you want. You have to set the path to the .bnd file which is a scene file. It is also possible to use a vrml (.wrl) file.

Parameters

obj	: Path to the scene file you want to use.
desiredObject	: Path to the scene file you want to use.

Definition at line 146 of file vpRobotWireFrameSimulator.cpp.

References vpWireFrameSimulator::camera, vpWireFrameSimulator::displayCamera, and vpWireFrameSimulator::initScene().

void vpRobotWireFrameSimulator::initScene ( vpSceneObject obj )

inherited

Initialize the display. It enables to choose the type of object which will be used to display the object at the current position. The object at the desired position is not displayed.

It exists several default scenes you can use. Use the vpSceneObject attributes to use them in this method. The corresponding files are stored in the "data" folder which is in the ViSP build directory.

Parameters

obj	: Type of scene used to display the object at the current position.

Definition at line 167 of file vpRobotWireFrameSimulator.cpp.

References vpWireFrameSimulator::camera, vpWireFrameSimulator::displayCamera, and vpWireFrameSimulator::initScene().

void vpRobotWireFrameSimulator::initScene ( const char * obj )

inherited

Initialize the display. It enables to choose the type of scene which will be used to display the object at the current position. The object at the desired position is not displayed.

Here you can use the scene you want. You have to set the path to the .bnd file which is a scene file, or the vrml file.

Parameters

obj	: Path to the scene file you want to use.

Definition at line 188 of file vpRobotWireFrameSimulator.cpp.

References vpWireFrameSimulator::camera, vpWireFrameSimulator::displayCamera, and vpWireFrameSimulator::initScene().

void vpWireFrameSimulator::initScene	(	const vpSceneObject &	obj,
		const vpSceneDesiredObject &	desiredObject
	)

inherited

Initialize the simulator. It enables to choose the type of scene which will be used to display the object at the current position and at the desired position.

It exists several default scenes you can use. Use the vpSceneObject and the vpSceneDesiredObject attributes to use them in this method. The corresponding files are stored in the "data" folder which is in the ViSP build directory.

Parameters

obj	: Type of scene used to display the object at the current position.
desiredObject	: Type of scene used to display the object at the desired pose (in the internal view).

Examples:: servoSimu4Points.cpp, servoSimuCylinder.cpp, servoSimuSphere.cpp, and wireframeSimulator.cpp.

Definition at line 610 of file vpWireFrameSimulator.cpp.

Referenced by vpRobotWireFrameSimulator::initScene(), and vpWireFrameSimulator::initScene().

void vpWireFrameSimulator::initScene ( const vpSceneObject & obj )

inherited

Initialize the simulator. It enables to choose the type of object which will be used to display the object at the current position. The object at the desired position is not displayed.

It exists several default scenes you can use. Use the vpSceneObject attributes to use them in this method. The corresponding files are stored in the "data" folder which is in the ViSP build directory.

Parameters

obj	: Type of scene used to display the object at the current position.

Definition at line 845 of file vpWireFrameSimulator.cpp.

void vpWireFrameSimulator::initScene	(	const vpSceneObject &	obj,
		const vpSceneDesiredObject &	desiredObject,
		const std::list< vpImageSimulator > &	imObj
	)

inherited

Initialize the simulator. It enables to choose the type of scene which will be used to display the object at the current position and at the desired position.

It exists several default scenes you can use. Use the vpSceneObject and the vpSceneDesiredObject attributes to use them in this method. The corresponding files are stored in the "data" folder which is in the ViSP build directory.

It is also possible to add a list of vpImageSimulator instances. They will be automatically projected into the image. The position of the four corners have to be given in the object frame.

Parameters

obj	: Type of scene used to display the object at the current position.
desiredObject	: Type of scene used to display the object at the desired pose (in the internal view).
imObj	: A list of vpImageSimulator instances.

Definition at line 723 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::displayImageSimulator, vpWireFrameSimulator::initScene(), and vpWireFrameSimulator::objectImage.

void vpWireFrameSimulator::initScene	(	const char *	obj,
		const char *	desiredObject,
		const std::list< vpImageSimulator > &	imObj
	)

inherited

Initialize the simulator. It enables to choose the type of scene which will be used to display the object at the current position and at the desired position.

Here you can use the scene you want. You have to set the path to a .bnd or a .wrl file which is a 3D model file.

It is also possible to add a list of vpImageSimulator instances. They will be automatically projected into the image. The position of the four corners have to be given in the object frame.

Parameters

obj	: Path to the scene file you want to use.
desiredObject	: Path to the scene file you want to use.
imObj	: A list of vpImageSimulator instances.

Definition at line 829 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::displayImageSimulator, vpWireFrameSimulator::initScene(), and vpWireFrameSimulator::objectImage.

void vpWireFrameSimulator::initScene	(	const vpSceneObject &	obj,
		const std::list< vpImageSimulator > &	imObj
	)

inherited

Initialize the simulator. It enables to choose the type of object which will be used to display the object at the current position. The object at the desired position is not displayed.

It exists several default scenes you can use. Use the vpSceneObject attributes to use them in this method. The corresponding files are stored in the "data" folder which is in the ViSP build directory.

It is also possible to add a list of vpImageSimulator instances. They will be automatically projected into the image. The position of the four corners have to be given in the object frame.

Parameters

obj	: Type of scene used to display the object at the current position.
imObj	: A list of vpImageSimulator instances.

Definition at line 928 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::displayImageSimulator, vpWireFrameSimulator::initScene(), and vpWireFrameSimulator::objectImage.

void vpWireFrameSimulator::initScene	(	const char *	obj,
		const std::list< vpImageSimulator > &	imObj
	)

inherited

Initialize the simulator. It enables to choose the type of scene which will be used to display the object at the current position. The object at the desired position is not displayed.

Here you can use the scene you want. You have to set the path to a .bnd or a .wrl file which is a 3D model file.

It is also possible to add a list of vpImageSimulator instances. They will be automatically projected into the image. The position of the four corners have to be given in the object frame.

Parameters

obj	: Path to the scene file you want to use.
imObj	: A list of vpImageSimulator instances.

Definition at line 1017 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::displayImageSimulator, vpWireFrameSimulator::initScene(), and vpWireFrameSimulator::objectImage.

void vpWireFrameSimulator::initScene	(	vpSceneObject	obj,
		vpSceneDesiredObject	desiredObject,
		vpList< vpImageSimulator > &	imObj
	)

inherited

Deprecated:: This method is deprecated. You should use initScene(vpSceneObject, vpSceneDesiredObject, const std::list<vpImageSimulator> &) instead.

Initialize the simulator. It enables to choose the type of scene which will be used to display the object at the current position and at the desired position.

It exists several default scenes you can use. Use the vpSceneObject and the vpSceneDesiredObject attributes to use them in this method. The corresponding files are stored in the "data" folder which is in the ViSP build directory.

It is also possible to add a list of vpImageSimulator instances. They will be automatically projected into the image. The position of the four corners have to be given in the object frame.

Parameters

obj	: Type of scene used to display the object at the current position.
desiredObject	: Type of scene used to display the object at the desired pose (in the internal view).
imObj	: A list of vpImageSimulator instances.

Definition at line 699 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::displayImageSimulator, vpList< type >::front(), vpWireFrameSimulator::initScene(), vpList< type >::next(), vpWireFrameSimulator::objectImage, vpList< type >::outside(), and vpList< type >::value().

void vpWireFrameSimulator::initScene	(	const char *	obj,
		const char *	desiredObject,
		vpList< vpImageSimulator > &	imObj
	)

inherited

Deprecated:: This method is deprecated. You should use initScene(const char*, const char*, const std::list<vpImageSimulator> &) instead.

Initialize the simulator. It enables to choose the type of scene which will be used to display the object at the current position and at the desired position.

Here you can use the scene you want. You have to set the path to a .bnd or a .wrl file which is a 3D model file.

It is also possible to add a list of vpImageSimulator instances. They will be automatically projected into the image. The position of the four corners have to be given in the object frame.

Parameters

obj	: Path to the scene file you want to use.
desiredObject	: Path to the scene file you want to use.
imObj	: A list of vpImageSimulator instances.

Definition at line 805 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::displayImageSimulator, vpList< type >::front(), vpWireFrameSimulator::initScene(), vpList< type >::next(), vpWireFrameSimulator::objectImage, vpList< type >::outside(), and vpList< type >::value().

void vpWireFrameSimulator::initScene	(	vpSceneObject	obj,
		vpList< vpImageSimulator > &	imObj
	)

inherited

Deprecated:: This method is deprecated. You should use initScene(vpSceneObject, const std::list<vpImageSimulator> &) instead.

Initialize the simulator. It enables to choose the type of object which will be used to display the object at the current position. The object at the desired position is not displayed.

It exists several default scenes you can use. Use the vpSceneObject attributes to use them in this method. The corresponding files are stored in the "data" folder which is in the ViSP build directory.

It is also possible to add a list of vpImageSimulator instances. They will be automatically projected into the image. The position of the four corners have to be given in the object frame.

Parameters

obj	: Type of scene used to display the object at the current position.
imObj	: A list of vpImageSimulator instances.

Definition at line 905 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::displayImageSimulator, vpList< type >::front(), vpWireFrameSimulator::initScene(), vpList< type >::next(), vpWireFrameSimulator::objectImage, vpList< type >::outside(), and vpList< type >::value().

void vpWireFrameSimulator::initScene	(	const char *	obj,
		vpList< vpImageSimulator > &	imObj
	)

inherited

Deprecated:: This method is deprecated. You should use initScene(const char*, const std::list<vpImageSimulator> &) instead.

Initialize the simulator. It enables to choose the type of scene which will be used to display the object at the current position. The object at the desired position is not displayed.

Here you can use the scene you want. You have to set the path to a .bnd or a .wrl file which is a 3D model file.

It is also possible to add a list of vpImageSimulator instances. They will be automatically projected into the image. The position of the four corners have to be given in the object frame.

Parameters

obj	: Path to the scene file you want to use.
imObj	: A list of vpImageSimulator instances.

Definition at line 994 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::displayImageSimulator, vpList< type >::front(), vpWireFrameSimulator::initScene(), vpList< type >::next(), vpWireFrameSimulator::objectImage, vpList< type >::outside(), and vpList< type >::value().

int vpSimulatorViper850::isInJointLimit ( void )

protectedvirtual

Method used to check if the robot reached a joint limit.

Implements vpRobotWireFrameSimulator.

Definition at line 1743 of file vpSimulatorViper850.cpp.

References vpRobotWireFrameSimulator::get_artCoord(), vpViper::joint_max, and vpViper::joint_min.

Referenced by updateArticularPosition().

static DWORD WINAPI vpRobotWireFrameSimulator::launcher ( LPVOID lpParam )

inlinestaticprotectedinherited

Function used to launch the thread which moves the robot.

Definition at line 316 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::vpSimulatorAfma6(), and vpSimulatorViper850().

void vpSimulatorViper850::move ( const char * filename )

Moves the robot to the joint position specified in the filename.

Parameters

filename File containing a joint position.

See also: readPosFile

Definition at line 2051 of file vpSimulatorViper850.cpp.

References vpRobot::ARTICULAR_FRAME, readPosFile(), setPosition(), setRobotState(), and vpRobot::STATE_POSITION_CONTROL.

vpHomogeneousMatrix vpWireFrameSimulator::navigation	(	const vpImage< vpRGBa > &	I,
		bool &	changed
	)

protectedinherited

Enables to change the external camera position.

Definition at line 1761 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::blocked, vpWireFrameSimulator::blockedr, vpWireFrameSimulator::blockedt, vpWireFrameSimulator::blockedz, vpHomogeneousMatrix::buildFrom(), vpMouseButton::button1, vpMouseButton::button2, vpMouseButton::button3, vpImagePoint::get_i(), vpImagePoint::get_j(), vpDisplay::getClick(), vpDisplay::getClickUp(), vpImage< Type >::getHeight(), vpDisplay::getPointerPosition(), vpImage< Type >::getWidth(), vpMath::minimum(), vpWireFrameSimulator::old_iPr, vpWireFrameSimulator::old_iPt, vpWireFrameSimulator::old_iPz, and vpMath::rad().

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), and vpWireFrameSimulator::getExternalImage().

vpHomogeneousMatrix vpWireFrameSimulator::navigation	(	const vpImage< unsigned char > &	I,
		bool &	changed
	)

protectedinherited

Enables to change the external camera position.

Definition at line 1855 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::blocked, vpWireFrameSimulator::blockedr, vpWireFrameSimulator::blockedt, vpWireFrameSimulator::blockedz, vpHomogeneousMatrix::buildFrom(), vpMouseButton::button1, vpMouseButton::button2, vpMouseButton::button3, vpImagePoint::get_i(), vpImagePoint::get_j(), vpDisplay::getClick(), vpDisplay::getClickUp(), vpImage< Type >::getHeight(), vpDisplay::getPointerPosition(), vpImage< Type >::getWidth(), vpMath::minimum(), vpWireFrameSimulator::old_iPr, vpWireFrameSimulator::old_iPt, vpWireFrameSimulator::old_iPz, and vpMath::rad().

void vpViper850::parseConfigFile ( const char * filename )

inherited

This function gets the robot constant parameters from a file.

Warning: This function is only available if the macro VISP_HAVE_ACCESS_TO_NAS is defined in vpConfig.h.

Parameters

filename : File name containing the robot constant parameters, like the hand-to-eye transformation.

Definition at line 415 of file vpViper850.cpp.

References vpHomogeneousMatrix::buildFrom(), vpViper::eMc, vpViper::erc, vpViper::etc, vpRobotException::readingParametersError, and vpERROR_TRACE.

Referenced by vpViper850::init().

vpImagePoint vpWireFrameSimulator::projectCameraTrajectory	(	const vpImage< vpRGBa > &	I,
		const vpHomogeneousMatrix &	cMo,
		const vpHomogeneousMatrix &	fMo
	)

protectedinherited

Project the center of the internal camera into the external camera view.

Definition at line 1950 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::camMf, vpMeterPixelConversion::convertPoint(), vpPoint::get_x(), vpPoint::get_y(), vpWireFrameSimulator::getExternalCameraParameters(), vpHomogeneousMatrix::inverse(), vpWireFrameSimulator::rotz, vpPoint::setWorldCoordinates(), and vpForwardProjection::track().

Referenced by vpWireFrameSimulator::displayTrajectory(), and vpWireFrameSimulator::getExternalImage().

vpImagePoint vpWireFrameSimulator::projectCameraTrajectory	(	const vpImage< unsigned char > &	I,
		const vpHomogeneousMatrix &	cMo,
		const vpHomogeneousMatrix &	fMo
	)

protectedinherited

Project the center of the internal camera into the external camera view.

Definition at line 1968 of file vpWireFrameSimulator.cpp.

References vpWireFrameSimulator::camMf, vpMeterPixelConversion::convertPoint(), vpPoint::get_x(), vpPoint::get_y(), vpWireFrameSimulator::getExternalCameraParameters(), vpHomogeneousMatrix::inverse(), vpWireFrameSimulator::rotz, vpPoint::setWorldCoordinates(), and vpForwardProjection::track().

vpImagePoint vpWireFrameSimulator::projectCameraTrajectory	(	const vpImage< vpRGBa > &	I,
		const vpHomogeneousMatrix &	cMo,
		const vpHomogeneousMatrix &	fMo,
		const vpHomogeneousMatrix &	cMf
	)

protectedinherited

Project the center of the internal camera into the external camera view.

Definition at line 1986 of file vpWireFrameSimulator.cpp.

References vpMeterPixelConversion::convertPoint(), vpPoint::get_x(), vpPoint::get_y(), vpWireFrameSimulator::getExternalCameraParameters(), vpHomogeneousMatrix::inverse(), vpWireFrameSimulator::rotz, vpPoint::setWorldCoordinates(), and vpForwardProjection::track().

vpImagePoint vpWireFrameSimulator::projectCameraTrajectory	(	const vpImage< unsigned char > &	I,
		const vpHomogeneousMatrix &	cMo,
		const vpHomogeneousMatrix &	fMo,
		const vpHomogeneousMatrix &	cMf
	)

protectedinherited

Project the center of the internal camera into the external camera view.

Definition at line 2004 of file vpWireFrameSimulator.cpp.

References vpMeterPixelConversion::convertPoint(), vpPoint::get_x(), vpPoint::get_y(), vpWireFrameSimulator::getExternalCameraParameters(), vpHomogeneousMatrix::inverse(), vpWireFrameSimulator::rotz, vpPoint::setWorldCoordinates(), and vpForwardProjection::track().

bool vpSimulatorViper850::readPosFile	(	const char *	filename,
		vpColVector &	q
	)

static

Read joint positions in a specific Viper850 position file.

This position file has to start with a header. The six joint positions are given after the "R:" keyword. The first 3 values correspond to the joint translations X,Y,Z expressed in meters. The 3 last values correspond to the joint rotations A,B,C expressed in degres to be more representative for the user. Theses values are then converted in radians in q. The character "#" starting a line indicates a comment.

A typical content of such a file is given below:

#Viper - Position - Version 1.0
# file: "myposition.pos "
#
# R: A B C D E F
# Joint position in degrees
#
R: 0.1 0.3 -0.25 -80.5 80 0

Parameters

filename	: Name of the position file to read.
q	: The six joint positions. Values are expressed in radians.

Returns: true if the positions were successfully readen in the file. false, if an error occurs.

The code below shows how to read a position from a file and move the robot to this position.

#include <visp/vpConfig.h>
#include <visp/vpSimulatorViper850.h>
#include <visp/vpColVector.h>
int main()
{
  vpSimulatorViper850 robot;
  
  // Enable the position control of the robot
  robot.setRobotState(vpRobot::STATE_POSITION_CONTROL);
  // Get the current robot joint positions
  vpColVector q;        // Current joint position
  robot.getPosition(vpRobot::ARTICULAR_FRAME, q); 
  // Save this position in a file named "current.pos"
  robot.savePosFile("current.pos", q); 
  // Get the position from a file and move to the registered position
  robot.readPosFile("current.pos", q); // Set the joint position from the file
  
  robot.setPositioningVelocity(5); // Positioning velocity set to 5%
  robot.setPosition(vpRobot::ARTICULAR_FRAME, q); // Move to the joint position
}

See also: savePosFile()

Definition at line 1946 of file vpSimulatorViper850.cpp.

References vpColVector::deg2rad(), vpViper::njoint, and vpColVector::resize().

Referenced by move(), and setPosition().

vpColVector vpRobot::saturateVelocities	(	const vpColVector &	v_in,
		const vpColVector &	v_max,
		bool	verbose = `false`
	)

staticinherited

Saturate velocities.

Parameters

v_in	: Vector of input velocities to saturate. Translation velocities should be expressed in m/s while rotation velocities in rad/s.
v_max	: Vector of maximal allowed velocities. Maximal translation velocities should be expressed in m/s while maximal rotation velocities in rad/s.
verbose	: Print a message indicating which axis causes the saturation.

Returns: Saturated velocities.

Exceptions

vpRobotException::dimensionError : If the input vectors have different dimensions.

The code below shows how to use this static method in order to saturate a velocity skew vector.

#include <iostream>
#include <visp/vpRobot.h>
int main()
{
  // Set a velocity skew vector
  vpColVector v(6);
  v[0] = 0.1;               // vx in m/s
  v[1] = 0.2;               // vy
  v[2] = 0.3;               // vz
  v[3] = vpMath::rad(10);   // wx in rad/s
  v[4] = vpMath::rad(-10);  // wy
  v[5] = vpMath::rad(20);   // wz
  // Set the maximal allowed velocities
  vpColVector v_max(6);
  for (int i=0; i<3; i++)
    v_max[i] = 0.3;             // in translation (m/s)
  for (int i=3; i<6; i++)
    v_max[i] = vpMath::rad(10); // in rotation (rad/s)
  // Compute the saturated velocity skew vector
  vpColVector v_sat = vpRobot::saturateVelocities(v, v_max, true);
  std::cout << "v    : " << v.t() << std::endl;
  std::cout << "v max: " << v_max.t() << std::endl;
  std::cout << "v sat: " << v_sat.t() << std::endl;
  return 0;
}

Definition at line 116 of file vpRobot.cpp.

References vpException::dimensionError, and vpColVector::size().

Referenced by vpSimulatorCamera::setVelocity(), vpSimulatorPioneer::setVelocity(), vpRobotCamera::setVelocity(), vpSimulatorPioneerPan::setVelocity(), vpRobotPioneer::setVelocity(), vpRobotAfma4::setVelocity(), vpRobotAfma6::setVelocity(), vpRobotViper650::setVelocity(), and vpRobotViper850::setVelocity().

bool vpSimulatorViper850::savePosFile	(	const char *	filename,
		const vpColVector &	q
	)

static

Save joint (articular) positions in a specific Viper850 position file.

This position file starts with a header on the first line. After convertion of the rotations in degrees, the joint position q is written on a line starting with the keyword "R: ". See readPosFile() documentation for an example of such a file.

Parameters

filename	: Name of the position file to create.
q	: The six joint positions to save in the filename. Values are expressed in radians.

Warning: All the six joint rotations written in the file are converted in degrees to be more representative for the user.

Returns: true if the positions were successfully saved in the file. false, if an error occurs.

See also: readPosFile()

Definition at line 2014 of file vpSimulatorViper850.cpp.

References vpMath::deg().

void vpRobotWireFrameSimulator::set_artCoord ( const vpColVector & coord )

inlineprotectedinherited

Definition at line 350 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::initialiseCameraRelativeToObject(), initialiseCameraRelativeToObject(), vpSimulatorAfma6::setPosition(), setPosition(), vpSimulatorAfma6::updateArticularPosition(), and updateArticularPosition().

void vpRobotWireFrameSimulator::set_artVel ( const vpColVector & vel )

inlineprotectedinherited

Definition at line 360 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::computeArticularVelocity(), computeArticularVelocity(), vpSimulatorAfma6::initialiseCameraRelativeToObject(), initialiseCameraRelativeToObject(), vpSimulatorAfma6::initialiseObjectRelativeToCamera(), initialiseObjectRelativeToCamera(), vpSimulatorAfma6::setPosition(), setPosition(), vpSimulatorAfma6::stopMotion(), stopMotion(), vpSimulatorAfma6::updateArticularPosition(), and updateArticularPosition().

void vpRobotWireFrameSimulator::set_displayBusy ( const bool & status )

inlineprotectedinherited

Definition at line 375 of file vpRobotWireFrameSimulator.h.

Referenced by vpRobotWireFrameSimulator::getInternalView(), vpSimulatorAfma6::init(), vpSimulatorAfma6::updateArticularPosition(), and updateArticularPosition().

void vpRobotWireFrameSimulator::set_fMo ( const vpHomogeneousMatrix & fMo )

inlineinherited

Set the pose between the object and the fixed world frame.

Parameters

fMo	: The pose between the object and the fixed world frame.

Definition at line 309 of file vpRobotWireFrameSimulator.h.

References vpWireFrameSimulator::fMo.

void vpRobotWireFrameSimulator::set_velocity ( const vpColVector & vel )

inlineprotectedinherited

Definition at line 370 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::initialiseCameraRelativeToObject(), initialiseCameraRelativeToObject(), vpSimulatorAfma6::initialiseObjectRelativeToCamera(), initialiseObjectRelativeToCamera(), vpSimulatorAfma6::setPosition(), setPosition(), vpSimulatorAfma6::setVelocity(), setVelocity(), vpSimulatorAfma6::stopMotion(), and stopMotion().

void vpRobotWireFrameSimulator::setCameraColor ( const vpColor col )

inlineinherited

Set the color used to display the camera in the external view.

Parameters

col	: The desired color.

Definition at line 230 of file vpRobotWireFrameSimulator.h.

void vpWireFrameSimulator::setCameraColor ( const vpColor & col )

inlineinherited

Set the color used to display the camera in the external view.

Parameters

col	: The desired color.

Examples:: wireframeSimulator.cpp.

Definition at line 449 of file vpWireFrameSimulator.h.

void vpSimulatorViper850::setCameraParameters ( const vpCameraParameters cam )

Set the intrinsic camera parameters.

Parameters

cam	: The desired camera parameters.

Definition at line 417 of file vpSimulatorViper850.cpp.

References vpCameraParameters::get_px(), vpCameraParameters::get_py(), vpWireFrameSimulator::px_int, and vpWireFrameSimulator::py_int.

Referenced by init().

void vpWireFrameSimulator::setCameraPositionRelObj ( const vpHomogeneousMatrix & cMo )

inlineinherited

Set the position of the camera relative to the object.

Parameters

cMo	: The pose of the camera.

Examples:: servoSimu4Points.cpp, servoSimuCylinder.cpp, servoSimuSphere.cpp, and wireframeSimulator.cpp.

Definition at line 455 of file vpWireFrameSimulator.h.

References vpHomogeneousMatrix::inverse().

void vpWireFrameSimulator::setCameraPositionRelWorld ( const vpHomogeneousMatrix & fMc )

inlineinherited

Set the position of the the world reference frame relative to the camera.

Parameters

fMc	: The pose of the camera.

Definition at line 462 of file vpWireFrameSimulator.h.

References vpHomogeneousMatrix::inverse().

void vpWireFrameSimulator::setCameraSizeFactor ( const float factor )

inlineinherited

Set the parameter which enables to choose the size of the main camera in the external camera views. By default this parameter is set to 1.

Parameters

factor : The ration for the camera size.

Definition at line 469 of file vpWireFrameSimulator.h.

void vpWireFrameSimulator::setCameraTrajectoryColor ( const vpColor & col )

inlineinherited

Set the color used to display the camera trajectory in the external view.

Parameters

col	: The desired color.

Definition at line 476 of file vpWireFrameSimulator.h.

void vpWireFrameSimulator::setCameraTrajectoryDisplayType ( const vpCameraTrajectoryDisplayType & camTrajType )

inlineinherited

Set the way to display the history of the main camera trajectory in the main external view. The choice is given between displaying lines and points.

Parameters

camTrajType : The chosen way to display the camera trajectory.

Definition at line 483 of file vpWireFrameSimulator.h.

void vpRobotWireFrameSimulator::setConstantSamplingTimeMode ( const bool _constantSamplingTimeMode )

inlineinherited

Set the flag used to force the sampling time in the thread computing the robot's displacement to a constant value; see setSamplingTime(). It may be useful if the main thread (computing the features) is very time consuming. False by default.

Parameters

_constantSamplingTimeMode : The new value of the constantSamplingTimeMode flag.

Examples:: servoMomentPoints.cpp.

Definition at line 240 of file vpRobotWireFrameSimulator.h.

void vpRobotWireFrameSimulator::setCurrentViewColor ( const vpColor col )

inlineinherited

Set the color used to display the object at the current position in the robot's camera view.

Parameters

col	: The desired color.

Examples:: servoMomentPoints.cpp, and servoMomentPolygon.cpp.

Definition at line 249 of file vpRobotWireFrameSimulator.h.

void vpWireFrameSimulator::setCurrentViewColor ( const vpColor & col )

inlineinherited

Set the color used to display the object at the current position.

Parameters

col	: The desired color.

Examples:: wireframeSimulator.cpp.

Definition at line 490 of file vpWireFrameSimulator.h.

void vpRobotWireFrameSimulator::setDesiredCameraPosition ( const vpHomogeneousMatrix cdMo )

inlineinherited

Set the desired position of the robot's camera relative to the object.

Parameters

cdMo	: The desired pose of the camera.

Examples:: servoMomentPoints.cpp, and servoMomentPolygon.cpp.

Definition at line 263 of file vpRobotWireFrameSimulator.h.

References vpWireFrameSimulator::setDesiredCameraPosition().

void vpWireFrameSimulator::setDesiredCameraPosition ( const vpHomogeneousMatrix & cdMo )

inlineinherited

Set the desired position of the camera relative to the object.

Parameters

cdMo	: The desired pose of the camera.

Examples:: servoSimu4Points.cpp, servoSimuCylinder.cpp, servoSimuSphere.cpp, and wireframeSimulator.cpp.

Definition at line 496 of file vpWireFrameSimulator.h.

Referenced by vpRobotWireFrameSimulator::setDesiredCameraPosition().

void vpRobotWireFrameSimulator::setDesiredViewColor ( const vpColor col )

inlineinherited

Set the color used to display the object at the desired position in the robot's camera view.

Parameters

col	: The desired color.

Examples:: servoMomentPoints.cpp, and servoMomentPolygon.cpp.

Definition at line 256 of file vpRobotWireFrameSimulator.h.

void vpWireFrameSimulator::setDesiredViewColor ( const vpColor & col )

inlineinherited

Set the color used to display the object at the desired position.

Parameters

col	: The desired color.

Examples:: wireframeSimulator.cpp.

Definition at line 502 of file vpWireFrameSimulator.h.

void vpWireFrameSimulator::setDisplayCameraTrajectory ( const bool & displayCameraTrajectory )

inlineinherited

Enable or disable the displaying of the camera trajectory in the main external camera view.

By default the trajectory is displayed.

Parameters

displayCameraTrajectory : Set to true to display the camera trajectory.

Definition at line 510 of file vpWireFrameSimulator.h.

void vpRobotWireFrameSimulator::setDisplayRobotType ( const vpDisplayRobotType dispType )

inlineinherited

Set the way to draw the robot. Depending on what you choose you can display a 3D wireframe model or a set of lines linking the frames used to compute the geometrical model.

Parameters

dispType : Type of display. Can be MODEL_3D or MODEL_DH.

Definition at line 273 of file vpRobotWireFrameSimulator.h.

void vpWireFrameSimulator::setExternalCameraParameters ( const vpCameraParameters & cam )

inlineinherited

Set the internal camera parameters.

Parameters

cam	: The desired camera parameters.

Examples:: servoSimu4Points.cpp, servoSimuCylinder.cpp, servoSimuSphere.cpp, and wireframeSimulator.cpp.

Definition at line 517 of file vpWireFrameSimulator.h.

References vpCameraParameters::get_px(), and vpCameraParameters::get_py().

Referenced by vpSimulatorAfma6::initDisplay(), and initDisplay().

void vpRobotWireFrameSimulator::setExternalCameraPosition ( const vpHomogeneousMatrix camMf )

inlineinherited

Set the external camera point of view.

Parameters

camMf : The pose of the external camera relative to the world reference frame.

Definition at line 279 of file vpRobotWireFrameSimulator.h.

References vpWireFrameSimulator::setExternalCameraPosition().

Referenced by vpSimulatorAfma6::initDisplay(), and initDisplay().

void vpWireFrameSimulator::setExternalCameraPosition ( const vpHomogeneousMatrix & camMf )

inlineinherited

Set the external camera point of view.

Parameters

camMf : The pose of the external camera relative to the world reference frame.

Examples:: servoSimu4Points.cpp, servoSimuCylinder.cpp, servoSimuSphere.cpp, and wireframeSimulator.cpp.

Definition at line 526 of file vpWireFrameSimulator.h.

References vpHomogeneousMatrix::buildFrom(), and vpHomogeneousMatrix::inverse().

Referenced by vpRobotWireFrameSimulator::setExternalCameraPosition().

void vpWireFrameSimulator::setInternalCameraParameters ( const vpCameraParameters & cam )

inlineinherited

Set the internal camera parameters.

Parameters

cam	: The desired camera parameters.

Examples:: servoSimu4Points.cpp, servoSimuCylinder.cpp, servoSimuSphere.cpp, and wireframeSimulator.cpp.

Definition at line 541 of file vpWireFrameSimulator.h.

References vpCameraParameters::get_px(), and vpCameraParameters::get_py().

void vpSimulatorViper850::setJointLimit	(	vpColVector	limitMin,
		vpColVector	limitMax
	)

This method enables to set the minimum and maximum joint limits for all the six axis of the robot. All the values have to be given in radian.

Parameters

limitMin	: The minimum joint limits are given in a vector of size 6. All the value must be in radian.
limitMax	: The maximum joint limits are given in a vector of size 6. All the value must be in radian.

Definition at line 1658 of file vpSimulatorViper850.cpp.

References vpMatrix::getRows(), vpViper::joint_max, vpViper::joint_min, and vpTRACE.

void vpRobot::setMaxRotationVelocity ( const double w_max )

inherited

Set the maximal rotation velocity that can be sent to the robot during a velocity control.

Parameters

w_max : Maximum rotation velocity expressed in rad/s.

Examples:: servoMomentPoints.cpp, servoSimu4Points.cpp, and servoSimuSphere.cpp.

Definition at line 215 of file vpRobot.cpp.

Referenced by vpSimulatorAfma6::setPosition().

void vpRobot::setMaxTranslationVelocity ( const double v_max )

inherited

Set the maximal translation velocity that can be sent to the robot during a velocity control.

Parameters

v_max : Maximum translation velocity expressed in m/s.

Examples:: servoMomentPoints.cpp, servoSimu4Points.cpp, and servoSimuSphere.cpp.

Definition at line 191 of file vpRobot.cpp.

Referenced by vpSimulatorAfma6::setPosition().

void vpWireFrameSimulator::setNbPtTrajectory ( const unsigned int nbPt )

inlineinherited

Set the maximum number of main camera's positions which are stored. Those position can be displayed in the external camera field of view. By default this parameter is set to 1000.

Parameters

nbPt	: The desired number of position which are saved.

Definition at line 551 of file vpWireFrameSimulator.h.

void vpSimulatorViper850::setPosition	(	const vpRobot::vpControlFrameType	frame,
		const vpColVector &	q
	)

virtual

Move to an absolute position with a given percent of max velocity. The percent of max velocity is to set with setPositioningVelocity(). The position to reach can be specified in joint coordinates, in the camera frame or in the reference frame.

Warning: This method is blocking. It returns only when the position is reached by the robot.

Parameters

q	: A six dimension vector corresponding to the position to reach. All the positions are expressed in meters for the translations and radians for the rotations. If the position is out of range, an exception is provided.
frame	: Frame in which the position is expressed.

In the joint space, positions are respectively X, Y, Z, A, B, C, with X,Y,Z the translations, and A,B,C the rotations of the end-effector.
In the camera and the reference frame, rotations are represented by a vpRxyzVector.
Mixt frame is not implemented. By mixt frame we mean, translations expressed in the reference frame, and rotations in the camera frame.

Exceptions

vpRobotException::lowLevelError	: vpRobot::MIXT_FRAME not implemented.
vpRobotException::positionOutOfRangeError	: The requested position is out of range.

#include <visp/vpConfig.h>
#include <visp/vpSimulatorViper850.h>
#include <visp/vpColVector.h>
int main()
{
  vpColVector position(6);
  // Set positions in the camera frame
  position[0] = 0.1;    // x axis, in meter
  position[1] = 0.2;    // y axis, in meter
  position[2] = 0.3;    // z axis, in meter
  position[3] = M_PI/8; // rotation around x axis, in rad
  position[4] = M_PI/4; // rotation around y axis, in rad
  position[5] = M_PI;   // rotation around z axis, in rad
  vpSimulatorViper850 robot;
  
  robot.setRobotState(vpRobot::STATE_POSITION_CONTROL);
  // Set the max velocity to 20%
  robot.setPositioningVelocity(20);
  // Moves the robot in the camera frame
  robot.setPosition(vpRobot::CAMERA_FRAME, position);
}

To catch the exception if the position is out of range, modify the code like:

try {
  robot.setPosition(vpRobot::CAMERA_FRAME, position);
}
catch (vpRobotException e) {
  if (e.getCode() == vpRobotException::positionOutOfRangeError) {
  std::cout << "The position is out of range" << std::endl;
}

Implements vpRobot.

Definition at line 1229 of file vpSimulatorViper850.cpp.

References vpRobot::ARTICULAR_FRAME, vpRobot::CAMERA_FRAME, vpWireFrameSimulator::fMc, vpRobotWireFrameSimulator::get_artCoord(), vpViper::get_fMc(), vpViper::getInverseKinematics(), vpRobot::getRobotState(), vpRobotException::lowLevelError, vpRobot::MIXT_FRAME, vpRobotException::positionOutOfRangeError, vpRobot::REFERENCE_FRAME, vpRobotWireFrameSimulator::set_artCoord(), vpRobotWireFrameSimulator::set_artVel(), vpRobotWireFrameSimulator::set_velocity(), vpRobotWireFrameSimulator::setVelocityCalled, vpRobot::STATE_POSITION_CONTROL, vpMatrix::sumSquare(), and vpERROR_TRACE.

Referenced by move(), and setPosition().

void vpSimulatorViper850::setPosition	(	const vpRobot::vpControlFrameType	frame,
		const double	pos1,
		const double	pos2,
		const double	pos3,
		const double	pos4,
		const double	pos5,
		const double	pos6
	)

Move to an absolute position with a given percent of max velocity. The percent of max velocity is to set with setPositioningVelocity(). The position to reach can be specified in joint coordinates, in the camera frame or in the reference frame.

This method overloads setPosition(const vpRobot::vpControlFrameType, const vpColVector &).

Warning: This method is blocking. It returns only when the position is reached by the robot.

Parameters

pos1,pos2,pos3,pos4,pos5,pos6	: The six coordinates of the position to reach. All the positions are expressed in meters for the translations and radians for the rotations.
frame	: Frame in which the position is expressed.

In the joint space, positions are respectively X (pos1), Y (pos2), Z (pos3), A (pos4), B (pos5), C (pos6), with X,Y,Z the translations, and A,B,C the rotations of the end-effector.
In the camera and the reference frame, rotations [pos4, pos5, pos6] are represented by a vpRxyzVector.
Mixt frame is not implemented. By mixt frame we mean, translations expressed in the reference frame, and rotations in the camera frame.

Exceptions

vpRobotException::lowLevelError	: vpRobot::MIXT_FRAME not implemented.
vpRobotException::positionOutOfRangeError	: The requested position is out of range.

#include <visp/vpConfig.h>
#include <visp/vpSimulatorViper850.h>
int main()
{
  // Set positions in the camera frame
  double pos1 = 0.1;    // x axis, in meter
  double pos2 = 0.2;    // y axis, in meter
  double pos3 = 0.3;    // z axis, in meter
  double pos4 = M_PI/8; // rotation around x axis, in rad
  double pos5 = M_PI/4; // rotation around y axis, in rad
  double pos6 = M_PI;   // rotation around z axis, in rad
  vpRobotViper850 robot;
  robot.setRobotState(vpRobot::STATE_POSITION_CONTROL);
  // Set the max velocity to 20%
  robot.setPositioningVelocity(20);
  // Moves the robot in the camera frame
  robot.setPosition(vpRobot::CAMERA_FRAME, pos1, pos2, pos3, pos4, pos5, pos6);
}

See also: setPosition()

Definition at line 1435 of file vpSimulatorViper850.cpp.

References setPosition(), and vpERROR_TRACE.

void vpSimulatorViper850::setPosition ( const char * filename )

Move to an absolute joint position with a given percent of max velocity. The robot state is set to position control. The percent of max velocity is to set with setPositioningVelocity(). The position to reach is defined in the position file.

Parameters

filename : Name of the position file to read. The readPosFile() documentation shows a typical content of such a position file.

This method has the same behavior than the sample code given below;

#include <visp/vpConfig.h>
#include <visp/vpSimulatorViper850.h>
#include <visp/vpColVector.h>
int main()
{
  vpColVector q;
  vpSimulatorViper850 robot;
  robot.readPosFile("MyPositionFilename.pos", q);
  robot.setRobotState(vpRobot::STATE_POSITION_CONTROL);
  robot.setPosition(vpRobot::ARTICULAR_FRAME, q);
}

Exceptions

vpRobotException::lowLevelError	: vpRobot::MIXT_FRAME not implemented.
vpRobotException::positionOutOfRangeError	: The requested position is out of range.

See also: setPositioningVelocity()

Definition at line 1496 of file vpSimulatorViper850.cpp.

References vpRobot::ARTICULAR_FRAME, vpRobotException::lowLevelError, readPosFile(), setPosition(), setRobotState(), vpRobot::STATE_POSITION_CONTROL, and vpERROR_TRACE.

void vpSimulatorViper850::setPositioningVelocity ( const double velocity )

inline

Definition at line 268 of file vpSimulatorViper850.h.

References vpRobotWireFrameSimulator::velocity.

vpRobot::vpControlFrameType vpRobot::setRobotFrame ( vpRobot::vpControlFrameType newFrame )

protectedinherited

Definition at line 161 of file vpRobot.cpp.

Referenced by vpSimulatorAfma6::init(), init(), vpSimulatorCamera::setVelocity(), vpSimulatorPioneer::setVelocity(), vpSimulatorPioneerPan::setVelocity(), vpSimulatorAfma6::setVelocity(), and setVelocity().

vpRobot::vpRobotStateType vpSimulatorViper850::setRobotState ( const vpRobot::vpRobotStateType newState )

virtual

Change the robot state.

Parameters

newState : New requested robot state.

Reimplemented from vpRobot.

Definition at line 703 of file vpSimulatorViper850.cpp.

References vpRobot::getRobotState(), vpRobot::setRobotState(), vpRobot::STATE_ACCELERATION_CONTROL, vpRobot::STATE_POSITION_CONTROL, vpRobot::STATE_STOP, vpRobot::STATE_VELOCITY_CONTROL, and stopMotion().

Referenced by init(), move(), setPosition(), and stopMotion().

void vpRobotWireFrameSimulator::setSamplingTime ( const double & delta_t )

inlinevirtualinherited

Set the sampling time.

Parameters

delta_t : Sampling time in second used to compute the robot displacement from the velocity applied to the robot during this time.

Since the wireframe simulator is threaded, the sampling time is set to vpTime::minTimeForUsleepCall / 1000 seconds.

Reimplemented from vpRobotSimulator.

Definition at line 293 of file vpRobotWireFrameSimulator.h.

References vpTime::minTimeForUsleepCall.

Referenced by vpRobotWireFrameSimulator::vpRobotWireFrameSimulator().

void vpRobotWireFrameSimulator::setSingularityManagement ( const bool sm )

inlineinherited

Set the parameter which enable or disable the singularity mangement

Definition at line 302 of file vpRobotWireFrameSimulator.h.

void vpViper850::setToolType ( vpViper850::vpToolType tool )

inlineprotectedinherited

Set the current tool type.

Definition at line 136 of file vpViper850.h.

Referenced by vpViper850::init(), init(), and vpRobotViper850::init().

void vpSimulatorViper850::setVelocity	(	const vpRobot::vpControlFrameType	frame,
		const vpColVector &	vel
	)

virtual

Apply a velocity to the robot.

Parameters

frame	: Control frame in which the velocity is expressed. Velocities could be expressed in articular, camera frame, reference frame or mixt frame.
vel	: Velocity vector. Translation velocities are expressed in m/s while rotation velocities in rad/s. The size of this vector is always 6.

In articular, $vel = [\dot{q}_1, \dot{q}_2, \dot{q}_3, \dot{q}_4, \dot{q}_5, \dot{q}_6]^t$ correspond to joint velocities.
In camera frame, $vel = [^{c} v_x, ^{c} v_y, ^{c} v_z, ^{c} \omega_x, ^{c} \omega_y, ^{c} \omega_z]^t$ is expressed in the camera frame.
In reference frame, $vel = [^{r} v_x, ^{r} v_y, ^{r} v_z, ^{r} \omega_x, ^{r} \omega_y, ^{r} \omega_z]^t$ is expressed in the reference frame.
In mixt frame, $vel = [^{r} v_x, ^{r} v_y, ^{r} v_z, ^{c} \omega_x, ^{c} \omega_y, ^{c} \omega_z]^t$ . In mixt frame, translations are expressed in the reference frame and rotations $\omega_x, \omega_y, \omega_z$ in the camera frame.

Exceptions

vpRobotException::wrongStateError : If a the robot is not configured to handle a velocity. The robot can handle a velocity only if the velocity control mode is set. For that, call setRobotState( vpRobot::STATE_VELOCITY_CONTROL) before setVelocity().

Warning: Velocities could be saturated if one of them exceed the maximal autorized speed (see vpRobot::maxTranslationVelocity and vpRobot::maxRotationVelocity). To change these values use setMaxTranslationVelocity() and setMaxRotationVelocity().

#include <visp/vpConfig.h>
#include <visp/vpSimulatorViper850.h>
#include <visp/vpColVector.h>
#include <visp/vpMath.h>
int main()
{
  vpSimulatorViper850 robot;
  vpColVector qvel(6);
  // Set a joint velocity
  qvel[0] = 0.1;             // Joint 1 velocity in rad/s
  qvel[1] = vpMath::rad(15); // Joint 2 velocity in rad/s
  qvel[2] = 0;               // Joint 3 velocity in rad/s
  qvel[3] = M_PI/8;          // Joint 4 velocity in rad/s
  qvel[4] = 0;               // Joint 5 velocity in rad/s
  qvel[5] = 0;               // Joint 6 velocity in rad/s
  
  // Initialize the controller to position control
  robot.setRobotState(vpRobot::STATE_VELOCITY_CONTROL);
  for ( ; ; ) {
    // Apply a velocity in the joint space
    robot.setVelocity(vpRobot::ARTICULAR_FRAME, qvel);
    // Compute new velocities qvel...
  }
  // Stop the robot
  robot.setRobotState(vpRobot::STATE_STOP);
}

Implements vpRobot.

Definition at line 807 of file vpSimulatorViper850.cpp.

References vpRobot::ARTICULAR_FRAME, vpRobot::CAMERA_FRAME, vpRobot::getMaxRotationVelocity(), vpRobot::getMaxTranslationVelocity(), vpRobot::getRobotState(), vpMatrix::getRows(), vpRobotWireFrameSimulator::jointLimit, vpRobot::MIXT_FRAME, vpRobot::REFERENCE_FRAME, vpRobotWireFrameSimulator::set_velocity(), vpRobot::setRobotFrame(), vpRobotWireFrameSimulator::setVelocityCalled, vpRobot::STATE_VELOCITY_CONTROL, vpERROR_TRACE, and vpRobotException::wrongStateError.

void vpRobot::setVerbose ( bool verbose )

inlineinherited

Definition at line 155 of file vpRobot.h.

Referenced by vpRobotAfma4::vpRobotAfma4(), vpRobotAfma6::vpRobotAfma6(), vpRobotViper650::vpRobotViper650(), and vpRobotViper850::vpRobotViper850().

bool vpSimulatorViper850::singularityTest	(	const vpColVector	q,
		vpMatrix &	J
	)

protected

Test to detect if the robot is near one of its singularities.

The goal is to avoid the problems du to such configurations.

Definition at line 1688 of file vpSimulatorViper850.cpp.

References vpViper::a1, vpViper::a2, vpViper::a3, and vpViper::d4.

Referenced by computeArticularVelocity().

void vpSimulatorViper850::stopMotion ( void )

Stop the robot.

Definition at line 2150 of file vpSimulatorViper850.cpp.

References vpRobot::getRobotState(), vpRobotWireFrameSimulator::set_artVel(), vpRobotWireFrameSimulator::set_velocity(), setRobotState(), vpRobot::STATE_STOP, and vpRobot::STATE_VELOCITY_CONTROL.

Referenced by setRobotState().

void vpSimulatorViper850::updateArticularPosition ( )

protectedvirtual

Method lauched by the thread to compute the position of the robot in the articular frame.

Implements vpRobotWireFrameSimulator.

Definition at line 429 of file vpSimulatorViper850.cpp.

Member Data Documentation

double vpViper::a1

protectedinherited

Definition at line 153 of file vpViper.h.

Referenced by compute_fMi(), vpViper::get_fJw(), vpViper::get_fMe(), vpViper::get_fMw(), vpViper::getInverseKinematicsWrist(), singularityTest(), vpViper::vpViper(), vpViper650::vpViper650(), and vpViper850::vpViper850().

double vpViper::a2

protectedinherited

for joint 2

Definition at line 154 of file vpViper.h.

Referenced by compute_fMi(), vpViper::get_fJw(), vpViper::get_fMe(), vpViper::get_fMw(), vpViper::getInverseKinematicsWrist(), singularityTest(), vpViper::vpViper(), vpViper650::vpViper650(), and vpViper850::vpViper850().

double vpViper::a3

protectedinherited

for joint 3

Definition at line 155 of file vpViper.h.

Referenced by compute_fMi(), vpViper::get_fJw(), vpViper::get_fMe(), vpViper::get_fMw(), vpViper::getInverseKinematicsWrist(), singularityTest(), vpViper::vpViper(), vpViper650::vpViper650(), and vpViper850::vpViper850().

int vpRobot::areJointLimitsAvailable

protectedinherited

Definition at line 111 of file vpRobot.h.

vpColVector vpRobotWireFrameSimulator::artCoord

protectedinherited

The articular coordinates

Definition at line 118 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::init(), and init().

vpColVector vpRobotWireFrameSimulator::artVel

protectedinherited

The articular velocity

Definition at line 120 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::init(), and init().

bool vpWireFrameSimulator::blocked

protectedinherited

Definition at line 268 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::navigation(), and vpWireFrameSimulator::vpWireFrameSimulator().

bool vpWireFrameSimulator::blockedr

protectedinherited

Definition at line 265 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::navigation(), and vpWireFrameSimulator::vpWireFrameSimulator().

bool vpWireFrameSimulator::blockedt

protectedinherited

Definition at line 267 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::navigation(), and vpWireFrameSimulator::vpWireFrameSimulator().

bool vpWireFrameSimulator::blockedz

protectedinherited

Definition at line 266 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::navigation(), and vpWireFrameSimulator::vpWireFrameSimulator().

double vpViper::c56

protectedinherited

Mechanical coupling between joint 5 and joint 6.

Definition at line 158 of file vpViper.h.

Referenced by vpViper::getCoupl56(), vpViper::vpViper(), vpViper650::vpViper650(), and vpViper850::vpViper850().

vpColor vpWireFrameSimulator::camColor

protectedinherited

Definition at line 249 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpWireFrameSimulator::getExternalImage(), and vpWireFrameSimulator::vpWireFrameSimulator().

Bound_scene vpWireFrameSimulator::camera

protectedinherited

Definition at line 236 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpWireFrameSimulator::getExternalImage(), vpSimulatorAfma6::initArms(), initArms(), vpRobotWireFrameSimulator::initScene(), vpWireFrameSimulator::initScene(), and vpWireFrameSimulator::~vpWireFrameSimulator().

float vpWireFrameSimulator::cameraFactor

protectedinherited

Definition at line 283 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::initArms(), initArms(), vpWireFrameSimulator::initScene(), and vpWireFrameSimulator::vpWireFrameSimulator().

vpCameraParameters vpRobotWireFrameSimulator::cameraParam

protectedinherited

External camera parameters

Definition at line 153 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::initDisplay(), initDisplay(), vpSimulatorAfma6::updateArticularPosition(), and updateArticularPosition().

std::list<vpImagePoint> vpWireFrameSimulator::cameraTrajectory

protectedinherited

Definition at line 257 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::vpWireFrameSimulator(), and vpWireFrameSimulator::~vpWireFrameSimulator().

vpHomogeneousMatrix vpWireFrameSimulator::camMf

protectedinherited

Definition at line 241 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::getInternalImage(), and vpWireFrameSimulator::projectCameraTrajectory().

vpHomogeneousMatrix vpWireFrameSimulator::camMf2

protectedinherited

Definition at line 270 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), and vpWireFrameSimulator::getExternalImage().

vpColor vpWireFrameSimulator::camTrajColor

protectedinherited

Definition at line 250 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::displayTrajectory(), vpWireFrameSimulator::getExternalImage(), and vpWireFrameSimulator::vpWireFrameSimulator().

vpCameraTrajectoryDisplayType vpWireFrameSimulator::camTrajType

protectedinherited

Definition at line 285 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::displayTrajectory(), vpWireFrameSimulator::getExternalImage(), and vpWireFrameSimulator::vpWireFrameSimulator().

vpHomogeneousMatrix vpWireFrameSimulator::cdMo

protectedinherited

Definition at line 244 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getInternalImage(), and vpRobotWireFrameSimulator::getInternalView().

vpHomogeneousMatrix vpWireFrameSimulator::cMo

protectedinherited

Definition at line 243 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), vpSimulatorAfma6::initialiseObjectRelativeToCamera(), and initialiseObjectRelativeToCamera().

const char *const vpViper850::CONST_CAMERA_FILENAME = "Z:/robot/Viper850/current/include/const_camera_Viper850.xml"

staticinherited

Definition at line 80 of file vpViper850.h.

Referenced by vpViper850::getCameraParameters().

const char *const vpViper850::CONST_EMC_GENERIC_WITH_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_generic_with_distortion_Viper850.cnf"

staticinherited

Definition at line 79 of file vpViper850.h.

Referenced by vpViper850::init().

const char *const vpViper850::CONST_EMC_GENERIC_WITHOUT_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_generic_without_distortion_Viper850.cnf"

staticinherited

Definition at line 78 of file vpViper850.h.

Referenced by vpViper850::init().

const char *const vpViper850::CONST_EMC_MARLIN_F033C_WITH_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_MarlinF033C_with_distortion_Viper850.cnf"

staticinherited

Definition at line 73 of file vpViper850.h.

Referenced by vpViper850::init().

const char *const vpViper850::CONST_EMC_MARLIN_F033C_WITHOUT_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_MarlinF033C_without_distortion_Viper850.cnf"

staticinherited

Files where constant tranformation between end-effector and camera frame are stored.

Definition at line 72 of file vpViper850.h.

Referenced by vpViper850::init().

const char *const vpViper850::CONST_EMC_PTGREY_FLEA2_WITH_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_PTGreyFlea2_with_distortion_Viper850.cnf"

staticinherited

Definition at line 75 of file vpViper850.h.

Referenced by vpViper850::init().

const char *const vpViper850::CONST_EMC_PTGREY_FLEA2_WITHOUT_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_PTGreyFlea2_without_distortion_Viper850.cnf"

staticinherited

Definition at line 74 of file vpViper850.h.

Referenced by vpViper850::init().

const char *const vpViper850::CONST_EMC_SCHUNK_GRIPPER_WITH_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_schunk_gripper_with_distortion_Viper850.cnf"

staticinherited

Definition at line 77 of file vpViper850.h.

Referenced by vpViper850::init().

const char *const vpViper850::CONST_EMC_SCHUNK_GRIPPER_WITHOUT_DISTORTION_FILENAME = "Z:/robot/Viper850/current/include/const_eMc_schunk_gripper_without_distortion_Viper850.cnf"

staticinherited

Definition at line 76 of file vpViper850.h.

Referenced by vpViper850::init().

const char *const vpViper850::CONST_GENERIC_CAMERA_NAME = "Generic-camera"

staticinherited

Definition at line 88 of file vpViper850.h.

Referenced by vpViper850::getCameraParameters().

const char *const vpViper850::CONST_MARLIN_F033C_CAMERA_NAME = "Marlin-F033C-12mm"

staticinherited

Name of the camera attached to the end-effector.

Definition at line 85 of file vpViper850.h.

Referenced by vpViper850::getCameraParameters(), and getCameraParameters().

const char *const vpViper850::CONST_PTGREY_FLEA2_CAMERA_NAME = "PTGrey-Flea2-6mm"

staticinherited

Definition at line 86 of file vpViper850.h.

Referenced by vpViper850::getCameraParameters(), and getCameraParameters().

const char *const vpViper850::CONST_SCHUNK_GRIPPER_CAMERA_NAME = "Schunk-Gripper-PTGrey-Flea2-6mm"

staticinherited

Definition at line 87 of file vpViper850.h.

Referenced by vpViper850::getCameraParameters().

bool vpRobotWireFrameSimulator::constantSamplingTimeMode

protectedinherited

Flag used to force the sampling time in the thread computing the robot's displacement to a constant value (samplingTime). It may be useful if the main thread (computing the features) is very time consumming. False by default.

Definition at line 171 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::updateArticularPosition(), updateArticularPosition(), and vpRobotWireFrameSimulator::vpRobotWireFrameSimulator().

vpColor vpWireFrameSimulator::curColor

protectedinherited

Definition at line 251 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), and vpWireFrameSimulator::vpWireFrameSimulator().

double vpViper::d1

protectedinherited

for joint 1

Definition at line 153 of file vpViper.h.

Referenced by compute_fMi(), vpViper::get_fMe(), vpViper::get_fMw(), vpViper::getInverseKinematicsWrist(), vpViper::vpViper(), vpViper650::vpViper650(), and vpViper850::vpViper850().

double vpViper::d4

protectedinherited

for joint 4

Definition at line 156 of file vpViper.h.

Referenced by compute_fMi(), vpViper::get_fJw(), vpViper::get_fMe(), vpViper::get_fMw(), vpViper::getInverseKinematicsWrist(), singularityTest(), vpViper::vpViper(), vpViper650::vpViper650(), and vpViper850::vpViper850().

double vpViper::d6

protectedinherited

for joint 6

Definition at line 157 of file vpViper.h.

Referenced by compute_fMi(), vpViper::get_fMe(), vpViper::get_wMe(), vpViper::vpViper(), vpViper650::vpViper650(), and vpViper850::vpViper850().

const double vpSimulatorViper850::defaultPositioningVelocity = 25.0

static

Definition at line 205 of file vpSimulatorViper850.h.

Referenced by init().

const vpViper850::vpToolType vpViper850::defaultTool = vpViper850::TOOL_PTGREY_FLEA2_CAMERA

staticinherited

Default tool attached to the robot end effector.

Examples:: testRobotViper850Pose.cpp.

Definition at line 99 of file vpViper850.h.

Referenced by vpViper850::init(), init(), and vpRobotViper850::init().

double vpRobotSimulator::delta_t_

protectedinherited

Definition at line 68 of file vpRobotSimulator.h.

Referenced by vpSimulatorCamera::setVelocity(), vpRobotCamera::setVelocity(), vpSimulatorPioneer::setVelocity(), and vpSimulatorPioneerPan::setVelocity().

vpColor vpWireFrameSimulator::desColor

protectedinherited

Definition at line 252 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), and vpWireFrameSimulator::vpWireFrameSimulator().

vpSceneDesiredObject vpWireFrameSimulator::desiredObject

protectedinherited

Definition at line 247 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), and vpWireFrameSimulator::initScene().

Bound_scene vpWireFrameSimulator::desiredScene

protectedinherited

Definition at line 235 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), vpWireFrameSimulator::initScene(), and vpWireFrameSimulator::~vpWireFrameSimulator().

vpDisplayX vpRobotWireFrameSimulator::display

protectedinherited

Definition at line 156 of file vpRobotWireFrameSimulator.h.

Referenced by vpRobotWireFrameSimulator::vpRobotWireFrameSimulator().

bool vpRobotWireFrameSimulator::displayAllowed

protectedinherited

Definition at line 169 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::updateArticularPosition(), updateArticularPosition(), and vpRobotWireFrameSimulator::vpRobotWireFrameSimulator().

bool vpRobotWireFrameSimulator::displayBusy

protectedinherited

Definition at line 141 of file vpRobotWireFrameSimulator.h.

Referenced by vpRobotWireFrameSimulator::vpRobotWireFrameSimulator().

bool vpWireFrameSimulator::displayCamera

protectedinherited

Definition at line 280 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpWireFrameSimulator::getExternalImage(), vpSimulatorAfma6::initArms(), initArms(), vpRobotWireFrameSimulator::initScene(), vpWireFrameSimulator::initScene(), vpWireFrameSimulator::vpWireFrameSimulator(), and vpWireFrameSimulator::~vpWireFrameSimulator().

bool vpWireFrameSimulator::displayCameraTrajectory

protectedinherited

Definition at line 256 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getExternalImage(), and vpWireFrameSimulator::vpWireFrameSimulator().

bool vpWireFrameSimulator::displayDesiredObject

protectedinherited

Definition at line 279 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), vpWireFrameSimulator::initScene(), vpWireFrameSimulator::vpWireFrameSimulator(), and vpWireFrameSimulator::~vpWireFrameSimulator().

bool vpWireFrameSimulator::displayImageSimulator

protectedinherited

Definition at line 281 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::getInternalImage(), vpWireFrameSimulator::initScene(), and vpWireFrameSimulator::vpWireFrameSimulator().

bool vpWireFrameSimulator::displayObject

protectedinherited

Definition at line 278 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), vpWireFrameSimulator::initScene(), vpWireFrameSimulator::vpWireFrameSimulator(), and vpWireFrameSimulator::~vpWireFrameSimulator().

vpDisplayRobotType vpRobotWireFrameSimulator::displayType

protectedinherited

Definition at line 167 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::updateArticularPosition(), updateArticularPosition(), and vpRobotWireFrameSimulator::vpRobotWireFrameSimulator().

vpMatrix vpRobot::eJe

protectedinherited

robot Jacobian expressed in the end-effector frame

Definition at line 103 of file vpRobot.h.

Referenced by vpSimulatorAfma6::computeArticularVelocity(), computeArticularVelocity(), vpSimulatorCamera::get_eJe(), vpRobotCamera::get_eJe(), vpSimulatorAfma6::getVelocity(), getVelocity(), vpSimulatorAfma6::setPosition(), and vpRobotAfma4::setVelocity().

int vpRobot::eJeAvailable

protectedinherited

is the robot Jacobian expressed in the end-effector frame available

Definition at line 105 of file vpRobot.h.

vpHomogeneousMatrix vpViper::eMc

protectedinherited

End effector to camera transformation.

Definition at line 147 of file vpViper.h.

Referenced by computeArticularVelocity(), vpViper::get_cMe(), vpViper::get_eMc(), vpViper::get_fMc(), vpViper::getInverseKinematics(), getVelocity(), vpViper850::init(), vpViper650::init(), init(), vpViper650::parseConfigFile(), vpViper850::parseConfigFile(), and vpViper::vpViper().

vpRxyzVector vpViper::erc

protectedinherited

Definition at line 150 of file vpViper.h.

Referenced by vpViper650::init(), vpViper850::init(), init(), vpRobotViper650::init(), vpRobotViper850::init(), vpViper850::parseConfigFile(), and vpViper650::parseConfigFile().

vpTranslationVector vpViper::etc

protectedinherited

Definition at line 149 of file vpViper.h.

Referenced by vpViper650::init(), vpViper850::init(), init(), vpRobotViper650::init(), vpRobotViper850::init(), vpViper850::parseConfigFile(), and vpViper650::parseConfigFile().

bool vpWireFrameSimulator::extCamChanged

protectedinherited

Definition at line 287 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getExternalImage(), and vpWireFrameSimulator::vpWireFrameSimulator().

vpHomogeneousMatrix vpWireFrameSimulator::f2Mf

protectedinherited

Definition at line 271 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), and vpWireFrameSimulator::getExternalImage().

vpMatrix vpRobot::fJe

protectedinherited

robot Jacobian expressed in the robot reference frame available

Definition at line 107 of file vpRobot.h.

Referenced by vpSimulatorAfma6::computeArticularVelocity(), computeArticularVelocity(), vpSimulatorAfma6::getVelocity(), and getVelocity().

int vpRobot::fJeAvailable

protectedinherited

is the robot Jacobian expressed in the robot reference frame available

Definition at line 109 of file vpRobot.h.

vpHomogeneousMatrix vpWireFrameSimulator::fMc

protectedinherited

Definition at line 240 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getExternalImage(), vpSimulatorAfma6::getPosition(), getPosition(), vpSimulatorAfma6::initialiseCameraRelativeToObject(), initialiseCameraRelativeToObject(), vpSimulatorAfma6::setPosition(), and setPosition().

vpHomogeneousMatrix* vpRobotWireFrameSimulator::fMi

protectedinherited

Table containing all the homogeneous matrices between the reference frame of the robot and the frames you used to compute the Denavit-Hartenberg representation

If you use a camera at the end of the effector, the last homogeneous matrix has to be the one between the reference frame and the camera frame (fMc)

Definition at line 115 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::compute_fMi(), compute_fMi(), vpSimulatorAfma6::init(), init(), vpSimulatorAfma6::updateArticularPosition(), updateArticularPosition(), vpSimulatorAfma6::~vpSimulatorAfma6(), and ~vpSimulatorViper850().

vpHomogeneousMatrix vpWireFrameSimulator::fMo

protectedinherited

Definition at line 239 of file vpWireFrameSimulator.h.

Referenced by vpRobotWireFrameSimulator::get_cMo(), vpRobotWireFrameSimulator::get_fMo(), vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), vpSimulatorAfma6::initialiseCameraRelativeToObject(), initialiseCameraRelativeToObject(), vpSimulatorAfma6::initialiseObjectRelativeToCamera(), initialiseObjectRelativeToCamera(), vpRobotWireFrameSimulator::set_fMo(), and vpWireFrameSimulator::vpWireFrameSimulator().

std::list<vpHomogeneousMatrix> vpWireFrameSimulator::fMoList

protectedinherited

Definition at line 259 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::vpWireFrameSimulator(), and vpWireFrameSimulator::~vpWireFrameSimulator().

HANDLE vpRobotWireFrameSimulator::hThread

protectedinherited

Definition at line 125 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::vpSimulatorAfma6(), vpSimulatorViper850(), vpSimulatorAfma6::~vpSimulatorAfma6(), and ~vpSimulatorViper850().

vpImage<vpRGBa> vpRobotWireFrameSimulator::I

inherited

Definition at line 92 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::updateArticularPosition(), updateArticularPosition(), and vpRobotWireFrameSimulator::vpRobotWireFrameSimulator().

vpColVector vpViper::joint_max

protectedinherited

Definition at line 161 of file vpViper.h.

Referenced by vpViper::getJointMax(), init(), vpRobotViper650::init(), vpRobotViper850::init(), isInJointLimit(), setJointLimit(), updateArticularPosition(), vpViper::vpViper(), vpViper650::vpViper650(), and vpViper850::vpViper850().

vpColVector vpViper::joint_min

protectedinherited

Definition at line 162 of file vpViper.h.

Referenced by vpViper::getJointMin(), init(), vpRobotViper650::init(), vpRobotViper850::init(), isInJointLimit(), setJointLimit(), updateArticularPosition(), vpViper::vpViper(), vpViper650::vpViper650(), and vpViper850::vpViper850().

bool vpRobotWireFrameSimulator::jointLimit

protectedinherited

True if one of the joint reach the limit

Definition at line 146 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::computeArticularVelocity(), computeArticularVelocity(), vpSimulatorAfma6::setVelocity(), setVelocity(), vpSimulatorAfma6::updateArticularPosition(), updateArticularPosition(), and vpRobotWireFrameSimulator::vpRobotWireFrameSimulator().

unsigned int vpRobotWireFrameSimulator::jointLimitArt

protectedinherited

Index of the joint which is in limit

Definition at line 148 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::updateArticularPosition(), and updateArticularPosition().

double vpRobot::maxRotationVelocity

protectedinherited

Definition at line 97 of file vpRobot.h.

const double vpRobot::maxRotationVelocityDefault = 0.7

staticprotectedinherited

Definition at line 98 of file vpRobot.h.

double vpRobot::maxTranslationVelocity

protectedinherited

Definition at line 95 of file vpRobot.h.

const double vpRobot::maxTranslationVelocityDefault = 0.2

staticprotectedinherited

Definition at line 96 of file vpRobot.h.

HANDLE vpRobotWireFrameSimulator::mutex_artCoord

protectedinherited

Definition at line 128 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::vpSimulatorAfma6(), vpSimulatorViper850(), vpSimulatorAfma6::~vpSimulatorAfma6(), and ~vpSimulatorViper850().

HANDLE vpRobotWireFrameSimulator::mutex_artVel

protectedinherited

Definition at line 127 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::vpSimulatorAfma6(), vpSimulatorViper850(), vpSimulatorAfma6::~vpSimulatorAfma6(), and ~vpSimulatorViper850().

HANDLE vpRobotWireFrameSimulator::mutex_display

protectedinherited

Definition at line 130 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::vpSimulatorAfma6(), vpSimulatorViper850(), vpSimulatorAfma6::~vpSimulatorAfma6(), and ~vpSimulatorViper850().

HANDLE vpRobotWireFrameSimulator::mutex_fMi

protectedinherited

Definition at line 126 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::compute_fMi(), compute_fMi(), vpSimulatorAfma6::vpSimulatorAfma6(), vpSimulatorViper850(), vpSimulatorAfma6::~vpSimulatorAfma6(), and ~vpSimulatorViper850().

HANDLE vpRobotWireFrameSimulator::mutex_velocity

protectedinherited

Definition at line 129 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::vpSimulatorAfma6(), vpSimulatorViper850(), vpSimulatorAfma6::~vpSimulatorAfma6(), and ~vpSimulatorViper850().

unsigned int vpWireFrameSimulator::nbrPtLimit

protectedinherited

Definition at line 260 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getExternalImage(), and vpWireFrameSimulator::vpWireFrameSimulator().

int vpRobot::nDof

protectedinherited

number of degrees of freedom

Definition at line 101 of file vpRobot.h.

const unsigned int vpViper::njoint = 6

staticinherited

Number of joint.

Definition at line 144 of file vpViper.h.

Referenced by vpRobotViper650::get_eJe(), vpRobotViper850::get_eJe(), vpRobotViper650::get_fJe(), vpRobotViper850::get_fJe(), vpRobotViper850::getDisplacement(), vpRobotViper650::getDisplacement(), vpViper::getInverseKinematicsWrist(), init(), readPosFile(), vpRobotViper650::readPosFile(), vpRobotViper850::readPosFile(), vpRobotViper650::setPosition(), vpRobotViper850::setPosition(), vpRobotViper650::setVelocity(), vpRobotViper850::setVelocity(), and vpViper::vpViper().

vpSceneObject vpWireFrameSimulator::object

protectedinherited

Definition at line 246 of file vpWireFrameSimulator.h.

std::list<vpImageSimulator> vpWireFrameSimulator::objectImage

protectedinherited

Definition at line 237 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::getInternalImage(), vpWireFrameSimulator::initScene(), and vpWireFrameSimulator::vpWireFrameSimulator().

vpImagePoint vpWireFrameSimulator::old_iPr

protectedinherited

Definition at line 262 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::navigation(), and vpWireFrameSimulator::vpWireFrameSimulator().

vpImagePoint vpWireFrameSimulator::old_iPt

protectedinherited

Definition at line 264 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::navigation(), and vpWireFrameSimulator::vpWireFrameSimulator().

vpImagePoint vpWireFrameSimulator::old_iPz

protectedinherited

Definition at line 263 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::navigation(), and vpWireFrameSimulator::vpWireFrameSimulator().

std::list<vpHomogeneousMatrix> vpWireFrameSimulator::poseList

protectedinherited

Definition at line 258 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::vpWireFrameSimulator(), and vpWireFrameSimulator::~vpWireFrameSimulator().

vpCameraParameters::vpCameraParametersProjType vpViper850::projModel

protectedinherited

Definition at line 144 of file vpViper850.h.

Referenced by vpViper850::getCameraParameters(), vpViper850::init(), and init().

double vpWireFrameSimulator::px_ext

protectedinherited

Definition at line 275 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpWireFrameSimulator::getExternalImage(), and vpWireFrameSimulator::vpWireFrameSimulator().

double vpWireFrameSimulator::px_int

protectedinherited

Definition at line 273 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getCameraParameters(), getCameraParameters(), vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), vpSimulatorAfma6::initDisplay(), initDisplay(), vpSimulatorAfma6::setCameraParameters(), setCameraParameters(), and vpWireFrameSimulator::vpWireFrameSimulator().

double vpWireFrameSimulator::py_ext

protectedinherited

Definition at line 276 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpWireFrameSimulator::getExternalImage(), and vpWireFrameSimulator::vpWireFrameSimulator().

double vpWireFrameSimulator::py_int

protectedinherited

Definition at line 274 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getCameraParameters(), getCameraParameters(), vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), vpSimulatorAfma6::initDisplay(), initDisplay(), vpSimulatorAfma6::setCameraParameters(), setCameraParameters(), and vpWireFrameSimulator::vpWireFrameSimulator().

double* vpRobot::qmax

protectedinherited

Definition at line 113 of file vpRobot.h.

double* vpRobot::qmin

protectedinherited

Definition at line 112 of file vpRobot.h.

vpHomogeneousMatrix vpWireFrameSimulator::refMo

protectedinherited

Definition at line 242 of file vpWireFrameSimulator.h.

Bound_scene* vpRobotWireFrameSimulator::robotArms

protectedinherited

Contains the 3D model of the robot's arms

Definition at line 108 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpSimulatorAfma6::init(), vpSimulatorAfma6::initArms(), initArms(), vpSimulatorAfma6::initDisplay(), initDisplay(), vpRobotWireFrameSimulator::vpRobotWireFrameSimulator(), vpSimulatorAfma6::~vpSimulatorAfma6(), and ~vpSimulatorViper850().

bool vpRobotWireFrameSimulator::robotStop

protectedinherited

True if the robot has to be stopped

Definition at line 144 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::updateArticularPosition(), updateArticularPosition(), vpRobotWireFrameSimulator::vpRobotWireFrameSimulator(), vpSimulatorAfma6::~vpSimulatorAfma6(), and ~vpSimulatorViper850().

vpHomogeneousMatrix vpWireFrameSimulator::rotz

protectedinherited

Definition at line 289 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::displayTrajectory(), vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), vpWireFrameSimulator::projectCameraTrajectory(), and vpWireFrameSimulator::vpWireFrameSimulator().

Bound_scene vpWireFrameSimulator::scene

protectedinherited

Definition at line 234 of file vpWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getExternalImage(), getExternalImage(), vpWireFrameSimulator::getExternalImage(), vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), vpWireFrameSimulator::initScene(), and vpWireFrameSimulator::~vpWireFrameSimulator().

bool vpWireFrameSimulator::sceneInitialized

protectedinherited

Definition at line 254 of file vpWireFrameSimulator.h.

Referenced by vpWireFrameSimulator::getInternalImage(), vpRobotWireFrameSimulator::getInternalView(), vpSimulatorAfma6::initDisplay(), initDisplay(), vpWireFrameSimulator::initScene(), vpWireFrameSimulator::vpWireFrameSimulator(), and vpWireFrameSimulator::~vpWireFrameSimulator().

bool vpRobotWireFrameSimulator::setVelocityCalled

protectedinherited

Flag used to specify to the thread managing the robot displacements that the setVelocity() method has been called.

Definition at line 174 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::setPosition(), setPosition(), vpSimulatorAfma6::setVelocity(), setVelocity(), vpSimulatorAfma6::updateArticularPosition(), updateArticularPosition(), and vpRobotWireFrameSimulator::vpRobotWireFrameSimulator().

bool vpRobotWireFrameSimulator::singularityManagement

protectedinherited

True if the singularity are automatically managed

Definition at line 150 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::computeArticularVelocity(), computeArticularVelocity(), and vpRobotWireFrameSimulator::vpRobotWireFrameSimulator().

unsigned int vpRobotWireFrameSimulator::size_fMi

protectedinherited

Size of the fMi table

Definition at line 111 of file vpRobotWireFrameSimulator.h.

Referenced by vpRobotWireFrameSimulator::get_cMo(), vpRobotWireFrameSimulator::getInternalView(), vpSimulatorAfma6::init(), and init().

double vpRobotWireFrameSimulator::tcur

protectedinherited

cpu time at the begining of the robot's movement

Definition at line 103 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::updateArticularPosition(), updateArticularPosition(), vpSimulatorAfma6::vpSimulatorAfma6(), and vpSimulatorViper850().

vpToolType vpViper850::tool_current

protectedinherited

Current tool in use.

Definition at line 138 of file vpViper850.h.

double vpRobotWireFrameSimulator::tprev

protectedinherited

cpu time at the end of the last robot's movement

Definition at line 105 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::updateArticularPosition(), and updateArticularPosition().

vpColVector vpRobotWireFrameSimulator::velocity

protectedinherited

The velocity in the current frame (articular, camera or reference)

Definition at line 122 of file vpRobotWireFrameSimulator.h.

Referenced by vpSimulatorAfma6::getVelocity(), getVelocity(), vpSimulatorAfma6::setPositioningVelocity(), setPositioningVelocity(), and vpRobotWireFrameSimulator::vpRobotWireFrameSimulator().

bool vpRobot::verbose_

protectedinherited

Definition at line 115 of file vpRobot.h.

Referenced by vpRobotAfma4::init(), vpRobotAfma6::init(), vpRobotViper650::init(), vpRobotViper850::init(), vpRobot::vpRobot(), vpRobotAfma4::vpRobotAfma4(), vpRobotAfma6::vpRobotAfma6(), vpRobotViper650::vpRobotViper650(), and vpRobotViper850::vpRobotViper850().

Public Types

Public Member Functions

Static Public Member Functions

Public Attributes

Static Public Attributes

Protected Types

Protected Member Functions

Static Protected Member Functions

Protected Attributes

Static Protected Attributes

Detailed Description

Member Enumeration Documentation

Constructor & Destructor Documentation

Member Function Documentation

Member Data Documentation