差速无人船的路径优化方法、装置及计算机可读存储介质制造方法及图纸

本发明专利技术公开了一种差速无人船的路径优化方法、装置及计算机可读存储介质，首先求得初始路径上的每相邻两路径片段之间的夹角差值，而后从初始路径上的第一路径点开始依次执行对应的操作，以使得在相邻的两路径片段之间的夹角差值在预设差值以上时，可在前一路径片段的长度大于预设长度值时在前一路径片段的设定位置插入第一插入点，在后一路径片段的长度大于预设长度值时在后一路径片段的设定位置插入第二插入点，而且第一插入点和第二插入点的速度取该路径点的速度或者在该路径点的速度超出最大限制速度时取最大限制速度；从而便于优化出适合差速无人船转弯的路径。

Path optimization method, device and computer readable storage medium of differential unmanned vessel

【技术实现步骤摘要】
差速无人船的路径优化方法、装置及计算机可读存储介质
本专利技术涉及路径优化
，尤其涉及一种差速无人船的路径优化方法、装置及计算机可读存储介质。
技术介绍
目前，在工业无人车
，工业无人车能够根据系统规划的路径进行移动，工业无人车在转弯时走折线。不过，在应用至差速无人船时，由于差速无人船在转弯时无法走折线，只能走曲线，从而使得通过类似为工业无人车规划的路径并不能适用于差速无人船。纵然，可以对该路径进行曲线优化，但是优化后的有些转弯处的曲线会出现不够平滑的情况，并不能保证无人船能够顺利的由该转弯处通过，特别是当转弯处的速度较快的情况下。因此，有必须提供一种差速无人船的路径优化方法，便于优化出适合差速无人船转弯的路径。
技术实现思路
本专利技术的目的在于提供一种差速无人船的路径优化方法、装置及计算机可读存储介质，便于优化出适合差速无人船转弯的路径。为实现上述目的，本专利技术提供一种差速无人船的路径优化方法，其特征在于，包括如下步骤：a.求得生成的初始路径上的每相邻两路径片段之间的夹角差值；b.对所述初始路径上的第一路径点执行如下操作：如果所述初始路径上的第一路径片段与第二路径片段之间的夹角差值在预设差值以下，则执行步骤c；如果所述第一路径片段与所述第二路径片段之间的夹角差值在所述预设差值以上，且如果所述第一路径片段的长度大于预设长度值，则在所述第一路径片段上距离所述第一路径点预设长度值的位置插入第一插入点，其中所述预设长度值不小于无人船的物理最小转弯半径，如果所述第一路径点的速度大于预设的最大限制速度，则所述第一插入点的速度取所述最大限制速度，否则，所述第一插入点的速度取所述第一路径点的速度；如果第二路径片段的长度大于所述预设长度值，则在所述第二路径片段上距离所述第一路径点预设长度值的位置插入第二插入点；如果所述第一路径点的速度大于所述最大限制速度，则所述第二插入点的速度取所述最大限制速度，否则，所述第二插入点的速度取所述第一路径点的速度；c.对所述初始路径上的第二路径点执行步骤b的操作。较佳地，步骤b还包括：如果所述第一路径点的速度大于所述最大限制速度且所述第一路径片段的长度大于最小设定距离时，则在所述第一路径片段上距离所述第一路径点所述最小设定距离的位置插入第三插入点，所述第三插入点的速度取所述最大限制速度，其中所述最小设定距离为所述路径点的速度超过对应的速度阈值时的产生的设定值，所述最小设定距离大于所述预设长度值，所述速度阈值不大于所述最大限制速度。较佳地，步骤b还包括：如果所述第一路径点的速度大于速度阈值时，且所述第二路径片段大于预设距离时，则在所述第二路径片段上距离所述第一路径点所述预设距离的位置插入第四插入点，所述第四插入点的速度取所述最大限制速度，其中所述预设距离大于所述预设长度值。较佳地，当所述第一路径片段与所述第二路径片段之间的夹角差值在所述预设差值以上，其被划分为至少两个角度范围，包含更大角度值的所述角度范围对应设置更大的所述最大限制速度。较佳地，还包括位于所述速度阈值之上的至少一距离切换阈值以根据所述路径点的不同速度区间产生不同的所述最小设定距离。较佳地，当所述初始路径上的对应的路径点依次执行完步骤b的操作后，对完成初步优化的初步优化路径进行曲线优化以得到符合无人船转弯特性的轨迹。较佳地，所述“进行曲线优化”具体为：将所述初步优化路径上的所有路径点依次代入四阶贝塞尔曲线进行曲线优化。较佳地，所述预设长度值等于无人船的物理最小转弯半径值。为实现上述目的，本专利技术还提供一种差速无人船的路径优化装置，包括：一个或多个存储器；一个或多个处理器；及存储在所述存储器上并可在所述处理器上运行的计算机程序，其特征在于，所述处理器执行所述计算机程序时，实现如上所述的差速无人船的路径优化方法。为实现上述目的，本专利技术还提供一种计算机可读存储介质，其上存储有计算机程序，其特征在于，所述计算机程序被处理器执行时，实现如上所述的差速无人船的路径优化方法。与现有技术相比，本专利技术优化形成的初步优化路径能够在后续进行曲线优化后，首先能够保证当对应的夹角差值超过一定值时，每一个转弯处的弧线的半径都至少大于无人船物理最小转弯半径，进而确保在速度不是很快的情况下，无人船可以顺利进行转弯；而且，通过将插入点的速度限制为最大限制速度，进一步提升无人船的顺利转弯程度。附图说明图1为本专利技术实施例中的初始路径的部分片段的示意图。图2为本专利技术实施例中的初步优化路径的部分片段的示意图。图3为本专利技术实施例差速无人船的路径优化方法的流程图。图4为本专利技术实施例差速无人船的路径优化装置的示意框图。具体实施方式为了详细说明本专利技术的
技术实现思路
、构造特征，以下结合实施方式并配合附图作进一步说明。实施例一请参阅图1至图3，本专利技术公开了一种差速无人船的路径优化方法，包括如下步骤：a.求得生成的初始路径上的每相邻两路径片段之间的夹角差值；b.对初始路径上的第一路径点B执行如下操作：如果初始路径上的第一路径片段AB与第二路径片段BC之间的夹角差值Δδab在预设差值以下，则执行步骤c；具体而言，第一路径片段AB为第零路径点A与第一路径点B之间的直线段，第二路径片段BC为第一路径点B与第二路径点C之间的直线段；如果第一路径片段AB与第二路径片段BC之间的夹角差值Δδab在预设差值以上，且如果第一路径片段AB的长度大于预设长度值L，则在第一路径片段AB上距离第一路径点B预设长度值L的位置插入第一插入点b，其中预设长度值L不小于无人船的物理最小转弯半径R，如果第一路径点B的速度Sb大于预设的最大限制速度Smax，则第一插入点b的速度取最大限制速度Smax，否则，第一插入点b的速度取第一路径点B的速度Sb；如果第二路径片段BC的长度大于预设长度值L，则在第二路径片段BC上距离第一路径点B预设长度值L的位置插入第二插入点c；如果第一路径点B的速度Sb大于最大限制速度Smax，则第二插入点c的速度取最大限制速度Smax，否则，第二插入点c的速度取第一路径点B的速度Sb；c.对初始路径上的第二路径点C执行步骤b的操作；即：如果第三路径片段(图未示)与第二路径片段BC之间的夹角差值在预设差值以下，则执行步骤c(对初始路径上的第三路径点执行步骤b的操作)；如果第三路径片段与第二路径片段BC之间的夹角差值在预设差值以上，且如果第二路径片段BC的长度大于预设长度值L，则在第二路径片段上距离第二路径点C预设长度值L的位置插入第一插入点，其中预设长度值L不小于无人船的物理最小转弯半径R；如果第二路径点C的速度大于预设的最大限制速度Smax，则第一插入点的速度取最大限制速度Smax，否则，第一插入点的速度取第二路径点C的速度；如果第三路径片段的长度大于预设长度值L，则在第三路径片段上距离第二路径点C预设长度值L的位置插入第二插入点；如果第二路径点C的速度大于最大限制速度Smax，则第二插入点的速度取最大限制速度Smax，否则，第二插入点的速度取第二路径点C的速度。按照上述方式，依次对初始路径上的第三点、第四点……第N点进行相应的操作，以完成对初始路径的初步优化。通过上述操作，使得在后续进行曲线优化后，首先能够保证当对应的夹角差值超过一定值时，每一个转弯处的弧线的半径都至少大于无人船物本文档来自技高网...

【技术保护点】
1.一种差速无人船的路径优化方法，其特征在于，包括如下步骤：a.求得生成的初始路径上的每相邻两路径片段之间的夹角差值；b.对所述初始路径上的第一路径点执行如下操作：如果所述初始路径上的第一路径片段与第二路径片段之间的夹角差值在预设差值以下，则执行步骤c；如果所述第一路径片段与所述第二路径片段之间的夹角差值在所述预设差值以上，且如果所述第一路径片段的长度大于预设长度值，则在所述第一路径片段上距离所述第一路径点预设长度值的位置插入第一插入点，其中所述预设长度值不小于无人船的物理最小转弯半径，如果所述第一路径点的速度大于预设的最大限制速度，则所述第一插入点的速度取所述最大限制速度，否则，所述第一插入点的速度取所述第一路径点的速度；如果第二路径片段的长度大于所述预设长度值，则在所述第二路径片段上距离所述第一路径点预设长度值的位置插入第二插入点；如果所述第一路径点的速度大于所述最大限制速度，则所述第二插入点的速度取所述最大限制速度，否则，所述第二插入点的速度取所述第一路径点的速度；c.对所述初始路径上的第二路径点执行步骤b的操作。

【技术特征摘要】
1.一种差速无人船的路径优化方法，其特征在于，包括如下步骤：a.求得生成的初始路径上的每相邻两路径片段之间的夹角差值；b.对所述初始路径上的第一路径点执行如下操作：如果所述初始路径上的第一路径片段与第二路径片段之间的夹角差值在预设差值以下，则执行步骤c；如果所述第一路径片段与所述第二路径片段之间的夹角差值在所述预设差值以上，且如果所述第一路径片段的长度大于预设长度值，则在所述第一路径片段上距离所述第一路径点预设长度值的位置插入第一插入点，其中所述预设长度值不小于无人船的物理最小转弯半径，如果所述第一路径点的速度大于预设的最大限制速度，则所述第一插入点的速度取所述最大限制速度，否则，所述第一插入点的速度取所述第一路径点的速度；如果第二路径片段的长度大于所述预设长度值，则在所述第二路径片段上距离所述第一路径点预设长度值的位置插入第二插入点；如果所述第一路径点的速度大于所述最大限制速度，则所述第二插入点的速度取所述最大限制速度，否则，所述第二插入点的速度取所述第一路径点的速度；c.对所述初始路径上的第二路径点执行步骤b的操作。2.如权利要求1所述的差速无人船的路径优化方法，其特征在于，步骤b还包括：如果所述第一路径点的速度大于所述最大限制速度且所述第一路径片段的长度大于最小设定距离时，则在所述第一路径片段上距离所述第一路径点所述最小设定距离的位置插入第三插入点，所述第三插入点的速度取所述最大限制速度，其中所述最小设定距离为所述路径点的速度超过对应的速度阈值时的产生的设定值，所述最小设定距离大于所述预设长度值，所述速度阈值不大于所述最大限制速度。3.如权利要求2所述的差速无人船的路径优化方法，其特征在于，步骤b还包括：如果所述第一路径点...

【专利技术属性】
技术研发人员：刘益华，
申请(专利权)人：深圳市哈威飞行科技有限公司，
类型：发明
国别省市：广东,44