V-REP中集成了在线运动轨迹生成库Reflexxes Motion Library Type IV,目前Reflexxes公司已经被谷歌收购。(The Reflexxes Motion Libraries provide instantaneous trajectory generation capabilities for motion control systems.  Reflexxes Motion Library contains a set of On-Line Trajectory Generation (OTG) algorithms that are designed to control robots and mechanical systems.) Reflexxes的众多优点使其可以应用于机器人、数控机床和伺服驱动系统等领域。

  随着计算机技术的发展,数控系统已经从最初的由数字逻辑电路构成的硬线数控系统发展到了以计算机为核心的计算机数控(Computer Numerical Control,CNC)系统。相对于硬线数控系统而言,CNC系统的控制功能主要由软件实现,并可处理逻辑电路难以处理的复杂信息,因而具有较高的柔性和更高的性能。高速加工对CNC的最基本要求:以足够快的速度处理数据、为各进给轴加减速产生无冲击的理论值。高速加工CNC的核心技术是样条实时插补和无冲击的加速器。如果jerk(加加速读/突变)过大,可在短时间内实现加速,但同时会造成机床的振动,从而使所加工表面出现条纹,降低了表面质量。如果加加速过小,可以实现高的表面质量,但很难实现快加速功能。因此,为了保证在高速情况下加工出高质量表面,合理的机床加加速非常重要。

  在基于位置的在线轨迹生成算法中输入、输出如下图所示。输入端:当前状态包括当前位置/姿态向量以及当前速度向量;运动约束包括最大速度和最大加速度(在Type IV库中还可以支持加加速度);目标状态包括目标位置/姿态以及目标速度。为了保证算法的可行性和数值稳定性,输入参数需要满足以下几点要求:

  (1)最大速度和最大加速度必须大于0;

  (2)在位置模式下(for the position-based algorithm),最大速度必须大于或等于目标速度;

  (3)所有输入参数的数值必须在一定的范围内。 For the position-based algorithm this is range is specified by

    and for the velocity-based algorithm

Input and output values of the position-based Type II On-Line Trajectory Generation algorithm of the Reflexxes Motion Libraries

  提供合理的输入参数后,可以从输出端获取数据,用于底层控制。下面是一个生成三自由度关节轨迹的简单例子。The position-based On-Line Trajectory Generation algorithm of the Type II Reflexxes Motion Library is called by the method ReflexxesAPI::RMLPosition(). In this example (cf. Example 1 — Introduction to the Position-based algorithm), we assume to control a simple Cartesian robot with three translational degrees of freedom, and we apply the following input values at time instant .

  三个轴的输入参数如下:

  下载Reflexxes Motion Libraries Type II后将其解压,用Visual Studio打开工程文件生成TypeIIRML.lib(参考Download and Build Instructions for the Type II Reflexxes Motion Library)。将01_RMLPositionSampleApplication中的源文件代码进行修改,添加写文件操作,将生成的输出数据记录在文本文件中:

#include <stdio.h>
#include <stdlib.h>
#include <fstream>
#include <iostream> #include <ReflexxesAPI.h>
#include <RMLPositionFlags.h>
#include <RMLPositionInputParameters.h>
#include <RMLPositionOutputParameters.h> //*************************************************************************
// defines #define CYCLE_TIME_IN_SECONDS 0.001 //one millisecond
#define NUMBER_OF_DOFS 3 int main()
{
// ********************************************************************
// Variable declarations and definitions int ResultValue = ; ReflexxesAPI *RML = NULL; RMLPositionInputParameters *IP = NULL; RMLPositionOutputParameters *OP = NULL; RMLPositionFlags Flags; // ********************************************************************
// Creating all relevant objects of the Type II Reflexxes Motion Library RML = new ReflexxesAPI(NUMBER_OF_DOFS, CYCLE_TIME_IN_SECONDS); IP = new RMLPositionInputParameters(NUMBER_OF_DOFS); OP = new RMLPositionOutputParameters(NUMBER_OF_DOFS); // ********************************************************************
// Set-up the input parameters // In this test program, arbitrary values are chosen. If executed on a
// real robot or mechanical system, the position is read and stored in
// an RMLPositionInputParameters::CurrentPositionVector vector object.
// For the very first motion after starting the controller, velocities
// and acceleration are commonly set to zero. The desired target state
// of motion and the motion constraints depend on the robot and the
// current task/application.
// The internal data structures make use of native C data types
// (e.g., IP->CurrentPositionVector->VecData is a pointer to
// an array of NUMBER_OF_DOFS double values), such that the Reflexxes
// Library can be used in a universal way. IP->CurrentPositionVector->VecData[] = 100.0;
IP->CurrentPositionVector->VecData[] = 0.0;
IP->CurrentPositionVector->VecData[] = 50.0; IP->CurrentVelocityVector->VecData[] = 100.0;
IP->CurrentVelocityVector->VecData[] = -220.0;
IP->CurrentVelocityVector->VecData[] = -50.0; IP->CurrentAccelerationVector->VecData[] = -150.0;
IP->CurrentAccelerationVector->VecData[] = 250.0;
IP->CurrentAccelerationVector->VecData[] = -50.0; IP->MaxVelocityVector->VecData[] = 300.0;
IP->MaxVelocityVector->VecData[] = 100.0;
IP->MaxVelocityVector->VecData[] = 300.0; IP->MaxAccelerationVector->VecData[] = 300.0;
IP->MaxAccelerationVector->VecData[] = 200.0;
IP->MaxAccelerationVector->VecData[] = 100.0; IP->TargetPositionVector->VecData[] = -600.0;
IP->TargetPositionVector->VecData[] = -200.0;
IP->TargetPositionVector->VecData[] = -350.0; IP->TargetVelocityVector->VecData[] = 50.0;
IP->TargetVelocityVector->VecData[] = -50.0;
IP->TargetVelocityVector->VecData[] = -200.0; IP->SelectionVector->VecData[] = true;
IP->SelectionVector->VecData[] = true;
IP->SelectionVector->VecData[] = true; std::ofstream out("out.txt", std::ios::app);
// ********************************************************************
// Starting the control loop while (ResultValue != ReflexxesAPI::RML_FINAL_STATE_REACHED)
{
// Calling the Reflexxes OTG algorithm
ResultValue = RML->RMLPosition(*IP, OP, Flags); if (ResultValue < )
{
printf("An error occurred (%d).\n", ResultValue);
break;
} // ****************************************************************
// Here, the new state of motion, that is
//
// - OP->NewPositionVector
// - OP->NewVelocityVector
// - OP->NewAccelerationVector
//
// can be used as input values for lower level controllers. In the
// most simple case, a position controller in actuator space is
// used, but the computed state can be applied to many other
// controllers (e.g., Cartesian impedance controllers,
// operational space controllers).
// ****************************************************************
for (int i = ; i < ; i++)
out << OP->NewPositionVector->VecData[i] << ",";
out << std::endl;
// ****************************************************************
// Feed the output values of the current control cycle back to
// input values of the next control cycle *IP->CurrentPositionVector = *OP->NewPositionVector;
*IP->CurrentVelocityVector = *OP->NewVelocityVector;
*IP->CurrentAccelerationVector = *OP->NewAccelerationVector;
} // ********************************************************************
// Deleting the objects of the Reflexxes Motion Library end terminating
// the process delete RML;
delete IP;
delete OP; out.close(); exit(EXIT_SUCCESS);
}

  while循环中调用RMLPosition函数(This is the central method of each Reflexxes Type Motion Library)单步执行轨迹生成算法。如果还没达到目标状态,该函数返回ReflexxesAPI::RML_WORKING;如果已达到设定的运动状态则返回ReflexxesAPI::RML_FINAL_STATE_REACHED,其它返回值可以参见API手册。

  将记录的三个轴的位置数据在Excel中用折线图显示出来(速度和加速度信息也可以按照同样方式操作):

  可以看出达到设定的目标位置。Reflexxes Motion Library有更复杂和强大的用法,这里只是先作一个简单的介绍。


  在V-REP中集成了Reflexxes Motion Library type IV C++库,目前在lua API中有如下几个函数可以使用:

  将UR5机器人从模型库拖到新建的场景里中,与其关联的代码里设置了当前关节速度、加速度以及运动过程中的最大速度、加速度、目标速度以及目标位置。然后调用simRMLMoveToJointPositions同时移动UR机器人的6个关节使其按照运动规律达到目标位置。

-- This is a threaded script, and is just an example!

jointHandles={-,-,-,-,-,-}
for i=,, do
jointHandles[i]=simGetObjectHandle('UR5_joint'..i)
end -- Set-up some of the RML vectors:
vel=
accel=
jerk=
currentVel={,,,,,,}
currentAccel={,,,,,,}
maxVel={vel*math.pi/,vel*math.pi/,vel*math.pi/,vel*math.pi/,vel*math.pi/,vel*math.pi/}
maxAccel={accel*math.pi/,accel*math.pi/,accel*math.pi/,accel*math.pi/,accel*math.pi/,accel*math.pi/}
maxJerk={jerk*math.pi/,jerk*math.pi/,jerk*math.pi/,jerk*math.pi/,jerk*math.pi/,jerk*math.pi/}
targetVel={,,,,,} targetPos1={*math.pi/,*math.pi/,-*math.pi/,*math.pi/,*math.pi/,*math.pi/} -- simRMLMoveToJointPositions: Moves (actuates) several joints at the same time using the Reflexxes Motion Library.
-- This function can only be called from child scripts running in a thread
--[[
number result,table newPos,table newVel,table newAccel,number timeLeft=simRMLMoveToJointPositions(table jointHandles,
number flags,table currentVel,table currentAccel,table maxVel,
table maxAccel,table maxJerk,table targetPos,table targetVel,table direction)
--]]
simRMLMoveToJointPositions(jointHandles,-,currentVel,currentAccel,maxVel,maxAccel,maxJerk,targetPos1,targetVel) targetPos2={-*math.pi/,*math.pi/,*math.pi/,*math.pi/,*math.pi/,*math.pi/}
simRMLMoveToJointPositions(jointHandles,-,currentVel,currentAccel,maxVel,maxAccel,maxJerk,targetPos2,targetVel) targetPos3={,,,,,}
simRMLMoveToJointPositions(jointHandles,-,currentVel,currentAccel,maxVel,maxAccel,maxJerk,targetPos3,targetVel)

  添加一个Graph记录基座转动关节的角位移,可以看出确实符合程序中的设置:0°→90°→-90°→0°

参考:

Reflexxes Motion LibrariesManual and Documentation

V-REP: Reflexxes Motion Library Demonstration

V-rep学习笔记:Reflexxes Motion Library 1的更多相关文章

  1. V-rep学习笔记:Reflexxes Motion Library 3

    路径规划 VS 轨迹规划 轨迹规划的目的是将输入的简单任务描述变为详细的运动轨迹描述.注意轨迹和路径的区别:Trajectory refers to a time history of positio ...

  2. V-rep学习笔记:Reflexxes Motion Library 2

    VREP中的simRMLMoveToPosition函数可以将静态物体按照设定的运动规律移动到指定的目标位置/姿态.If your object is dynamically enabled, it ...

  3. 【HLSL学习笔记】WPF Shader Effect Library算法解读之[DirectionalBlur]

    原文:[HLSL学习笔记]WPF Shader Effect Library算法解读之[DirectionalBlur] 方位模糊是一个按照指定角度循环位移并叠加纹理,最后平均颜色值并输出的一种特效. ...

  4. 【HLSL学习笔记】WPF Shader Effect Library算法解读之[Embossed]

    原文:[HLSL学习笔记]WPF Shader Effect Library算法解读之[Embossed] Embossed(浮雕效果)          浮雕效果主要有两个参数:Amount和Wid ...

  5. 【HLSL学习笔记】WPF Shader Effect Library算法解读之[BandedSwirl]

    原文:[HLSL学习笔记]WPF Shader Effect Library算法解读之[BandedSwirl] 因工作原因,需要在Silverlight中使用Pixel Shader技术,这对于我来 ...

  6. R语言与机器学习学习笔记

    人工神经网络(ANN),简称神经网络,是一种模仿生物神经网络的结构和功能的数学模型或计算模型.神经网络由大量的人工神经元联结进行计算.大多数情况下人工神经网络能在外界信息的基础上改变内部结构,是一种自 ...

  7. DirectX Graphics Infrastructure(DXGI):最佳范例 学习笔记

    今天要学习的这篇文章写的算是比较早的了,大概在DX11时代就写好了,当时龙书11版看得很潦草,并没有注意这篇文章,现在看12,觉得是跳不过去的一篇文章,地址如下: https://msdn.micro ...

  8. <老友记>学习笔记

    这是六个人的故事,从不服输而又有强烈控制欲的monica,未经世事的千金大小姐rachel,正直又专情的ross,幽默风趣的chandle,古怪迷人的phoebe,花心天真的joey——六个好友之间的 ...

  9. (转) OpenCV学习笔记大集锦 与 图像视觉博客资源2之MIT斯坦福CMU

          首页 视界智尚 算法技术 每日技术 来打我呀 注册     OpenCV学习笔记大集锦 整理了我所了解的有关OpenCV的学习笔记.原理分析.使用例程等相关的博文.排序不分先后,随机整理的 ...

随机推荐

  1. OpenResty全功能Web应用服务器,打包了标准的 nginx 核心

    OpenResty打包了标准的 nginx 核心,很多的常用的第三方模块,以及它们的大多数依赖项. 通过揉和众多设计良好的 nginx 模块,OpenResty 有效地把 nginx 服务器转变为一个 ...

  2. Matlab中使用LaTeX

    Matlab作为数据计算和处理的数学语言(软件),而LaTex作为出版界的重要排版语言(软件),尤其是对数学公式的排版功能特别强.在Matlab中有两种方法使用LaTeX:1)对Matlab生成的图形 ...

  3. 基于JAVA原生HTTP请求工具类 httphelper

    原文地址;http://lushuifa.iteye.com/blog/2313896 import java.io.BufferedReader; import java.io.BufferedWr ...

  4. 深入JVM系列(二)之GC机制、收集器与GC调优

    一.回想JVM内存分配 须要了解很多其它内存模式与内存分配的,请看 深入JVM系列(一)之内存模型与内存分配 1.1.内存分配: 1.对象优先在EDEN分配 2.大对象直接进入老年代  3.长期存活的 ...

  5. 【经验】STL的list vector在iterator迭代器的循环中 使用erase 造成的BUG

    #include <iostream> #include <list> #include <vector> using namespace std; typedef ...

  6. C/C++ 关于 for循环 的第二个表达式右侧非常量的时候

    废话不多说,直接看代码: #include<stdio.h> int main(){ ; ;z<zmax;z++){ printf("i=%d z=%d\n",i ...

  7. java问题排查命令

    java问题排查命令 jps:查看java进程 jmap:导出堆详细信息(与jhat一起使用) jhat:分析Java堆的命令(与jmap一起使用) jstack:可以定位到线程堆栈,根据堆栈信息我们 ...

  8. Windows server 2012 R2 与 Windows 2016 的双系统重启选项

    一台主机上,同时安装了Windows 2012R2还有Windows 2016, 但是如何能在任意一个系统重启到另一个呢? 下图中,在Win2012R2中,无法选择重启到2016中. 解决方案 === ...

  9. Redis 在线管理工具(phpRedisAdmin)介绍

    phpRedisAdmin is a simple web interface to manage Redis databases. phpRedisAdmin 在 Redis clients 的列表 ...

  10. Kafka:ZK+Kafka+Spark Streaming集群环境搭建(二十二)Spark Streaming接收流数据及使用窗口函数

    官网文档:<http://spark.apache.org/docs/latest/streaming-programming-guide.html#a-quick-example> Sp ...