一种基于完整自由段接触搜索的机器人编织异形芯模沉积轨迹与收敛距离测量方法

摘要: 本发明涉及机器人辅助复合材料编织成形与轨迹控制,具体涉及一种基于完整自由段接触搜索的机器人编织异形芯模沉积轨迹与收敛距离测量方法。背景技术:1、复合材料环形编织...
一种基于完整自由段接触搜索的机器人编织异形芯模沉积轨迹与收敛距离测量方法

本发明涉及机器人辅助复合材料编织成形与轨迹控制,具体涉及一种基于完整自由段接触搜索的机器人编织异形芯模沉积轨迹与收敛距离测量方法。

背景技术:

1、复合材料环形编织成形过程中,多根纱线在导向环带动下相互交错并沉积于芯模表面形成预成型体。对于等截面或简单芯模,纱线分布可根据导向环运动与芯模几何关系近似求解;但对于弯曲、变截面或弯曲变截面耦合的异形芯模,纱线沉积过程与上一有效沉积锚点位置、当前导纱点位置、芯模全局表面接触关系及局部半径变化密切相关。

2、现有技术中,纱线轨迹求解方法通常采用局部面片投影递推方式,以上一落点所在三角面片及其邻域为搜索范围,通过投影点与面片边求交确定下一落点;另有方法基于已知落点所在局部三角面片进行向量投影递推,并以纱线是否落在芯模表面作为落点更新条件。上述方法通常未以上一有效沉积锚点至当前导纱点之间的完整空间自由段作为接触搜索对象,难以统一描述纱线自由段与芯模全局表面的首次接触关系;在弯曲变截面芯模的过渡区域,容易出现候选落点误选、沉积点沿错误面片链跳转以及落点曲线局部不连续的问题。

3、此外,已有后处理测量通常将局部编织角、收敛距离h等工艺参数分别计算,测量对象和测量基准不完全一致,导致同一弧长位置处的参数偏差之间缺少统一对应关系,影响机器人辅助编织过程中后续tcp轨迹修正输入的可靠性。因此,有必要提出一种以完整空间自由段为统一分析对象的沉积落点确定方法,并在同一预测沉积轨迹基础上实现局部编织角和动态收敛距离h的统一测量与轨迹修正。

技术实现思路

1、针对现有技术存在的不足,本发明提供一种基于完整自由段接触搜索的机器人编织异形芯模沉积轨迹与收敛距离测量方法。本发明所述完整自由段是指上一有效沉积锚点与当前导纱点之间构成的完整空间自由段。

2、为实现上述目的,本发明提供如下技术方案:一种基于完整自由段接触搜索的机器人编织异形芯模沉积轨迹与收敛距离测量方法,包括以下步骤:s1、获取异形芯模的三维几何模型、芯模中心线数据、导向环几何参数、纱线数量、导向环旋转参数以及编织工艺参数;s2、对所述芯模中心线进行弧长参数化,并在所述芯模中心线的离散位置建立用于几何定位和测量的局部参考,得到各离散位置对应的弧长坐标及局部几何参数;s3、根据导向环中心位置、导向环半径、纱线初始相位和导向环旋转状态,确定各根纱线在各时刻对应的导纱点位置;

3、s4、对于第k根纱线在当前时刻t,以该纱线的上一有效沉积锚点为自由段起点,以当前导纱点为自由段终点,构建完整空间自由段,在初始时刻,根据芯模前端边界圈采样或前端点云采样确定各纱线初始锚点,并与对应导纱点的角度顺序对齐;其中:

4、s5、沿所述完整空间自由段的运动方向,在异形芯模表面筛选候选三角面片集合,所述筛选依据包括候选面片中心与上一有效沉积锚点之间的距离约束,以及候选面片中心相对于上一有效沉积锚点的方向向量与完整空间自由段单位方向向量的点积为正的前向方向约束;

5、s6、对所述完整空间自由段与候选三角面片集合进行首相交搜索,并根据首相交点位于上一有效沉积锚点与当前导纱点之间有效线段内部的条件,将满足有效性条件的首相交点确定为当前沉积落点;

6、s7、按照时间顺序累积各时刻的沉积落点,形成各根纱线在异形芯模表面的预测沉积轨迹,并基于同一预测沉积轨迹在同一弧长坐标系下测量局部编织角和动态收敛距离h;

7、s8、根据所述局部编织角和动态收敛距离h与对应目标值之间的偏差,生成机器人tcp后续轨迹修正输入。

8、在其中一些实施例中,所述异形芯模的三维几何模型为三角网格模型、体网格模型或由离散截面轮廓重建得到的曲面模型;所述芯模中心线数据为由离散点构成的三维路径;所述局部几何参数包括局部等效半径、半径变化率或半径坡度中的一种或多种。

9、在其中一些实施例中,所述s2中,所述局部参考至少包括芯模中心线的弧长坐标及用于几何定位和测量的局部方向信息;所述局部几何参数包括局部等效半径、半径变化率或半径坡度中的一种或多种。

10、在其中一些实施例中,所述s3中,第k根纱线在时刻t的导纱点位置位于导向环圆周上,并根据导向环中心位置、导向环半径、该纱线的初始相位以及旋转方向连续变化。

11、在其中一些实施例中,所述候选三角面片集合由满足以下条件的三角面片共同组成:候选三角面片中心与上一有效沉积锚点之间的距离小于由完整空间自由段长度确定的预设阈值,且候选三角面片中心相对于上一有效沉积锚点的方向向量与完整空间自由段的单位方向向量的点积为正。

12、在其中一些实施例中,所述首相交点为完整空间自由段与候选三角面片集合中的三角面片相交所得的首个交点,所述首个交点沿完整空间自由段自上一有效沉积锚点指向当前导纱点的方向确定。

13、在其中一些实施例中,所述候选三角面片的筛选包括:计算候选三角面片中心与上一有效沉积锚点之间的欧氏距离,并保留距离小于完整空间自由段长度加预设冗余量的候选三角面片;计算候选三角面片中心相对于上一有效沉积锚点的方向与完整空间自由段单位方向向量的点积,并保留点积为正的候选三角面片。

14、在其中一些实施例中,所述s6中的有效性判定包括自由段参数有效性条件、候选面片距离约束条件和前向方向约束条件;其中,所述自由段参数有效性条件为首相交点位于上一有效沉积锚点与当前导纱点之间的有效线段内部,且与所述上一有效沉积锚点及当前导纱点均保持预设最小间距。

15、在其中一些实施例中,当首相交点满足所述有效性判定条件时,将该首相交点确定为当前沉积落点,并写入对应纱线的沉积锚点序列。

16、在其中一些实施例中,当当前时刻不存在满足所述有效性判定条件的首相交点时,保持上一有效沉积锚点不变,并在下一时刻继续执行候选三角面片筛选和首相交搜索。

17、在其中一些实施例中,所述s7中,对每一根纱线分别保存沉积锚点序列,并按照时间顺序将所述沉积锚点序列连接为该纱线的预测沉积轨迹,所述预测沉积轨迹作为局部编织角和动态收敛距离h的共同测量基础。

18、在其中一些实施例中,所述局部编织角的测量包括提取预测沉积轨迹在目标弧长位置处的纱线切向量,并将所述纱线切向量、沉积落点、芯模中心线局部切向以及芯模局部表面切平面统一到同一弧长坐标系和测量基准下,以得到局部编织角。

19、在其中一些实施例中,在等直径区域采用基于芯模中心线切向量的轴向角测量方式;在变直径区域将纱线切向量投影至由中心线切向量和周向方向构成的局部表面展开坐标系中,并基于轴向分量和周向分量计算表面投影角;在等直径区域与变直径区域之间的过渡区域,根据芯模局部等效半径对弧长的一阶导数确定混合权重,并采用混合权重方式得到连续的编织角测量结果。

20、在其中一些实施例中,所述变直径区域通过芯模局部等效半径对弧长的一阶导数、局部等效半锥角或半径坡度阈值进行识别。

21、在其中一些实施例中,所述动态收敛距离的测量包括:将当前沉积落点关联到芯模中心线对应的弧长位置,并根据当前导向环中心、当前沉积落点以及导向环法向确定单根纱线对应的动态收敛距离。

22、在其中一些实施例中,所述收敛距离为导向环中心相对于当前沉积落点在导向环法向方向上的投影距离,可表示为:

23、

24、同一弧长邻域内多根纱线的收敛距离可取平均值或加权平均值得到截面收敛距离

25、在一些可选实施例中,还可基于预测沉积轨迹得到芯模表面局部覆盖率,所述覆盖率不作为生成机器人tcp后续轨迹修正输入的必要测量对象。

26、在其中一些实施例中,所述s8中,根据目标编织角和目标动态收敛距离h计算编织角偏差和收敛距离偏差,并根据所述偏差生成机器人tcp的位置修正量、姿态修正量或轨迹速度参数修正量,使后续弧长位置处的理论落纱截面与预测沉积区域之间的相对位置误差减小。

27、本发明还提供一种电子设备,包括处理器和存储器,所述存储器中存储有计算机程序,所述计算机程序被所述处理器执行时,实现所述的方法。

28、本发明还提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时,实现所述的方法。

29、与现有技术相比,本发明的有益效果是:

30、其一,将上一有效沉积锚点与当前导纱点之间的完整空间自由段作为沉积接触分析对象,减少弯曲变截面芯模局部过渡区域中因局部面片递推造成的伪接触点误选;

31、其二,通过候选三角面片中心距离约束、前向方向约束以及首相交点位于有效线段内部且与两端点保持预设最小间距的条件,提高沉积落点确定的稳定性,抑制沉积点沿错误面片链跳转及落点曲线局部不连续的问题;

32、其三,将局部编织角和动态收敛距离h统一建立在同一预测沉积轨迹和同一弧长坐标系下,使同一弧长位置处的编织角偏差和收敛距离偏差具有统一对应关系;

33、其四,基于上述统一测量结果生成机器人tcp的位置修正量、姿态修正量或轨迹速度参数修正量,使该方法不仅适用于静态织物模拟,还可用于机器人辅助编织过程的后续轨迹修正,提高复杂异形芯模条件下编织工艺参数预测与机器人控制的一致性。

34、以下结合附图和具体实施方式对本发明作进一步说明。