场景
动画
一、IRB 8700简介
二、动画脚本重点分析
2.1 sim.moveToPose
通过在两个 poses 之间执行插值,使用 Ruckig 在线轨迹生成器生成对象运动数据。该函数可以通过处理 4 个运动变量(x、y、z 和两个姿势之间的角度)或单个运动变量(t,需要指定一个度量来计算两个姿势之间的距离)来操作。该函数只能从线程中运行的脚本调用,因为这是一个阻塞操作
float[7]/float[12] endP/endM, float t = sim.moveToPose(int flags,
float[7]/float[12] currentP/currentM,
float[] maxVel, float[] maxAccel,
float[] maxJerk,
float[7]/float[12] targetP/targetM,
func/string callback, auxData,
float[4] metric = nil,
float timeStep = 0)
Arguments 参数
flags: Ruckig flags. -1 for default flags.
标志:Ruckig 标志。-1 表示默认标志。currentP/currentM: the start pose, specified via a pose [x y z qx qy qz qw] or transformation matrix [Vx0 Vy0 Vz0 P0 Vx1 Vy1 Vz1 P1 Vx2 Vy2 Vz2 P2]
currentP/currentM:起始姿势,通过姿势 [x y z qx qy qz qw] 或变换矩阵 [Vx0 Vy0 Vz0 P0 Vx1 Vy1 Vz1 P1 Vx2 Vy2 Vz2 P2] 指定maxVel: the maximum allowed velocity. If metric is specified, then this is an array of size 1, otherwse an array of size 4. If sim.ruckig_minVel is specified in flags, then this array should contain twice as many values, first the values for the maximum velocity, then the values for the minimum velocity.
maxVel:允许的最大速度。如果指定了 metric,则这是一个大小为 1 的数组,否则为大小为 4 的数组。如果在标志中指定了 sim.ruckig_minVel,则该数组应包含两倍的值,首先是最大速度的值,然后是最小速度值。maxAccel: the maximum allowed acceleration. If metric is specified, then this is an array of size 1, otherwse an array of size 4. If sim.ruckig_minAccel is specified in flags, then this array should contain twice as many values, first the values for the maximum acceleration, then the values for the minimum acceleration.
maxAccel:允许的最大加速度。如果指定了 metric,则这是一个大小为 1 的数组,否则为大小为 4 的数组。如果在标志中指定了 sim.ruckig_minAccel,则该数组应包含两倍的值,首先是最大加速度的值,然后是最小加速度值。maxJerk: the maximum allowed jerk. If metric is specified, then this is an array of size 1, otherwse an array of size 4.
maxJerk:允许的最大加加速度。如果指定了 metric,则这是一个大小为 1 的数组,否则为大小为 4 的数组。targetP/targetM: the goal pose, specified via a pose [x y z qx qy qz qw] or transformation matrix [Vx0 Vy0 Vz0 P0 Vx1 Vy1 Vz1 P1 Vx2 Vy2 Vz2 P2]
targetP/targetM:目标姿势,通过姿势 [x y z qx qy qz qw] 或变换矩阵 [Vx0 Vy0 Vz0 P0 Vx1 Vy1 Vz1 P1 Vx2 Vy2 Vz2 P2] 指定callback: a callback function that will be called for each movement step. The arguments provided to the callback function are: currentPose/currentMatrix, currentVel, currentAccel, auxData.
回调:每个移动步骤都会调用的回调函数。提供给回调函数的参数有:currentPose/currentMatrix、currentVel、currentAccel、auxData。auxData: random data that will be forwarded to the callback function.
auxData:将转发到回调函数的随机数据。metric: an optional metric, used to compute a pose-pose distance. If metric is None/nil, the movement calculation happens in the 4-dimensional space (x,y,z,angle), otherwise it happens in the 1-dimensional space (t).
metric:可选的度量,用于计算位姿-位姿距离。如果 metric 为 None/nil,则运动计算发生在 4 维空间 (x,y,z,angle) 中,否则发生在 1 维空间 (t) 中。timeStep: the desired time step size. A value of 0 indicates that the current simulation time step will be used.
timeStep:所需的时间步长。值 0 表示将使用当前模拟时间步长。
Return values 返回值
endP/endM: the pose at the end of the movement, specified via a pose [x y z qx qy qz qw] or transformation matrix [Vx0 Vy0 Vz0 P0 Vx1 Vy1 Vz1 P1 Vx2 Vy2 Vz2 P2]
endP/endM:运动结束时的位姿,通过位姿 [x y z qx qy qz qw] 或变换矩阵 [Vx0 Vy0 Vz0 P0 Vx1 Vy1 Vz1 P1 Vx2 Vy2 Vz2 P2] 指定t: the leftover time in current simulation step, i.e. the remaining time that was not used for movement.
t:当前模拟步骤的剩余时间,即未用于运动的剩余时间。
2.2 逆运动学求解
建立4个机器人运动学的IK组,作为auxData成员传递给自定义函数moveToPose,在自定义函数中传递给函数 sim.moveToPose的回调函数,回调函数中调用simIK.handleGroup处理所有逆运动学组的求解并设置{syncWorlds=true}将IK组的处理结果同步到仿真场景。以下依次为ik组1-4.
2.3 吸盘仿真
初始化函数中设置了吸盘是否为无限吸力、设置了最大拉力、最大剪切力,最大剥离扭矩。
传感函数中监控模型的自定义数据块吸盘状态:吸合-激活或释放-非激活,进行不同处理。当非激活时,重置dummy l 与l2重合,父对象为吸盘。当激活时,判断父对象是否为吸盘,如果为吸盘说明没有吸物体,此时通过接近传感器获取要吸合的物体,将dummy l绑定到物体上,并关联l 和l2 ;如果已经吸合物体,读取力传感器,判断是否需要有条件的释放物体,比如超出最大拉力、超出最大剪切力,任意方向的扭矩超过最大剥离扭矩。满足释放条件,就地释放物体。 同时在传感函数中实时检测仿真状态是否为“正在停止的最后一步”,如果是,则重置l与l2重合,父对象恢复为吸盘。
2.4 机器人Tip的速度曲线和加速度曲线
因为Tip的速度可直接获得,可直接用于绘制速度曲线图。加速度曲线图六需要通过 sim.setGraphStreamTransformation设置 sim.stream_transf_derivative,此时直接将速度值传递给加速度曲线即可。
参考网址:
https://new.abb.com/products/robotics/zh/robots/articulated-robots/irb-8700
https://search.abb.com/library/Download.aspx?DocumentID=3HAC052852-001&LanguageCode=en&DocumentPartId=&Action=Launch
https://library.e.abb.com/public/8b7f0d10fde0465c817d18e2e7664d37/IRB8700_datasheet_CN%20Rev%20D.pdf
作者陈晓永:智能装备专业高级工程师,软件工程师。机器人自动化产线仿真动画制作
The End