CN111588494A - 一种基于弯制点密度的正畸弓丝变角度划分方法 - Google Patents

Abstract

本发明公开了一种基于弯制点密度的正畸弓丝变角度划分方法，它涉及正畸弓丝弯制领域，根据患者的个性化正畸弓丝曲线，基于正畸弓丝曲线成形控制点信息集，成形控制点的机器人运动信息集，当患者正畸弓丝曲线上各弯制点的单位角距比均小于单位角距比上限值时，结合机器人弯制正畸弓丝的特点，设定变角度域弯制点密度上限值，得出一种基于弯制点密度的正畸弓丝变角度划分方法，划分并排列变角度域，最终得到各弯制点的弯制顺序。本发明通过对划分变角度域的弯制点密集程度进行定量约束，保证了变角度域划分的合理性，提高了规划效率。

Description

一种基于弯制点密度的正畸弓丝变角度划分方法

技术领域

本发明专利涉及一种基于弯制点密度的正畸弓丝变角度划分方法，属于正畸弓丝弯制技术领域。

背景技术

目前错颌畸形是一种在人群中发病率较高的口腔疾病，错颌畸形不仅影响患者颌骨及面部软组织的发育、口腔的健康和功能、容貌外观和发音功能，甚至可能导致呼吸困难和胃肠功能的紊乱等严重后果，在现代口腔医学中固定矫治是一种常用且有效的正畸治疗手段，而正畸弓丝的弯制精度是固定矫治技术治疗的关键，随着数字化技术的不断发展，正畸矫治器中弓丝的加工正在向数字化发展，弯制点顺序的高效规划是实现弓丝数字化加工，提高机器人弯制正畸弓丝效率以及保证弯制精度的前提。

在个性化弓丝弯制点顺序规划时，个性化正畸弓丝上存在各弯制点的弯制复杂程度相对较低，即各弯制点的单位角距比都相对较小的情况，当弓丝曲线上各弯制点的单位角距比值均小于根据机器人弯制正畸弓丝而设定的单位角距比上限值时，由于其弯制点分布的特殊性，在对这类个性化正畸弓丝进行变角度域划分时，现有的正畸弓丝成形控制点弯制顺序规划计算量相对较大，规划期间耗时相对较大，目前正畸弓丝弯制技术领域缺少对此类个性化正畸弓丝弯制点顺序规划的方法，无法对此类个性化正畸弓丝实现高效数字化弯制。

发明内容

针对上述问题，本发明提出一种基于弯制点密度的正畸弓丝变角度划分方法，解决目前正畸弓丝弯制技术领域缺少对此类个性化正畸弓丝弯制点顺序规划的方法的问题，在弯制顺序规划过程中提出合理的划分依据，对所划分区域的弯制点密集程度定量约束，进而实现高效的正畸弓丝数字化弯制。

本发明为解决上述问题所采取的方案为：一种基于弯制点密度的正畸弓丝变角度划分方法，其特征在于：所述方法的具体实现过程为：

步骤一、变角度域划分数据导入：

根据患者有i个成形控制点的个性化正畸弓丝曲线，输入个性化正畸弓丝曲线成形控制点信息集M＝{m₁，m₂，m₃，...，m_i}，m_i＝(u_i，v_i，w_i)'为每个个性化正畸弓丝曲线成形控制点的坐标，每一个正畸弓丝曲线成形控制点m_i均对应一个成形控制点机器人运动信息单元n_i，输入的成形控制点的机器人运动信息集为N＝{n₁，n₂，n₃，...，n_i}，n_i表示机器人在弯制该点时的成形控制点坐标及弯制角度，n_i＝(u_i，v_i，w_i，α_i)'，u_i、v_i、w_i为该成形控制点m_i的坐标，α_i为机器人作用在成形控制点m_i上的弯制角度，将正畸弓丝曲线成形控制点信息集M、成形控制点的机器人运动信息集N，单位角距比上限值E_max输入到正畸弓丝弯制系统中，并且根据机器人弯制正畸弓丝的特点设定变角度域弯制点密度阀值ρ_max；

个性化正畸弓丝曲线两端点坐标为m_s(u_s，v_s，w_s)，m_e(u_e，v_e，w_e)，将弓丝曲线左端点m_s设定为成形控制点m₀，将弓丝曲线右端点m_e设定为成形控制点m_i+1，以弓丝曲线左右端点的中点

定义为圆心O，将成形控制点m_k作为划分变角度域的起点，k的初始值为k＝0，0≤k≤i，成形控制点m_k与圆心O之间的连线定义为划分半径R_k；

步骤二、正畸弓丝曲线坐标转换及划分变量定义：

将个性化正畸弓丝成形控制点信息集中各成形控制点的坐标m_i＝(u_i,v_i,w_i)'中的w_i赋值为0，即令w_i＝0，获得正畸弓丝转换曲线M′；

针对变角度划分方法而言，定义变角度域b_k的弯制点密度

其中

表示在变角度域b_k内划分的弯制点个数，

的初始值为

表示变角度域b_k内划分半径R_k与划分半径

之间形成的角度值，

为在变角度域b_k内最大的划分半径，初始化

个性化正畸弓丝上任意一弯制点m_x的单位角距比

为弯制点m_x的弯制角度α_x与其弯制距离

的比值，即

其中

表示弯制点m_x与弯制点m_x+1之间的弧长，1≤x≤i，计算个性化正畸弓丝上各弯制点的单位角距比

当各弯制点的单位角距比

均小于单位角距比上限值E_max时，跳转至步骤三；

步骤三、寻找变角度域内的最大半径

R_k+j表示从成形控制点m_k到成形控制点

之间的第j个成形控制点对应的划分半径值，j的初始值为j＝1，

a)判断

是否成立；

如果

成立，判断

是否成立；

如果

成立，则将R_k+j的值赋予

即

j＝j+1，返回步骤三a；

如果

不成立，

的值保持不变，即

j＝j+1，返回步骤三a；

b)如果

不成立，跳转至步骤四；

步骤四、计算变角度域弯制点密度：

与R_k之间的角度记为

利用公式

计算变角度域b_k的弯制点密度；

判断

是否成立；

如果

成立，说明已划分至弓丝曲线的右端点，将弯制点m_k和弯制点

之间的变角度域定义为变角度域区间b_k，变角度域区间b_k的弯制点密度为

跳转至步骤五，统计已划分的弯制点数目q；

如果

不成立，说明未划分至弓丝曲线的右端点，并且判断

是否成立；

如果

成立，则可以继续增加该变角度域内弯制点的个数，即令

跳转至步骤三；

如果

不成立，说明该变角度域内不能再增加弯制点，跳转至步骤五；

步骤五、定义变角度域区间：

将弯制点m_k和弯制点

之间的变角度域定义为变角度域区间b_k，并且变角度域区间b_k内从弯制点m_k到弯制点

包括弯制点

但是不包括弯制点m_k的所有弯制点已划分，统计已划分的弯制点数目q，变角度域区间b_k的弯制点密度为

跳转至步骤六；

步骤六、判断是否继续进行变角度域划分：

判断q＝i是否成立；

如果q＝i不成立，则继续进行变角度域划分，由于当前弯制点不符合弯制要求，故从当前弯制点的上一个弯制点继续开始变角度划分，即以

为划分变角度域的起点，令

跳转至步骤二；

如果q＝i成立，说明所有的弯制点均已被划分，跳转至步骤七；

步骤七、获得最终弯制点弯制顺序：

输出变角度域区间信息集B＝{b₁，b₂，...，b_g}，每个变角度域区间(b₁，b₂，...，b_g)所对应的角度值分别为(θ₁，θ₂，...，θ_g)，并且θ₁+θ₂+...+θ_g＝π，比较每个变角度域区间(b₁，b₂，...，b_g)的弯制点密度

得到

则以弯制点密度

为指标将g个变角度域区间降序排列，得到降序变角度域区间信息集C＝{c₂，c₄，...，c_g}，在任何一个变角度域区间内，以各弯制点的单位角距比

为指标对弯制点进行降序排列，将弯制点角距比降序排列顺序定义为该变角度域区间内的弯制点弯制顺序，得到个性化正畸弓丝曲线成形控制点坐标降序矩阵M₁{m₄，m₆，...，m_s}和机器人运动降序信息集N₁{n₄，n₆，...，n_s}，其中m_s表示变角度域区间b_g中的弯制点，输出最终弯制点弯制顺序M₁{m₄，m₆，...，m_s}、N₁{n₄，n₆，...，n_s}，程序结束。

本发明的有益效果为：

1、本发明在对正畸弓丝进行变角度划分时，提出了单位角距比的概念，通过各弯制点弯制角度与弯制弧长的比值对正畸弓丝曲线上各个弯制点的弯制复杂程度进行量化描述，并且根据机器人弯制正畸弓丝的特点设定了单位角距比上限值E_max，从而限定了此时正畸弓丝曲线上各弯制点的弯制复杂程度，方便下一步利用弯制点密度值对正畸弓丝曲线进行变角度域划分。

2、同本发明人同日申报的发明专利《一种变角度划分的正畸弓丝弯制顺序规划方法》相比，本专利先对正畸弓丝曲线上各弯制点的弯制复杂程度进行判断，即判断正畸弓丝曲线上各弯制点的单位角距比均满足划分要求后，再对其进行变角度划分，此时划分时只需计算变角度域弯制点密度，从而减少了循环次数，降低计算规模，提高了划分效率。

3、本发明在根据变角度域弯制点密度

对各变角度区间进行降序排列之后，在各个变角度区间内部，使用每个弯制点的单位角距比的降序排列作为该区间内弯制点的排列顺序，最后可以输出合理的弯制顺序，保证了正畸弓丝弯制规划的完整性。

4、同本发明人已经授权的授权公告号为CN107714203B的发明专利《一种等角度划分的正畸弓丝弯制顺序规划方法》相比，本方法是在平面变角度划分的基础上，针对具有特定属性的一类弓丝，充分考虑此类正畸弓丝曲线上弯制点分布信息个性化特点，即患者个性化正畸弓丝上弯制点的单位角距比都相对较小，各弯制点的单位角距比均小于规定的单位角距比上限值，提出了基于变角度域弯制点密度的概念，用于划分此类正畸弓丝曲线的划分方法，使得划分过程并非以一种无依据的均匀化标准进行划分，而是为了使划分的变角度域符合弯制点分布密集程度的上限要求，不断改变划分变角度域的角度值，生成了一系列满足变角度域弯制点密度要求的变角度域区间，提高了正畸弓丝成形控制点弯制顺序规划方法的合理性，有效避免了弯制机器人产生空程无效动作、弯制过程相互干涉动作和弯制运动复杂动作，充分发挥弯制机器人优势的最大化，明显提高了弯制效率。

5、同本发明人同日申报的发明专利《一种基于弯制点角距比和的正畸弓丝变角度划分方法》相比，虽然两方法都适用于具有特殊属性的一类个性化正畸弓丝曲线，但对于《一种基于弯制点角距比和的正畸弓丝变角度划分方法》中提及的方法所侧重的前提是每个弯制点的单位弯制点密度都满足设定要求，进而仅以变角度域弯制点角距比和

作为划分变角度域的依据，本方法所侧重的前提是弯制点的单位角距比满足设定要求，进而仅以变角度域弯制点密度

作为划分变角度域的依据，两种方法在进行正畸弓丝弯制顺序规划时应用情况不同，因此本方法的提出与另种方法互相补偿，进而完善了正畸弓丝弯制顺序规划的系列方法。

附图说明

为了易于说明，本发明由下述的具体实施及附图作以详细描述。

图1为一种基于弯制点密度的正畸弓丝变角度划分方法的流程图；

图2为变角度域弯制点密度计算示意图；

图3为基于弯制点密度变角度划分个性化正畸弓丝曲线示意图；

图4为个性化正畸弓丝成形控制点分布示意图；

图5为变角度划分个性化正畸弓丝曲线完成后规划弯制点弯制顺序示意图；

具体实施方式

为使本发明专利的目的、技术方案和优点更加清楚明了，下面通过附图中示出的具体实施例来描述本发明专利，但是应该理解，这些描述只是示例性的，而并非要限制本发明专利的范围，此外，在以下说明中，省略了对公知结构和技术的描述，以避免不必要地混淆本发明专利的概念。

实施例1：如图1、图2、图3、图4、图5所示，本具体实施方式采用以下技术方案：一种基于弯制点密度的正畸弓丝变角度划分方法，所述方法的具体实现过程为：

步骤一、变角度域划分数据导入：

根据患者有i个成形控制点的个性化正畸弓丝曲线，输入个性化正畸弓丝曲线成形控制点信息集M＝{m₁，m₂，m₃，...，m_i}，m_i＝(u_i，v_i，w_i)'为每个个性化正畸弓丝曲线成形控制点的坐标，每一个正畸弓丝曲线成形控制点m_i均对应一个成形控制点机器人运动信息单元n_i，输入的成形控制点的机器人运动信息集为N＝{n₁，n₂，n₃，...，n_i}，n_i表示机器人在弯制该点时的成形控制点坐标及弯制角度，n_i＝(u_i，v_i，w_i，α_i)'，u_i、v_i、w_i为该成形控制点m_i的坐标，α_i为机器人作用在成形控制点m_i上的弯制角度，将正畸弓丝曲线成形控制点信息集M、成形控制点的机器人运动信息集N，单位角距比上限值E_max输入到正畸弓丝弯制系统中，并且根据机器人弯制正畸弓丝的特点设定变角度域弯制点密度阀值ρ_max；

个性化正畸弓丝曲线两端点坐标为m_s(u_s，v_s，w_s)，m_e(u_e，v_e，w_e)，将弓丝曲线左端点m_s设定为成形控制点m₀，将弓丝曲线右端点m_e设定为成形控制点m_i+1，以弓丝曲线左右端点的中点

定义为圆心O，将成形控制点m_k作为划分变角度域的起点，k的初始值为k＝0，0≤k≤i，成形控制点m_k与圆心O之间的连线定义为划分半径R_k；

步骤二、正畸弓丝曲线坐标转换及划分变量定义：

将个性化正畸弓丝成形控制点信息集中各成形控制点的坐标m_i＝(u_i,v_i,w_i)'中的w_i赋值为0，即令w_i＝0，获得正畸弓丝转换曲线M′；

针对变角度划分方法而言，定义变角度域b_k的弯制点密度

其中

表示在变角度域b_k内划分的弯制点个数，

的初始值为

表示变角度域b_k内划分半径R_k与划分半径

之间形成的角度值，

为在变角度域b_k内最大的划分半径，初始化

个性化正畸弓丝上任意一弯制点m_x的单位角距比

为弯制点m_x的弯制角度α_x与其弯制距离

的比值，即

其中

表示弯制点m_x与弯制点m_x+1之间的弧长，1≤x≤i，计算个性化正畸弓丝上各弯制点的单位角距比

当各弯制点的单位角距比

均小于单位角距比上限值E_max时，跳转至步骤三；

步骤三、寻找变角度域内的最大半径

R_k+j表示从成形控制点m_k到成形控制点

之间的第j个成形控制点对应的划分半径值，j的初始值为j＝1，

a)判断

是否成立；

如果

成立，判断

是否成立；

如果

成立，则将R_k+j的值赋予

即

j＝j+1，返回步骤三a；

如果

不成立，

的值保持不变，即

j＝j+1，返回步骤三a；

b)如果

不成立，跳转至步骤四；

步骤四、计算变角度域弯制点密度：

与R_k之间的角度记为

利用公式

计算变角度域b_k的弯制点密度；

判断

是否成立；

如果

成立，说明已划分至弓丝曲线的右端点，将弯制点m_k和弯制点

之间的变角度域定义为变角度域区间b_k，变角度域区间b_k的弯制点密度为

跳转至步骤五，统计已划分的弯制点数目q；

如果

不成立，说明未划分至弓丝曲线的右端点，并且判断

是否成立；

如果

成立，则可以继续增加该变角度域内弯制点的个数，即令

跳转至步骤三；

如果

不成立，说明该变角度域内不能再增加弯制点，跳转至步骤五；

步骤五、定义变角度域区间：

将弯制点m_k和弯制点

之间的变角度域定义为变角度域区间b_k，并且变角度域区间b_k内从弯制点m_k到弯制点

包括弯制点

但是不包括弯制点m_k的所有弯制点已划分，统计已划分的弯制点数目q，变角度域区间b_k的弯制点密度为

跳转至步骤六；

步骤六、判断是否继续进行变角度域划分：

判断q＝i是否成立；

如果q＝i不成立，则继续进行变角度域划分，由于当前弯制点不符合弯制要求，故从当前弯制点的上一个弯制点继续开始变角度划分，即以

为划分变角度域的起点，令

跳转至步骤一；

如果q＝i成立，说明所有的弯制点均已被划分，跳转至步骤七；

步骤七、获得最终弯制点弯制顺序：

输出变角度域区间信息集B＝{b₁，b₂，...，b_g}，每个变角度域区间(b₁，b₂，...，b_g)所对应的角度值分别为(θ₁，θ₂，...，θ_g)，并且θ₁+θ₂+...+θ_g＝π，比较每个变角度域区间(b₁，b₂，...，b_g)的弯制点密度

得到

则以弯制点密度

为指标将g个变角度域区间降序排列，得到降序变角度域区间信息集C＝{c₂，c₄，...，c_g}，在任何一个变角度域区间内，以各弯制点的单位角距比

为指标对弯制点进行降序排列，将弯制点角距比降序排列顺序定义为该变角度域区间内的弯制点弯制顺序，得到个性化正畸弓丝曲线成形控制点坐标降序矩阵M₁{m₄，m₆，...，m_s}和机器人运动降序信息集N₁{n₄，n₆，...，n_s}，其中m_s表示变角度域区间b_g中的弯制点，输出最终弯制点弯制顺序M₁{m₄，m₆，...，m_s}、N₁{n₄，n₆，...，n_s}，程序结束。

实施例2：如图2、图3、图4、图5所示，在一条包含i＝22个弯制点(正畸弓丝的左右端点不参与弓丝弯制)的个性化正畸弓丝曲线进行基于弯制点密度变角度划分的弯制顺序规划过程中，假设最终得到的弯制变角度域区间的个数为n＝8，根据在步骤七中变角度域区间信息集B＝{b₁，b₂，...，b_g}，得到各变角度域区间的弯制点个数为

每个弯制变角度域区间(b₁，b₂，...，b_g)的弯制点密度为

比较各变角度域区间的弯制点密度，存在

以各变角度域区间的弯制点密度

为指标将8个变角度域区间降序排列，从而得到降序变角度域区间信息集为C₁＝{c₇，c₅，c₃，c₄，c₁，c₈，c₂，c₆}，规定在任何一个变角度域区间内，以各弯制点的单位角距比

为指标对弯制点进行降序排列，将弯制点单位角距比降序排列顺序定义为该变角度域区间内的弯制点弯制顺序，则各变角度域区间的弯制点顺序为b₇＝(m₁₇，m₁₆，m₁₈)，b₅＝(m₁₁，m₁₂)，b₃＝(m₆，m₇)，b₄＝(m₉，m₈，m₁₀)，b₁＝(m₁，m₃，m₄，m₂)，b₈＝(m₂₀，m₁₉，m₂₂，m₂₁)，b₂＝(m₅)，b₆＝(m₁₄，m₁₃，m₁₅)，结合变角度域区间排列顺序，进而得到正畸弓丝曲线成形控制点坐标矩阵M₁＝{m₁₇，m₁₆，m₁₈，m₁₁，m₁₂，m₆，m₇，m₉，m₈，m₁₀，m₁，m₃，m₄，m₂，m₂₀，m₁₉，m₂₂，m₂₁，m₅，m₁₄，m₁₃，m₁₅}和机器人弯制信息集N₁＝{n₁₇，n₁₆，n₁₈，n₁₁，n₁₂，n₆，n₇，n₉，n₈，n₁₀，n₁，n₃，n₄，n₂，n₂₀，n₁₉，n₂₂，n₂₁，n₅，n₁₄，n₁₃，n₁₅}，输出最终弯制点弯制顺序M₁＝{m₁₇，m₁₆，m₁₈，m₁₁，m₁₂，m₆，m₇，m₉，m₈，m₁₀，m₁，m₃，m₄，m₂，m₂₀，m₁₉，m₂₂，m₂₁，m₅，m₁₄，m₁₃，m₁₅}、N₁＝{n₁₇，n₁₆，n₁₈，n₁₁，n₁₂，n₆，n₇，n₉，n₈，n₁₀，n₁，n₃，n₄，n₂，n₂₀，n₁₉，n₂₂，n₂₁，n₅，n₁₄，n₁₃，n₁₅}程序结束。

Claims (1)

1.一种基于弯制点密度的正畸弓丝变角度划分方法，其特征在于：所述方法的具体实现过程为：

步骤一、变角度域划分数据导入：

根据患者有i个成形控制点的个性化正畸弓丝曲线，输入个性化正畸弓丝曲线成形控制点信息集M＝{m₁，m₂，m₃，...，m_i}，m_i＝(u_i，v_i，w_i)'为每个个性化正畸弓丝曲线成形控制点的坐标，每一个正畸弓丝曲线成形控制点m_i均对应一个成形控制点机器人运动信息单元n_i，输入的成形控制点的机器人运动信息集为N＝{n₁，n₂，n₃，...，n_i}，n_i表示机器人在弯制该点时的成形控制点坐标及弯制角度，n_i＝(u_i，v_i，w_i，α_i)'，u_i、v_i、w_i为该成形控制点m_i的坐标，α_i为机器人作用在成形控制点m_i上的弯制角度，将正畸弓丝曲线成形控制点信息集M、成形控制点的机器人运动信息集N，单位角距比上限值E_max输入到正畸弓丝弯制系统中，并且根据机器人弯制正畸弓丝的特点设定变角度域弯制点密度阀值ρ_max；

个性化正畸弓丝曲线两端点坐标为m_s(u_s，v_s，w_s)，m_e(u_e，v_e，w_e)，将弓丝曲线左端点m_s设定为成形控制点m₀，将弓丝曲线右端点m_e设定为成形控制点m_i+1，以弓丝曲线左右端点的中点

定义为圆心O，将成形控制点m_k作为划分变角度域的起点，k的初始值为k＝0，0≤k≤i，成形控制点m_k与圆心O之间的连线定义为划分半径R_k；

步骤二、正畸弓丝曲线坐标转换及划分变量定义：

将个性化正畸弓丝成形控制点信息集中各成形控制点的坐标m_i＝(u_i,v_i,w_i)'中的w_i赋值为0，即令w_i＝0，获得正畸弓丝转换曲线M′；

针对变角度划分方法而言，定义变角度域b_k的弯制点密度

其中

表示在变角度域b_k内划分的弯制点个数，

的初始值为

表示变角度域b_k内划分半径R_k与划分半径

之间形成的角度值，

为在变角度域b_k内最大的划分半径，初始化

个性化正畸弓丝上任意一弯制点m_x的单位角距比

为弯制点m_x的弯制角度α_x与其弯制距离

的比值，即

其中

表示弯制点m_x与弯制点m_x+1之间的弧长，1≤x≤i，计算个性化正畸弓丝上各弯制点的单位角距比

当各弯制点的单位角距比

均小于单位角距比上限值E_max时，跳转至步骤三；

步骤三、寻找变角度域内的最大半径

R_k+j表示从成形控制点m_k到成形控制点

之间的第j个成形控制点对应的划分半径值，j的初始值为j＝1，

a)判断

是否成立；

如果

成立，判断

是否成立；

如果

成立，则将R_k+j的值赋予

即

j＝j+1，返回步骤三a；

如果

不成立，

的值保持不变，即

j＝j+1，返回步骤三a；

b)如果

不成立，跳转至步骤四；

步骤四、计算变角度域弯制点密度：

与R_k之间的角度记为

利用公式

计算变角度域b_k的弯制点密度；

判断

是否成立；

如果

成立，说明已划分至弓丝曲线的右端点，将弯制点m_k和弯制点

之间的变角度域定义为变角度域区间b_k，变角度域区间b_k的弯制点密度为

跳转至步骤五，统计已划分的弯制点数目q；

如果

不成立，说明未划分至弓丝曲线的右端点，并且判断

是否成立；

如果

成立，则可以继续增加该变角度域内弯制点的个数，即令

跳转至步骤三；

如果

不成立，说明该变角度域内不能再增加弯制点，跳转至步骤五；

步骤五、定义变角度域区间：

将弯制点m_k和弯制点

之间的变角度域定义为变角度域区间b_k，并且变角度域区间b_k内从弯制点m_k到弯制点

包括弯制点

但是不包括弯制点m_k的所有弯制点已划分，统计已划分的弯制点数目q，变角度域区间b_k的弯制点密度为

跳转至步骤六；

步骤六、判断是否继续进行变角度域划分：

判断q＝i是否成立；

如果q＝i不成立，则继续进行变角度域划分，由于当前弯制点不符合弯制要求，故从当前弯制点的上一个弯制点继续开始变角度划分，即以

为划分变角度域的起点，令

跳转至步骤二；

如果q＝i成立，说明所有的弯制点均已被划分，跳转至步骤七；

步骤七、获得最终弯制点弯制顺序：

输出变角度域区间信息集B＝{b₁，b₂，...，b_g}，每个变角度域区间(b₁，b₂，...，b_g)所对应的角度值分别为(θ₁，θ₂，...，θ_g)，并且θ₁+θ₂+...+θ_g＝π，比较每个变角度域区间(b₁，b₂，...，b_g)的弯制点密度

得到

则以弯制点密度

为指标将g个变角度域区间降序排列，得到降序变角度域区间信息集C＝{c₂，c₄，...，c_g}，在任何一个变角度域区间内，以各弯制点的单位角距比

为指标对弯制点进行降序排列，将弯制点角距比降序排列顺序定义为该变角度域区间内的弯制点弯制顺序，进而得到个性化正畸弓丝曲线成形控制点坐标降序矩阵M₁{m₄，m₆，...，m_s}和机器人运动降序信息集N₁{n₄，n₆，...，n_s}，其中m_s表示变角度域区间b_g中的弯制点，输出最终弯制点弯制顺序M₁{m₄，m₆，...，m_s}、N₁{n₄，n₆，...，n_s}，程序结束。

Images