CN113009884B - 无人设备的作业控制方法、装置、设备及存储介质 - Google Patents

无人设备的作业控制方法、装置、设备及存储介质 Download PDF

Info

Publication number
CN113009884B
CN113009884B CN201911319454.4A CN201911319454A CN113009884B CN 113009884 B CN113009884 B CN 113009884B CN 201911319454 A CN201911319454 A CN 201911319454A CN 113009884 B CN113009884 B CN 113009884B
Authority
CN
China
Prior art keywords
point
target
points
position information
segmentation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201911319454.4A
Other languages
English (en)
Other versions
CN113009884A (zh
Inventor
吴斌
刘登卫
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangzhou Xaircraft Technology Co Ltd
Original Assignee
Guangzhou Xaircraft Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Guangzhou Xaircraft Technology Co Ltd filed Critical Guangzhou Xaircraft Technology Co Ltd
Priority to CN201911319454.4A priority Critical patent/CN113009884B/zh
Publication of CN113009884A publication Critical patent/CN113009884A/zh
Application granted granted Critical
Publication of CN113009884B publication Critical patent/CN113009884B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/41Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path
    • G05B19/4103Digital interpolation
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/35Nc in input of data, input till input file format
    • G05B2219/35105Polyhedral machining, cutter moved between centroids of adjacent surface triangles

Landscapes

  • Engineering & Computer Science (AREA)
  • Computing Systems (AREA)
  • Theoretical Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

本发明实施例公开了一种无人设备的作业控制方法、装置、设备及存储介质。其中,方法包括:采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息;存储所述位置信息及作业信息至存储器;响应于重复执行与所述位置信息对应的运动轨迹的命令,从存储器中获取所述位置信息和作业信息,以控制所述无人设备按照所述位置信息进行重复运动,并在运动至所述原始运动轨迹点时,进行与所述作业信息匹配的作业动作。本发明实施例解决了现有技术的轨迹重复作业需要前期工作投入和人力投入的问题,实现了在无人设备完成第一次受控作业后,自主控制无人设备进行轨迹重复作业。

Description

无人设备的作业控制方法、装置、设备及存储介质
技术领域
本发明实施例涉及无人设备技术,尤其涉及一种无人设备的作业控制方法、装置、设备及存储介质。
背景技术
传统的无人设备作业有单次路径执行和手动遥控两种方式。单次路径执行是无人设备按已有的确定路径巡迹一次。手动遥控是直接用遥控器控制无人设备的行走路径。
单次路径执行适用于非重复性、轨迹包络面积广的作业场合,这种作业方式通常需要在作业前完成比较精准的测量工作来支持后续的轨迹规划,如植保作业。手动遥控的方式不需要精准的测量和规划,适用于作业半径小的场合,该对操作员的技术和身体素质都有要求,尤其是在需要重复作业的情况下。
在需要任意轨迹重复作业的场合,例如示教,重复巡查,目标点来回等,上述两种无人设备作业模式都存在着不足:通过单次路径执行的方式进行轨迹重复作业,需要前期工作投入;通过手动遥控的方式进行轨迹重复作业,需要人力投入。
发明内容
本发明实施例提供一种无人设备的作业控制方法、装置、设备及存储介质,以解决现有技术的轨迹重复作业需要前期工作投入和人力投入的问题,实现在无人设备完成第一次受控作业后,自主控制无人设备进行轨迹重复作业。
第一方面,本发明实施例提供了一种无人设备的作业控制方法,包括:
采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息;
存储位置信息及作业信息至存储器;
响应于重复执行与位置信息对应的运动轨迹的命令,从存储器中获取位置信息和作业信息,以控制无人设备按照位置信息进行重复运动,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作。
可选的,在存储位置信息及作业信息至存储器之前,还包括:
根据多个原始运动轨迹点的位置信息,确定多条参考线段,并根据多条参考线段,确定多个新轨迹点的位置信息;
存储位置信息及作业信息至存储器,包括:
存储原始运动轨迹点的位置信息和作业信息,以及新轨迹点的位置信息至存储器。
可选的,采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息,包括:
按照预设的采集间隔,确定多个采集时间点;
在无人设备的受控作业过程中,在各采集时间点下,获取无人设备所在的位置点作为原始运动轨迹点,并获取各原始运动轨迹点的位置信息和作业信息。
可选的,根据多个原始运动轨迹点的位置信息,确定多条参考线段,并根据多条参考线段,确定多个新轨迹点的位置信息,包括:
按照采集时间从远到近的顺序,生成与各原始运动轨迹点对应的数据序列;
根据数据序列,确定多个分段点;
根据多个分段点生成多条参考线段,并按照第一间隔距离,在各参考线段上确定多个参考点;
根据各参考点,确定多个新的轨迹点的位置信息。
可选的,根据数据序列,确定多个分段点,包括:
在数据序列中,获取当前处理的目标分段点,目标分段点的初始值为数据序列中的首个数据点;
在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点,并在获取到满足分段条件的目标备选分段点时,将目标备选分段点作为新的目标分段点;
返回执行在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点的操作,直至满足结束分段条件。
可选的,在根据数据序列,确定多个分段点之前,还包括:
按照第二间隔距离,对数据序列进行插值运算,并在数据序列中插入多个插值轨迹点的位置信息。
可选的,按照第二间隔距离,对数据序列进行插值运算,并在数据序列中插入多个插值轨迹点的位置信息,包括:
按照预设的插值函数,依次获取数据序列中的目标数量的原始运动轨迹点构成多个轨迹点集合,插值函数以位置信息中的第一位置分量为自变量,第二位置分量为因变量;
按照第二间隔距离以及插值函数,计算与各轨迹点集合分别对应的插值轨迹点的位置信息;
将各插值轨迹点的位置信息按照插入位置,加入至数据序列中。
可选的,按照预设的插值函数,依次获取数据序列中的目标数量的原始运动轨迹点构成多个轨迹点集合,包括:
根据插值函数中包括的待确定常量的个数,确定目标数量;
依次获取数据序列中的目标数量的原始运动轨迹点构成多个轨迹点集合。
可选的,按照第二间隔距离以及插值函数,计算与各轨迹点集合分别对应的插值轨迹点的位置信息,包括:
获取当前处理的目标轨迹点集合,并获取与目标轨迹点集合中各目标轨迹点的位置信息;
根据各目标轨迹点的第一位置分量信息和第二位置分量信息,计算插值函数中各待确定常量的位置描述常量值,以得到位置插值函数;
根据与目标轨迹点集合对应的起始位置信息以及终止位置信息,以及第二间隔距离,计算得到与各插值轨迹点对应的插值位置分量;
根据各插值位置分量以及位置插值函数,得到与各插值轨迹点对应的位置信息。
可选的,在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点,包括:
获取目标分段点之后的第一相邻点,并判断第一相邻点是否为原始运动轨迹点;
若否,则获取第一相邻点之后的第二相邻点,并判断第二相邻点是否为原始运动轨迹点;
若否,则建立目标分段点与第一相邻点之间的第一连线,以及目标分段点与第二相邻点之间的第二连线;
根据第一连线与第二连线得到基础比对夹角;
如果基础比对夹角满足角度阈值条件,则将第二相邻点确定为目标备选分段点;
如果基础比对夹角不满足角度阈值条件,则继续遍历第二相邻点的后一轨迹点作为新的第二相邻点后,返回执行判断第二相邻点是否为原始运动轨迹点的操作。
可选的,在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点,包括:
获取目标分段点的后一相邻点作为比较点,并判断比较点是否为原始运动轨迹点;
若否,则计算目标分段点与比较点之间的连线长度;
如果连线长度满足长度阈值条件,则将比较点确定为目标备选分段点;
如果连线长度不满足长度阈值条件,则获取比较点的后一相邻点作为新的比较点,并返回执行判断比较点是否为原始运动轨迹点的操作。
可选的,根据多个分段点生成多条参考线段,并按照第一间隔距离,在各参考线段上确定多个参考点,包括:
顺序建立两两相邻分段点之间的连线作为参考线段;
根据各参考线段的起终点,计算与各参考线段对应的线段长度;
按照与线段长度匹配的第一间隔距离,在各参考线段上确定多个参考点,参考点中包括各参考线段的起终点。
可选的,根据各参考点,确定多个新的轨迹点的位置信息,包括:
根据数据序列,获取与各参考线段分别对应的局部数据序列,构成多个线段数据对;
确定各线段数据对中参考线段与局部数据序列之间的近似程度;
如果当前处理的目标线段数据对的近似程度满足预设的近似条件,则确定使用目标线段数据对中参考线段上的各目标参考点作为新的轨迹点;
如果当前处理的目标线段曲线对的近似程度不满足近似条件,则在目标线段数据对中与目标局部数据序列对应的曲线上,获取与各目标参考点对应的目标曲线点作为新的轨迹点。
可选的,确定各线段数据对中参考线段与局部数据序列之间的近似程度,包括:
以当前处理的目标线段数据对中的目标参考线段的线段起点为原点,以目标参考线段所在的直线为X轴,建立坐标系;
将数据序列中,与目标线段数据对中目标局部数据序列映射至坐标系中,得到映射序列;
根据原点以及映射序列中原点的后一映射点,建立目标射线;
计算目标参考线段的终点到目标射线的距离值,作为目标线段数据对中目标参考线段与目标局部数据序列之间的近似程度。
可选的,在目标线段数据对中与目标局部数据序列对应的曲线上,获取与各目标参考点对应的目标曲线点作为新的轨迹点,包括:
使用各目标参考点,对映射序列中的各映射点进行插值运算,得到各目标曲线点。
第二方面,本发明实施例还提供了一种无人设备的作业控制装置,包括:
信息采集模块,用于采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息;
信息存储模块,用于存储位置信息及作业信息至存储器;
作业控制模块,用于响应于重复执行与位置信息对应的运动轨迹的命令,从存储器中获取位置信息和作业信息,以控制无人设备按照位置信息进行重复运动,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作。
第三方面,本发明实施例还提供了一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现如本发明实施例所述的无人设备的作业控制方法。
第四方面,本发明实施例还提供了一种计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现如本发明实施例所述的无人设备的作业控制方法。
本发明实施例的技术方案,通过采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息,并存储位置信息及作业信息至存储器,然后响应于重复执行与位置信息对应的运动轨迹的命令,从存储器中获取位置信息和作业信息,以控制无人设备按照位置信息进行重复运动,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作,解决了现有技术的轨迹重复作业需要前期工作投入和人力投入的问题,可以通过采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息进行存储,对无人设备在受控作业过程中的运动轨迹进行保存,可以根据存储的位置信息和作业信息,控制无人设备重复受控作业过程的运动轨迹和作业动作,从而实现了在无人设备完成第一次受控作业后,自主控制无人设备进行轨迹重复作业。
附图说明
图1为本发明实施例一提供的一种无人设备的作业控制方法的流程图;
图2为本发明实施例二提供的一种无人设备的作业控制方法的流程图;
图3a为本发明实施例三提供的一种无人设备的作业控制方法的流程图;
图3b为本发明实施例三提供的一种轨迹点坐标系的示意图;
图3c为本发明实施例三提供的一种轨迹点坐标系的示意图;
图3d为本发明实施例三提供的一种轨迹点坐标系的示意图;
图4为本发明实施例四提供的一种无人设备的作业控制装置的结构示意图;
图5为本发明实施例五提供的一种计算机设备的结构示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。
另外还需要说明的是,为了便于描述,附图中仅示出了与本发明相关的部分而非全部内容。在更加详细地讨论示例性实施例之前应当提到的是,一些示例性实施例被描述成作为流程图描绘的处理或方法。虽然流程图将各项操作(或步骤)描述成顺序的处理,但是其中的许多操作可以被并行地、并发地或者同时实施。此外,各项操作的顺序可以被重新安排。当其操作完成时所述处理可以被终止,但是还可以具有未包括在附图中的附加步骤。所述处理可以对应于方法、函数、规程、子例程、子程序等等。
实施例一
图1为本发明实施例一提供的一种无人设备的作业控制方法的流程图,本发明实施例可适用于对无人设备进行作业控制的情况,该方法可以由本发明实施例提供的无人设备的作业控制装置来执行,该装置可采用软件和/或硬件的方式实现,并一般可集成在无人设备中。如图1所示,本发明实施例的方法具体包括:
步骤101、采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息。
可选的,无人设备可以为无人车。
可选的,受控作业过程是用户手动操作控制无人设备按期望的轨迹作业的过程。原始运动轨迹点是无人设备在受控作业过程中的轨迹点。
可选的,原始运动轨迹点的位置信息为原始运动轨迹点的位置坐标。
可选的,用户手动操作控制无人设备按期望的轨迹进行水稻运输。作业信息可以包括:停留时间和感知信息。
示例性的,感知信息可以为通过无人设备承载装置上装配的压力传感器采集的压力感知数据。无人设备承载装置上装配有压力传感器。压力传感器用于感知压力。通过记录压力传感器采集的压力感知数据,对感知压力的过程予以记录。
示例性的,感知信息可以为通过无人设备承载装置上装配的雷达采集的货物感知数据。无人设备承载装置上装配有雷达。根据雷达采集的货物感知数据,可以感知无人设备承载装置上是否存在货物。
示例性的,感知信息可以为通过无人设备承载装置上装配的图像传感器采集的货物感知数据。无人设备承载装置上装配有图像传感器。根据图像传感器采集的货物感知数据,可以感知无人设备承载装置上是否存在货物。可选的,采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息,可以包括:获取按照预设的采集间隔,确定多个采集时间点;在无人设备的受控作业过程中,在各采集时间点下,获取无人设备所在的位置点作为原始运动轨迹点,并获取各原始运动轨迹点的位置信息和作业信息。
预设的采集间隔可以根据业务需求进行设置。
在一个具体实例中,预设的采集间隔为1分钟。在位置信息的采集过程开始后,每间隔1分钟即为1个采集时间点,在各采集时间点下,获取无人设备所在的位置点作为原始运动轨迹点,并获取各原始运动轨迹点的位置信息。
步骤102、存储位置信息及作业信息至存储器。
其中,将获取的无人设备在受控作业过程中的多个原始运动轨迹点的位置信息和作业信息,存储至存储器,从而对无人设备在受控作业过程中的运动轨迹和作业信息进行保存。
步骤103、响应于重复执行与位置信息对应的运动轨迹的命令,从存储器中获取位置信息和作业信息,以控制无人设备按照位置信息进行重复运动,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作。
可选的,在检测到重复执行与位置信息对应的运动轨迹的命令时,从存储器中获取位置信息和作业信息,控制无人设备运动至与位置信息对应的原始运动轨迹点,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作。
在一个具体实例中,作业信息包括:停留时间、喷头方向、喷头数量以及喷头喷量。在检测到重复执行与位置信息对应的运动轨迹的命令时,从存储器中获取位置信息和作业信息,控制无人设备运动至与位置信息对应的原始运动轨迹点,并在运动至原始运动轨迹点时,根据原始运动轨迹点的停留时间、喷头方向、喷头数量以及喷头喷量,进行与作业信息匹配的水稻运输作业动作。
由此,在检测到重复执行受控作业过程的运动轨迹的命令时,根据存储的无人设备在受控作业过程中的多个原始运动轨迹点的位置信息和作业信息,控制无人设备运动至受控作业过程中的各个原始运动轨迹点,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作,从而根据存储的位置信息和作业信息,控制无人设备重复受控作业过程的运动轨迹和作业动作。
可选的,在存储位置信息及作业信息至存储器之前,可以还包括:根据多个原始运动轨迹点的位置信息,确定多条参考线段,并根据多条参考线段,确定多个新轨迹点的位置信息;存储位置信息及作业信息至存储器,可以包括:存储原始运动轨迹点的位置信息和作业信息,以及新轨迹点的位置信息至存储器。
其中,根据原始运动轨迹点的位置信息,确定与运动轨迹对应的多个新轨迹点的位置信息,增加与运动轨迹对应的位置信息的数量,从而可以更精准地控制无人设备按照运动轨迹进行重复运动。
可选的,根据多个原始运动轨迹点的位置信息,确定多条参考线段,并根据多条参考线段,确定多个新轨迹点的位置信息,可以包括:按照采集时间从远到近的顺序,生成与各原始运动轨迹点对应的数据序列;根据数据序列,确定多个分段点;根据多个分段点生成多条参考线段,并按照第一间隔距离,在各参考线段上确定多个参考点;根据各参考点,确定多个新的轨迹点的位置信息。
可选的,在根据数据序列,确定多个分段点之前,可以还包括:按照第二间隔距离,对数据序列进行插值运算,并在数据序列中插入多个插值轨迹点的位置信息。
本发明实施例提供了一种无人设备的作业控制方法,通过采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息,并存储位置信息及作业信息至存储器,然后响应于重复执行与位置信息对应的运动轨迹的命令,从存储器中获取位置信息和作业信息,以控制无人设备按照位置信息进行重复运动,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作,解决了现有技术的轨迹重复作业需要前期工作投入和人力投入的问题,可以通过采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息进行存储,对无人设备在受控作业过程中的运动轨迹进行保存,可以根据存储的位置信息和作业信息,控制无人设备重复受控作业过程的运动轨迹和作业动作,从而实现了在无人设备完成第一次受控作业后,自主控制无人设备进行轨迹重复作业。
实施例二
图2为本发明实施例二提供的一种无人设备的作业控制方法的流程图。本发明实施例可以与上述一个或者多个实施例中各个可选方案结合,在本发明实施例中,在存储位置信息及作业信息至存储器之前,可以还包括:根据多个原始运动轨迹点的位置信息,确定多条参考线段,并根据多条参考线段,确定多个新轨迹点的位置信息;存储位置信息及作业信息至存储器,可以包括:存储原始运动轨迹点的位置信息和作业信息,以及新轨迹点的位置信息至存储器。
如图2所示,本发明实施例的方法具体包括:
步骤201、采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息。
步骤202、根据多个原始运动轨迹点的位置信息,确定多条参考线段,并根据多条参考线段,确定多个新轨迹点的位置信息。
可选的,根据多个原始运动轨迹点的位置信息,确定多条参考线段,并根据多条参考线段,确定多个新轨迹点的位置信息,可以包括:按照采集时间从远到近的顺序,生成与各原始运动轨迹点对应的数据序列;根据数据序列,确定多个分段点;根据多个分段点生成多条参考线段,并按照第一间隔距离,在各参考线段上确定多个参考点;根据各参考点,确定多个新的轨迹点的位置信息。
可选的,确定各原始运动轨迹点的采集时间,按照采集时间从远到近的顺序对各原始运动轨迹点进行排序,得到与各原始运动轨迹点对应的数据序列。
可选的,在根据数据序列,确定多个分段点之前,可以还包括:按照第二间隔距离,对数据序列进行插值运算,并在数据序列中插入多个插值轨迹点的位置信息。
可选的,根据数据序列,确定多个分段点,可以包括:在数据序列中,获取当前处理的目标分段点,目标分段点的初始值为数据序列中的首个数据点;在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点,并在获取到满足分段条件的目标备选分段点时,将目标备选分段点作为新的目标分段点;返回执行在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点的操作,直至满足结束分段条件。
可选的,在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点,可以包括:获取目标分段点之后的第一相邻点,并判断第一相邻点是否为原始运动轨迹点;若否,则获取第一相邻点之后的第二相邻点,并判断第二相邻点是否为原始运动轨迹点;若否,则建立目标分段点与第一相邻点之间的第一连线,以及目标分段点与第二相邻点之间的第二连线;根据第一连线与第二连线得到基础比对夹角;如果基础比对夹角满足角度阈值条件,则将第二相邻点确定为目标备选分段点;如果基础比对夹角不满足角度阈值条件,则继续遍历第二相邻点的后一轨迹点作为新的第二相邻点后,返回执行判断第二相邻点是否为原始运动轨迹点的操作。
可选的,在判断第一相邻点是否为原始运动轨迹点之后,可以还包括:若是,则继续遍历第一相邻点的后一轨迹点作为新的第一相邻点后,返回执行判断第一相邻点是否为原始运动轨迹点的操作。
可选的,在判断第二相邻点是否为原始运动轨迹点之后,可以还包括:若是,则继续遍历第二相邻点的后一轨迹点作为新的第二相邻点后,返回执行判断第二相邻点是否为原始运动轨迹点的操作。
可选的,在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点,包括:获取目标分段点的后一相邻点作为比较点,并判断比较点是否为原始运动轨迹点;若否,则计算目标分段点与比较点之间的连线长度;如果连线长度满足长度阈值条件,则将比较点确定为目标备选分段点;如果连线长度不满足长度阈值条件,则获取比较点的后一相邻点作为新的比较点,并返回执行判断比较点是否为原始运动轨迹点的操作。
可选的,在判断比较点是否为原始运动轨迹点之后,还包括:若是,则继续遍历比较点的后一轨迹点作为新的比较点后,返回执行判断比较点是否为原始运动轨迹点的操作。
可选的,结束分段条件为目标分段点为数据序列中的最后一个数据点。
可选的,结束分段条件为目标分段点之后的备选分段点都不满足目标备选分段点。
可选的,根据多个分段点生成多条参考线段,并按照第一间隔距离,在各参考线段上确定多个参考点,可以包括:顺序建立两两相邻分段点之间的连线作为参考线段;根据各参考线段的起终点,计算与各参考线段对应的线段长度;按照与线段长度匹配的第一间隔距离,在各参考线段上确定多个参考点,参考点中包括各参考线段的起终点。
可选的,根据各参考点,确定多个新的轨迹点的位置信息,可以包括:根据数据序列,获取与各参考线段分别对应的局部数据序列,构成多个线段数据对;确定各线段数据对中参考线段与局部数据序列之间的近似程度;如果当前处理的目标线段数据对的近似程度满足预设的近似条件,则确定使用目标线段数据对中参考线段上的各目标参考点作为新的轨迹点;如果当前处理的目标线段曲线对的近似程度不满足近似条件,则在目标线段数据对中与目标局部数据序列对应的曲线上,获取与各目标参考点对应的目标曲线点作为新的轨迹点。
步骤203、存储原始运动轨迹点的位置信息和作业信息,以及新轨迹点的位置信息至存储器。
其中,将获取的无人设备在受控运动过程中的多个原始运动轨迹点的位置信息和作业信息,以及根据多个原始运动轨迹点的位置信息确定的多个新轨迹点的位置信息一同存储至存储器,从而对无人设备在受控运动过程中的运动轨迹进行保存。
新轨迹点不与实际的原始运动轨迹点对应,只有位置信息,没有作业信息。
步骤204、响应于重复执行与位置信息对应的运动轨迹的命令,从存储器中获取位置信息和作业信息,以控制无人设备按照位置信息进行重复运动,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作。
本发明实施例提供了一种无人设备的作业控制方法,通过根据多个原始运动轨迹点的位置信息,确定多条参考线段,并根据多条参考线段,确定多个新轨迹点的位置信息,然后存储原始运动轨迹点以及新轨迹点的位置信息至存储器,可以在通过采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息之后,根据原始运动轨迹点的位置信息,确定与运动轨迹对应的多个新轨迹点的位置信息,增加与运动轨迹对应的位置信息的数量,从而可以更精准地控制无人设备按照运动轨迹进行重复运动。
实施例三
图3a为本发明实施例三提供的一种无人设备的作业控制方法的流程图。本发明实施例可以与上述一个或者多个实施例中各个可选方案结合,在本发明实施例中,根据多个原始运动轨迹点的位置信息,确定多条参考线段,并根据多条参考线段,确定多个新轨迹点的位置信息,可以包括:按照采集时间从远到近的顺序,生成与各原始运动轨迹点对应的数据序列;根据数据序列,确定多个分段点;根据多个分段点生成多条参考线段,并按照第一间隔距离,在各参考线段上确定多个参考点;根据各参考点,确定多个新的轨迹点的位置信息。
以及,在根据数据序列,确定多个分段点之前,可以还包括:按照第二间隔距离,对数据序列进行插值运算,并在数据序列中插入多个插值轨迹点的位置信息。
如图3a所示,本发明实施例的方法具体包括:
步骤301、采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息。
步骤302、按照采集时间从远到近的顺序,生成与各原始运动轨迹点对应的数据序列。
可选的,确定各原始运动轨迹点的采集时间,按照采集时间从远到近的顺序对各原始运动轨迹点进行排序,得到与各原始运动轨迹点对应的数据序列。
步骤303、按照第二间隔距离,对数据序列进行插值运算,并在数据序列中插入多个插值轨迹点的位置信息。
可选的,按照第二间隔距离,对数据序列进行插值运算,并在数据序列中插入多个插值轨迹点的位置信息,可以包括:按照预设的插值函数,依次获取数据序列中的目标数量的原始运动轨迹点构成多个轨迹点集合,插值函数以位置信息中的第一位置分量为自变量,第二位置分量为因变量;按照第二间隔距离以及插值函数,计算与各轨迹点集合分别对应的插值轨迹点的位置信息;将各插值轨迹点的位置信息按照插入位置,加入至数据序列中。
可选的,按照预设的插值函数,依次获取数据序列中的目标数量的原始运动轨迹点构成多个轨迹点集合,可以包括:根据插值函数中包括的待确定常量的个数,确定目标数量;依次获取数据序列中的目标数量的原始运动轨迹点构成多个轨迹点集合。
可选的,将各插值轨迹点的位置信息按照插入位置,加入至数据序列中,包括:根据与各插值轨迹点对应的插值位置分量,将各插值轨迹点的位置信息按照插入位置,加入至数据序列中。
在一个具体实例中,位置信息为位置坐标(x,y)。插值函数为y=ax+b。插值函数以位置信息中的第一位置分量x为自变量,第二位置分量y为因变量待确定常量为a和b。目标数量为2。依次获取数据序列中的2个原始运动轨迹点构成多个轨迹点集合。
在另一个具体实例中,位置信息为位置坐标(x,y)。插值函数为y=ax2+bx+c。插值函数以位置信息中的第一位置分量x为自变量,第二位置分量y为因变量待确定常量为a、b以及c。目标数量为3。依次获取数据序列中的3个原始运动轨迹点构成多个轨迹点集合。
可选的,按照第二间隔距离以及插值函数,计算与各轨迹点集合分别对应的插值轨迹点的位置信息,可以包括:获取当前处理的目标轨迹点集合,并获取与目标轨迹点集合中各目标轨迹点的位置信息;根据各目标轨迹点的第一位置分量信息和第二位置分量信息,计算插值函数中各待确定常量的位置描述常量值,以得到位置插值函数;根据与目标轨迹点集合对应的起始位置信息以及终止位置信息,以及第二间隔距离,计算得到与各插值轨迹点对应的插值位置分量;根据各插值位置分量以及位置插值函数,得到与各插值轨迹点对应的位置信息。
在一个具体实例中,获取当前处理的目标轨迹点集合。目标轨迹点集合中包括3个原始运动轨迹点。获取与目标轨迹点集合中各目标轨迹点的位置信息即各目标轨迹点的位置坐标(x,y)。根据各目标轨迹点的第一位置分量信息x和第二位置分量信息y,计算插值函数y=ax2+bx+c中各待确定常量的位置描述常量值。计算结果为:待确定常量a的位置描述常量值为2,待确定常量b的位置描述常量值为3,待确定常量c的位置描述常量值为1。得到位置插值函数y=2x2+3x+1。
第二间隔距离为1m。与目标轨迹点集合对应的起始位置信息为位置坐标(1,6)。与目标轨迹点集合对应的终止位置信息为位置坐标(5,66)。与各插值轨迹点对应的插值位置分量可以为插值轨迹点的第一位置分量。根据位置坐标(1,6)和位置坐标(5,66)的第一位置分量信息以及第二间隔距离1m,计算得到与各插值轨迹点对应的插值位置分量:2、3、4。
将各插值位置分量2、3、4,代入位置插值函数y=2x2+3x+1,得到对应的插值轨迹点的第二位置分量:15、28、45,从而得到与各插值轨迹点对应的位置信息:(2,15)、(3,28)、(4,45)。
将各插值轨迹点的位置信息按照插入位置,加入至数据序列中。差值运算后的数据序列包括:(1,6)、(2,15)、(3,28)、(4,45)、(5,66)。
根据与各插值轨迹点对应的插值位置分量:2、3、4,将各插值轨迹点的位置信息按照插入位置,加入至数据序列中。差值运算后的数据序列包括:(1,6)、(2,15)、(3,28)、(4,45)、(5,66)。
由此,通过按照第二间隔距离,对数据序列进行插值运算,并在数据序列中插入多个插值轨迹点的位置信息,增加与运动轨迹对应的位置信息的数量,从而可以更精准地控制无人设备按照运动轨迹进行重复运动。
步骤304、根据数据序列,确定多个分段点。
可选的,根据数据序列,确定多个分段点,可以包括:在数据序列中,获取当前处理的目标分段点,目标分段点的初始值为数据序列中的首个数据点;在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点,并在获取到满足分段条件的目标备选分段点时,将目标备选分段点作为新的目标分段点;返回执行在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点的操作,直至满足结束分段条件。
可选的,在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点,可以包括:获取目标分段点之后的第一相邻点,并判断第一相邻点是否为原始运动轨迹点;若否,则获取第一相邻点之后的第二相邻点,并判断第二相邻点是否为原始运动轨迹点;若否,则建立目标分段点与第一相邻点之间的第一连线,以及目标分段点与第二相邻点之间的第二连线;根据第一连线与第二连线得到基础比对夹角;如果基础比对夹角满足角度阈值条件,则将第二相邻点确定为目标备选分段点;如果基础比对夹角不满足角度阈值条件,则继续遍历第二相邻点的后一轨迹点作为新的第二相邻点后,返回执行判断第二相邻点是否为原始运动轨迹点的操作。
可选的,在判断第一相邻点是否为原始运动轨迹点之后,可以还包括:若是,则继续遍历第一相邻点的后一轨迹点作为新的第一相邻点后,返回执行判断第一相邻点是否为原始运动轨迹点的操作。
可选的,在判断第二相邻点是否为原始运动轨迹点之后,可以还包括:若是,则继续遍历第二相邻点的后一轨迹点作为新的第二相邻点后,返回执行判断第二相邻点是否为原始运动轨迹点的操作。
通过两次判断操作,保证获取的目标分段点之后的第一相邻点、以及第一相邻点之后的第二相邻点,不是原始运动轨迹点,而是插值轨迹点,从而实现后续进行的确定多个新的轨迹点的位置信息的步骤,都是基于插值轨迹点。
在一个具体施例中,如图3b所示,目标分段点O之后的第一相邻点A为原始运动轨迹点。第一相邻点A之后的第二相邻点B为原始运动轨迹点。建立目标分段点O与第一相邻点A之间的第一连线OA,以及目标分段点O与第二相邻点B之间的第二连线OB。根据第一连线OA与第二连线OB得到基础比对夹角α。角度阈值条件为大于30°。如果基础比对夹角α大于30°,则将第二相邻点B确定为目标备选分段点。如果基础比对夹角α小于等于30°,则继续遍历第二相邻点B的后一轨迹点作为新的第二相邻点后,返回执行判断第二相邻点是否为原始运动轨迹点的操作。
可选的,在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点,包括:获取目标分段点的后一相邻点作为比较点,并判断比较点是否为原始运动轨迹点;若否,则计算目标分段点与比较点之间的连线长度;如果连线长度满足长度阈值条件,则将比较点确定为目标备选分段点;如果连线长度不满足长度阈值条件,则获取比较点的后一相邻点作为新的比较点,并返回执行判断比较点是否为原始运动轨迹点的操作。
可选的,在判断比较点是否为原始运动轨迹点之后,还包括:若是,则继续遍历比较点的后一轨迹点作为新的比较点后,返回执行判断比较点是否为原始运动轨迹点的操作。
通过判断操作,保证获取的比较点不是原始运动轨迹点,而是插值轨迹点,从而实现后续进行的确定多个新的轨迹点的位置信息的步骤,都是基于插值轨迹点。
在一个具体施例中,如图3b所示,获取目标分段点O的后一相邻点A作为比较点。比较点A为原始运动轨迹点。计算目标分段点O与比较点A之间的连线长度OA。长度阈值条件为大于1m。如果连线长度OA大于1m,则将比较点A确定为目标备选分段点。如果连线长度OA小于等于1m,则获取比较点A的后一相邻点作为新的比较点,并返回执行判断比较点是否为原始运动轨迹点的操作。
可选的,结束分段条件为目标分段点为数据序列中的最后一个数据点。如果新的目标分段点为数据序列中的最后一个数据点,则结束分段。
可选的,结束分段条件为目标分段点之后的备选分段点都不满足目标备选分段点。如果新的目标分段点之后的备选分段点都不满足目标备选分段点,则结束分段。
步骤305、根据多个分段点生成多条参考线段,并按照第一间隔距离,在各参考线段上确定多个参考点。
可选的,根据多个分段点生成多条参考线段,并按照第一间隔距离,在各参考线段上确定多个参考点,可以包括:顺序建立两两相邻分段点之间的连线作为参考线段;根据各参考线段的起终点,计算与各参考线段对应的线段长度;按照与线段长度匹配的第一间隔距离,在各参考线段上确定多个参考点,参考点中包括各参考线段的起终点。
在一个具体施例中,如图3c所示,分段点包括:O、A以及B。顺序建立两两相邻分段点之间的连线作为参考线段:参考线段OA、参考线段AB。根据各参考线段的起终点,计算与各参考线段对应的线段长度。参考线段OA的线段长度为0.8m。参考线段OA的线段长度为1m。与0.8m匹配的第一间隔距离为0.2。与1m匹配的第一间隔距离为0.25。按照与0.8m匹配的第一间隔距离0.2,在参考线段OA上确定5个参考点:O、A1、A2、A3、A。按照与1m匹配的第一间隔距离0.25,在参考线段AB上确定5个参考点:O、B1、B2、B3、B。
步骤306、根据各参考点,确定多个新的轨迹点的位置信息。
可选的,根据各参考点,确定多个新的轨迹点的位置信息,可以包括:根据数据序列,获取与各参考线段分别对应的局部数据序列,构成多个线段数据对;确定各线段数据对中参考线段与局部数据序列之间的近似程度;如果当前处理的目标线段数据对的近似程度满足预设的近似条件,则确定使用目标线段数据对中参考线段上的各目标参考点作为新的轨迹点;如果当前处理的目标线段曲线对的近似程度不满足近似条件,则在目标线段数据对中与目标局部数据序列对应的曲线上,获取与各目标参考点对应的目标曲线点作为新的轨迹点。
与各参考线段分别对应的局部数据序列是数据序列中,位于参考线段的起终点之间的数据点。
可选的,确定各线段数据对中参考线段与局部数据序列之间的近似程度,可以包括:以当前处理的目标线段数据对中的目标参考线段的线段起点为原点,以目标参考线段所在的直线为X轴,建立坐标系;将数据序列中,与目标线段数据对中目标局部数据序列映射至坐标系中,得到映射序列;根据原点以及映射序列中原点的后一映射点,建立目标射线;计算目标参考线段的终点到目标射线的距离值,作为目标线段数据对中目标参考线段与目标局部数据序列之间的近似程度。
在一个具体施例中,如图3d所示,以当前处理的目标线段数据对中的目标参考线段OA的线段起点O为原点,以目标参考线段OA所在的直线为X轴,建立坐标系x1oy1。将数据序列中,与目标线段数据OA对中目标局部数据序列,映射至坐标系中,得到映射序列L1、L2、L3。根据原点O以及映射序列中原点O的后一映射点L1,建立目标射线
Figure BDA0002326740560000171
计算目标参考线段OA的终点A到目标射线
Figure BDA0002326740560000172
的距离值,作为目标线段数据对中目标参考线段与目标局部数据序列之间的近似程度。预设的近似条件为小于0.1m。如果目标参考线段OA的终点A到目标射线
Figure BDA0002326740560000173
的距离值小于0.1m,则确定使用目标线段数据对中参考线段OA上的各目标参考点作为新的轨迹点。如果目标参考线段OA的终点A到目标射线
Figure BDA0002326740560000181
的距离值大于等于0.1m,则在目标线段数据对中与目标局部数据序列对应的曲线上,获取与各目标参考点对应的目标曲线点作为新的轨迹点。
可选的,在目标线段数据对中与目标局部数据序列对应的曲线上,获取与各目标参考点对应的目标曲线点作为新的轨迹点,可以包括:使用各目标参考点,对映射序列中的各映射点进行插值运算,得到各目标曲线点。
具体的,使用各目标参考点,对映射序列中的各映射点进行插值运算,得到各目标曲线点,可以包括:将数据序列中,与目标线段数据对中目标局部数据序列,映射至坐标系中,得到映射序列;根据插值函数中包括的待确定常量的个数,确定目标数量;依次获取映射序列中的目标数量的原始运动轨迹点构成轨迹点集合;获取轨迹点集合中各目标轨迹点的位置信息;根据各目标轨迹点的第一位置分量信息和第二位置分量信息,计算插值函数中各待确定常量的位置描述常量值,以得到位置插值函数;根据各目标参考点的位置信息,确定与各目标曲线点对应的插值位置分量;根据各插值位置分量以及位置插值函数,得到与各目标曲线点对应的位置信息。
在一个具体实例中,轨迹点集合中包括3个原始运动轨迹点。根据各目标轨迹点的第一位置分量信息x和第二位置分量信息y,计算插值函数y=ax2+bx+c中各待确定常量的位置描述常量值。计算结果为:待确定常量a的位置描述常量值为1,待确定常量b的位置描述常量值为1,待确定常量c的位置描述常量值为1。得到位置插值函数y=x2+x+1。目标参考点包括:(1,5)、(2,10)。获取目标参考点的第一位置分量,作为与各目标曲线点对应的插值位置分量:1、2。将各插值位置分量代入位置插值函数y=x2+x+1,得到对应的各目标曲线点的第二位置分量:3、7,从而得到与各目标曲线点对应的位置信息:(1,3)、(2,7)。
步骤307、存储原始运动轨迹点的位置信息和作业信息,以及新轨迹点的位置信息至存储器。
步骤308、响应于重复执行与位置信息对应的运动轨迹的命令,从存储器中获取位置信息和作业信息,以控制无人设备按照位置信息进行重复运动,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作。
本发明实施例提供了一种无人设备的作业控制方法,通过在按照采集时间从远到近的顺序,生成与各原始运动轨迹点对应的数据序列之后,按照第二间隔距离,对数据序列进行插值运算,并在数据序列中插入多个插值轨迹点的位置信息,然后根据完成插值运算后的数据序列,确定多个分段点,生成多条参考线段,并按照第一间隔距离,在各参考线段上确定多个参考点,之后根据各参考点,确定多个新的轨迹点的位置信息,可以通过在数据序列中插入多个插值轨迹点的位置信息,并根据插值运算后的数据序列,确定多个新的轨迹点的位置信息,从而可以增加与运动轨迹对应的位置信息的数量,实现更精准地控制无人设备按照运动轨迹进行重复运动。
实施例四
图4为本发明实施例四提供的一种无人设备的作业控制装置的结构示意图,如图4所示,所述装置包括:信息采集模块401、信息存储模块402以及作业控制模块403。
其中,信息采集模块401,用于采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息;信息存储模块402,用于存储位置信息及作业信息至存储器;作业控制模块403,用于响应于重复执行与位置信息对应的运动轨迹的命令,从存储器中获取位置信息和作业信息,以控制无人设备按照位置信息进行重复运动,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作。
本发明实施例提供了一种无人设备的作业控制装置,通过采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息,并存储位置信息及作业信息至存储器,然后响应于重复执行与位置信息对应的运动轨迹的命令,从存储器中获取位置信息和作业信息,以控制无人设备按照位置信息进行重复运动,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作,解决了现有技术的轨迹重复作业需要前期工作投入和人力投入的问题,可以通过采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息进行存储,对无人设备在受控作业过程中的运动轨迹进行保存,可以根据存储的位置信息和作业信息,控制无人设备重复受控作业过程的运动轨迹和作业动作,从而实现了在无人设备完成第一次受控作业后,自主控制无人设备进行轨迹重复作业。
在上述各实施例的基础上,无人设备的作业控制装置可以还包括:新轨迹点确定模块,用于根据多个原始运动轨迹点的位置信息,确定多条参考线段,并根据多条参考线段,确定多个新轨迹点的位置信息;信息存储模块402可以包括:信息存储子模块,用于存储原始运动轨迹点的位置信息和作业信息,以及新轨迹点的位置信息至存储器。
在上述各实施例的基础上,信息采集模块401可以包括:起点获取子模块,用于按照预设的采集间隔,确定多个采集时间点;信息获取子模块,用于在无人设备的受控作业过程中,在各采集时间点下,获取无人设备所在的位置点作为原始运动轨迹点,并获取各原始运动轨迹点的位置信息和作业信息。
在上述各实施例的基础上,新轨迹点确定模块可以包括:序列生成子模块,用于按照采集时间从远到近的顺序,生成与各原始运动轨迹点对应的数据序列;分段点确定子模块,用于根据数据序列,确定多个分段点;参考点确定子模块,用于根据多个分段点生成多条参考线段,并按照第一间隔距离,在各参考线段上确定多个参考点;信息确定子模块,用于根据各参考点,确定多个新的轨迹点的位置信息。
在上述各实施例的基础上,分段点确定子模块可以包括:第一获取单元,用于在数据序列中,获取当前处理的目标分段点,目标分段点的初始值为数据序列中的首个数据点;第二获取单元,用于在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点,并在获取到满足分段条件的目标备选分段点时,将目标备选分段点作为新的目标分段点;操作返回单元,用于返回执行在数据序列中,顺序遍历目标分段点之后的至少一个备选分段点的操作,直至满足结束分段条件。
在上述各实施例的基础上,新轨迹点确定模块可以还包括:序列插值子模块,用于按照第二间隔距离,对数据序列进行插值运算,并在数据序列中插入多个插值轨迹点的位置信息。
在上述各实施例的基础上,序列插值子模块可以包括:集合获取单元,用于按照预设的插值函数,依次获取数据序列中的目标数量的原始运动轨迹点构成多个轨迹点集合,插值函数以位置信息中的第一位置分量为自变量,第二位置分量为因变量;信息计算单元,用于按照第二间隔距离以及插值函数,计算与各轨迹点集合分别对应的插值轨迹点的位置信息;信息插入单元,用于将各插值轨迹点的位置信息按照插入位置,加入至数据序列中。
在上述各实施例的基础上,集合获取单元可以包括:数量确定子单元,用于根据插值函数中包括的待确定常量的个数,确定目标数量;轨迹点获取子单元,用于依次获取数据序列中的目标数量的原始运动轨迹点构成多个轨迹点集合。
在上述各实施例的基础上,信息计算单元可以包括:信息获取子单元,用于获取当前处理的目标轨迹点集合,并获取与目标轨迹点集合中各目标轨迹点的位置信息;第一计算子单元,用于根据各目标轨迹点的第一位置分量信息和第二位置分量信息,计算插值函数中各待确定常量的位置描述常量值,以得到位置插值函数;第二计算子单元,用于根据与目标轨迹点集合对应的起始位置信息以及终止位置信息,以及第二间隔距离,计算得到与各插值轨迹点对应的插值位置分量;信息生成子单元,用于根据各插值位置分量以及位置插值函数,得到与各插值轨迹点对应的位置信息。
在上述各实施例的基础上,第二获取单元可以包括:第一判断子单元,用于获取目标分段点之后的第一相邻点,并判断第一相邻点是否为原始运动轨迹点;第二判断子单元,用于若否,则获取第一相邻点之后的第二相邻点,并判断第二相邻点是否为原始运动轨迹点;连线建立子单元,用于若否,则建立目标分段点与第一相邻点之间的第一连线,以及目标分段点与第二相邻点之间的第二连线;夹角生成子单元,用于根据第一连线与第二连线得到基础比对夹角;第一确定子单元,用于如果基础比对夹角满足角度阈值条件,则将第二相邻点确定为目标备选分段点;第一返回子单元,用于如果基础比对夹角不满足角度阈值条件,则继续遍历第二相邻点的后一轨迹点作为新的第二相邻点后,返回执行判断第二相邻点是否为原始运动轨迹点的操作。
在上述各实施例的基础上,第二获取单元可以包括:第三判断子单元,用于获取目标分段点的后一相邻点作为比较点,并判断比较点是否为原始运动轨迹点;第四判断子单元,用于若否,则计算目标分段点与比较点之间的连线长度;第二确定子单元,用于如果连线长度满足长度阈值条件,则将比较点确定为目标备选分段点;第二返回子单元,用于如果连线长度不满足长度阈值条件,则获取比较点的后一相邻点作为新的比较点,并返回执行判断比较点是否为原始运动轨迹点的操作。
在上述各实施例的基础上,参考点确定子模块可以包括:连线建立子单元,用于顺序建立两两相邻分段点之间的连线作为参考线段;长度计算子单元,用于根据各参考线段的起终点,计算与各参考线段对应的线段长度;参考点确定子单元,用于按照与线段长度匹配的第一间隔距离,在各参考线段上确定多个参考点,参考点中包括各参考线段的起终点。
在上述各实施例的基础上,信息确定子模块可以包括:数据对生成单元,用于根据数据序列,获取与各参考线段分别对应的局部数据序列,构成多个线段数据对;近似程度确定单元,用于确定各线段数据对中参考线段与局部数据序列之间的近似程度;轨迹点确定单元,用于如果当前处理的目标线段数据对的近似程度满足预设的近似条件,则确定使用目标线段数据对中参考线段上的各目标参考点作为新的轨迹点;曲线点获取单元,用于如果当前处理的目标线段曲线对的近似程度不满足近似条件,则在目标线段数据对中与目标局部数据序列对应的曲线上,获取与各目标参考点对应的目标曲线点作为新的轨迹点。
在上述各实施例的基础上,近似程度确定单元可以包括:坐标系建立子单元,用于以当前处理的目标线段数据对中的目标参考线段的线段起点为原点,以目标参考线段所在的直线为X轴,建立坐标系;序列映射子单元,用于将数据序列中,与目标线段数据对中目标局部数据序列映射至坐标系中,得到映射序列;射线建立子单元,用于根据原点以及映射序列中原点的后一映射点,建立目标射线;距离值计算子单元,用于计算目标参考线段的终点到目标射线的距离值,作为目标线段数据对中目标参考线段与目标局部数据序列之间的近似程度。
在上述各实施例的基础上,曲线点获取单元可以包括:插值运算子单元,用于使用各目标参考点,对映射序列中的各映射点进行插值运算,得到各目标曲线点。
上述无人设备的作业控制装置可执行本发明任意实施例所提供的无人设备的作业控制方法,具备执行无人设备的作业控制方法相应的功能模块和有益效果。
实施例五
图5为本发明实施例五提供的一种计算机设备的结构示意图。图5示出了适于用来实现本发明实施方式的示例性计算机设备512的框图。图5显示的计算机设备512仅仅是一个示例,不应对本发明实施例的功能和使用范围带来任何限制。
如图5所示,计算机设备512以通用计算设备的形式表现。计算机设备512的组件可以包括但不限于:一个或者多个处理器516,存储器528,连接不同系统组件(包括存储器528和处理器516)的总线518。
总线518表示几类总线结构中的一种或多种,包括存储器总线或者存储器控制器,外围总线,图形加速端口,处理器或者使用多种总线结构中的任意总线结构的局域总线。举例来说,这些体系结构包括但不限于工业标准体系结构(ISA)总线,微通道体系结构(MAC)总线,增强型ISA总线、视频电子标准协会(VESA)局域总线以及外围组件互连(PCI)总线。
计算机设备512典型地包括多种计算机系统可读介质。这些介质可以是任何能够被计算机设备512访问的可用介质,包括易失性和非易失性介质,可移动的和不可移动的介质。
存储器528可以包括易失性存储器形式的计算机系统可读介质,例如随机存取存储器(RAM)530和/或高速缓存存储器532。计算机设备512可以进一步包括其它可移动/不可移动的、易失性/非易失性计算机系统存储介质。仅作为举例,存储系统534可以用于读写不可移动的、非易失性磁介质(图5未显示,通常称为“硬盘驱动器”)。尽管图5中未示出,可以提供用于对可移动非易失性磁盘(例如“软盘”)读写的磁盘驱动器,以及对可移动非易失性光盘(例如CD-ROM,DVD-ROM或者其它光介质)读写的光盘驱动器。在这些情况下,每个驱动器可以通过一个或者多个数据介质接口与总线518相连。存储器528可以包括至少一个程序产品,该程序产品具有一组(例如至少一个)程序模块,这些程序模块被配置以执行本发明各实施例的功能。
具有一组(至少一个)程序模块542的程序/实用工具540,可以存储在例如存储器528中,这样的程序模块542包括——但不限于——操作系统、一个或者多个应用程序、其它程序模块以及程序数据,这些示例中的每一个或某种组合中可能包括网络环境的实现。程序模块542通常执行本发明所描述的实施例中的功能和/或方法。
计算机设备512也可以与一个或多个外部设备614(例如键盘、指向设备、显示器524等)通信,还可与一个或者多个使得用户能与该计算机设备512交互的设备通信,和/或与使得该计算机设备512能与一个或多个其它计算设备进行通信的任何设备(例如网卡,调制解调器等等)通信。这种通信可以通过输入/输出(I/O)接口522进行。并且,计算机设备512还可以通过网络适配器520与一个或者多个网络(例如局域网(LAN),广域网(WAN)和/或公共网络,例如因特网)通信。如图所示,网络适配器520通过总线518与计算机设备512的其它模块通信。应当明白,尽管图5中未示出,可以结合计算机设备512使用其它硬件和/或软件模块,包括但不限于:微代码、设备驱动器、冗余处理单元、外部磁盘驱动阵列、RAID系统、磁带驱动器以及数据备份存储系统等。
处理器516通过运行存储在存储器528中的程序,从而执行各种功能应用以及数据处理,例如实现本发明实施例所提供的无人设备的作业控制方法。也即,采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息;存储位置信息及作业信息至存储器;响应于重复执行与位置信息对应的运动轨迹的命令,从存储器中获取位置信息和作业信息,以控制无人设备按照位置信息进行重复运动,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作。
实施例六
本发明实施例六提供了一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现如本申请所有发明实施例提供的无人设备的作业控制方法。也即,采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息;存储位置信息及作业信息至存储器;响应于重复执行与位置信息对应的运动轨迹的命令,从存储器中获取位置信息和作业信息,以控制无人设备按照位置信息进行重复运动,并在运动至原始运动轨迹点时,进行与作业信息匹配的作业动作。
可以采用一个或多个计算机可读的介质的任意组合。计算机可读介质可以是计算机可读信号介质或者计算机可读存储介质。计算机可读存储介质例如可以是——但不限于——电、磁、光、电磁、红外线、或半导体的系统、装置或器件,或者任意以上的组合。计算机可读存储介质的更具体的例子(非穷举的列表)包括:具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、随机存取存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、光纤、便携式紧凑磁盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。在本文件中,计算机可读存储介质可以是任何包含或存储程序的有形介质,该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。
计算机可读的信号介质可以包括在基带中或者作为载波一部分传播的数据信号,其中承载了计算机可读的程序代码。这种传播的数据信号可以采用多种形式,包括——但不限于——电磁信号、光信号或上述的任意合适的组合。计算机可读的信号介质还可以是计算机可读存储介质以外的任何计算机可读介质,该计算机可读介质可以发送、传播或者传输用于由指令执行系统、装置或者器件使用或者与其结合使用的程序。
计算机可读介质上包含的程序代码可以用任何适当的介质传输,包括——但不限于——无线、电线、光缆、RF等等,或者上述的任意合适的组合。
可以以一种或多种程序设计语言或其组合来编写用于执行本发明操作的计算机程序代码,所述程序设计语言包括面向对象的程序设计语言—诸如Java、Smalltalk、C++,还包括常规的过程式程序设计语言—诸如“C”语言或类似的程序设计语言。程序代码可以完全地在用户计算机上执行、部分地在用户计算机上执行、作为一个独立的软件包执行、部分在用户计算机上部分在远程计算机上执行、或者完全在远程计算机或服务器上执行。在涉及远程计算机的情形中,远程计算机可以通过任意种类的网络——包括局域网(LAN)或广域网(WAN)—连接到用户计算机,或者,可以连接到外部计算机(例如利用因特网服务提供商来通过因特网连接)。
注意,上述仅为本发明的较佳实施例及所运用技术原理。本领域技术人员会理解,本发明不限于这里所述的特定实施例,对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本发明的保护范围。因此,虽然通过以上实施例对本发明进行了较为详细的说明,但是本发明不仅仅限于以上实施例,在不脱离本发明构思的情况下,还可以包括更多其他等效实施例,而本发明的范围由所附的权利要求范围决定。

Claims (18)

1.一种无人设备的作业控制方法,其特征在于,包括:
采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息;
存储所述位置信息及作业信息至存储器;
响应于重复执行与所述位置信息对应的运动轨迹的命令,从存储器中获取所述位置信息和作业信息,以控制所述无人设备按照所述位置信息进行重复运动,并在运动至所述原始运动轨迹点时,进行与所述作业信息匹配的作业动作。
2.根据权利要求1所述的方法,其特征在于,在存储所述位置信息及作业信息至存储器之前,还包括:
根据所述多个原始运动轨迹点的位置信息,确定多条参考线段,并根据所述多条参考线段,确定多个新轨迹点的位置信息;
存储所述位置信息及作业信息至存储器,包括:
存储所述原始运动轨迹点的位置信息和作业信息,以及新轨迹点的位置信息至所述存储器。
3.根据权利要求1所述的方法,其特征在于,采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息,包括:
按照预设的采集间隔,确定多个采集时间点;
在所述无人设备的受控作业过程中,在各所述采集时间点下,获取所述无人设备所在的位置点作为所述原始运动轨迹点,并获取各所述原始运动轨迹点的位置信息和作业信息。
4.根据权利要求2所述的方法,其特征在于,根据所述多个原始运动轨迹点的位置信息,确定多条参考线段,并根据所述多条参考线段,确定多个新轨迹点的位置信息,包括:
按照采集时间从远到近的顺序,生成与各所述原始运动轨迹点对应的数据序列;
根据所述数据序列,确定多个分段点;
根据多个分段点生成多条参考线段,并按照第一间隔距离,在各所述参考线段上确定多个参考点;
根据各所述参考点,确定所述多个新的轨迹点的位置信息。
5.根据权利要求4所述的方法,其特征在于,根据所述数据序列,确定多个分段点,包括:
在所述数据序列中,获取当前处理的目标分段点,所述目标分段点的初始值为所述数据序列中的首个数据点;
在所述数据序列中,顺序遍历所述目标分段点之后的至少一个备选分段点,并在获取到满足分段条件的目标备选分段点时,将所述目标备选分段点作为新的目标分段点;
返回执行在所述数据序列中,顺序遍历所述目标分段点之后的至少一个备选分段点的操作,直至满足结束分段条件。
6.根据权利要求4所述的方法,其特征在于,在根据所述数据序列,确定多个分段点之前,还包括:
按照第二间隔距离,对所述数据序列进行插值运算,并在所述数据序列中插入多个插值轨迹点的位置信息。
7.根据权利要求6所述的方法,其特征在于,按照第二间隔距离,对所述数据序列进行插值运算,并在所述数据序列中插入多个插值轨迹点的位置信息,包括:
按照预设的插值函数,依次获取所述数据序列中的目标数量的原始运动轨迹点构成多个轨迹点集合,所述插值函数以位置信息中的第一位置分量为自变量,第二位置分量为因变量;
按照所述第二间隔距离以及所述插值函数,计算与各所述轨迹点集合分别对应的插值轨迹点的位置信息;
将各所述插值轨迹点的位置信息按照插入位置,加入至所述数据序列中。
8.根据权利要求7所述的方法,其特征在于,按照预设的插值函数,依次获取所述数据序列中的目标数量的原始运动轨迹点构成多个轨迹点集合,包括:
根据所述插值函数中包括的待确定常量的个数,确定所述目标数量;
依次获取所述数据序列中的目标数量的原始运动轨迹点构成多个轨迹点集合。
9.根据权利要求7所述的方法,其特征在于,按照所述第二间隔距离以及所述插值函数,计算与各所述轨迹点集合分别对应的插值轨迹点的位置信息,包括:
获取当前处理的目标轨迹点集合,并获取与所述目标轨迹点集合中各目标轨迹点的位置信息;
根据各目标轨迹点的第一位置分量信息和第二位置分量信息,计算所述插值函数中各待确定常量的位置描述常量值,以得到位置插值函数;
根据与所述目标轨迹点集合对应的起始位置信息以及终止位置信息,以及所述第二间隔距离,计算得到与各插值轨迹点对应的插值位置分量;
根据各所述插值位置分量以及所述位置插值函数,得到与各所述插值轨迹点对应的位置信息。
10.根据权利要求5、7-9任一项所述的方法,其特征在于,在所述数据序列中,顺序遍历所述目标分段点之后的至少一个备选分段点,包括:
获取所述目标分段点之后的第一相邻点,并判断所述第一相邻点是否为原始运动轨迹点;
若否,则获取所述第一相邻点之后的第二相邻点,并判断所述第二相邻点是否为原始运动轨迹点;
若否,则建立所述目标分段点与所述第一相邻点之间的第一连线,以及所述目标分段点与所述第二相邻点之间的第二连线;
根据所述第一连线与所述第二连线得到基础比对夹角;
如果所述基础比对夹角满足角度阈值条件,则将所述第二相邻点确定为所述目标备选分段点;
如果所述基础比对夹角不满足所述角度阈值条件,则继续遍历所述第二相邻点的后一轨迹点作为新的第二相邻点后,返回执行判断所述第二相邻点是否为原始运动轨迹点的操作。
11.根据权利要求5、7-9任一项所述的方法,其特征在于,在所述数据序列中,顺序遍历所述目标分段点之后的至少一个备选分段点,包括:
获取所述目标分段点的后一相邻点作为比较点,并判断所述比较点是否为原始运动轨迹点;
若否,则计算所述目标分段点与所述比较点之间的连线长度;
如果所述连线长度满足长度阈值条件,则将所述比较点确定为所述目标备选分段点;
如果所述连线长度不满足长度阈值条件,则获取所述比较点的后一相邻点作为新的比较点,并返回执行判断所述比较点是否为原始运动轨迹点的操作。
12.根据权利要求4-9任一项所述的方法,其特征在于,根据所述多个分段点生成多条参考线段,并按照第一间隔距离,在各所述参考线段上确定多个参考点,包括:
顺序建立两两相邻分段点之间的连线作为所述参考线段;
根据各所述参考线段的起终点,计算与各所述参考线段对应的线段长度;
按照与所述线段长度匹配的第一间隔距离,在各所述参考线段上确定多个参考点,所述参考点中包括各参考线段的起终点。
13.根据权利要求4-9任一项所述的方法,其特征在于,根据各所述参考点,确定所述多个新的轨迹点的位置信息,包括:
根据所述数据序列,获取与各所述参考线段分别对应的局部数据序列,构成多个线段数据对;
确定各所述线段数据对中参考线段与局部数据序列之间的近似程度;
如果当前处理的目标线段数据对的近似程度满足预设的近似条件,则确定使用所述目标线段数据对中参考线段上的各目标参考点作为所述新的轨迹点;
如果当前处理的目标线段曲线对的近似程度不满足所述近似条件,则在所述目标线段数据对中与目标局部数据序列对应的曲线上,获取与各所述目标参考点对应的目标曲线点作为所述新的轨迹点。
14.根据权利要求13所述的方法,其特征在于,确定各所述线段数据对中参考线段与局部数据序列之间的近似程度,包括:
以当前处理的目标线段数据对中的目标参考线段的线段起点为原点,以所述目标参考线段所在的直线为X轴,建立坐标系;
将所述数据序列中,与所述目标线段数据对中目标局部数据序列映射至所述坐标系中,得到映射序列;
根据所述原点以及所述映射序列中所述原点的后一映射点,建立目标射线;
计算所述目标参考线段的终点到所述目标射线的距离值,作为所述目标线段数据对中目标参考线段与目标局部数据序列之间的近似程度。
15.根据权利要求14所述的方法,其特征在于,在所述目标线段数据对中与目标局部数据序列对应的曲线上,获取与各所述目标参考点对应的目标曲线点作为所述新的轨迹点,包括:
使用各所述目标参考点,对所述映射序列中的各映射点进行插值运算,得到各所述目标曲线点。
16.一种无人设备的作业控制装置,其特征在于,包括:
信息采集模块,用于采集无人设备在受控作业过程中的多个原始运动轨迹点的位置信息以及作业信息;
信息存储模块,用于存储所述位置信息及作业信息至存储器;
作业控制模块,用于响应于重复执行与所述位置信息对应的运动轨迹的命令,从存储器中获取所述位置信息和作业信息,以控制所述无人设备按照所述位置信息进行重复运动,并在运动至所述原始运动轨迹点时,进行与所述作业信息匹配的作业动作。
17.一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现如权利要求1-15中任一所述的无人设备的作业控制方法。
18.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该计算机程序被处理器执行时实现如权利要求1-15中任一所述的无人设备的作业控制方法。
CN201911319454.4A 2019-12-19 2019-12-19 无人设备的作业控制方法、装置、设备及存储介质 Active CN113009884B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911319454.4A CN113009884B (zh) 2019-12-19 2019-12-19 无人设备的作业控制方法、装置、设备及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911319454.4A CN113009884B (zh) 2019-12-19 2019-12-19 无人设备的作业控制方法、装置、设备及存储介质

Publications (2)

Publication Number Publication Date
CN113009884A CN113009884A (zh) 2021-06-22
CN113009884B true CN113009884B (zh) 2022-06-21

Family

ID=76381253

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911319454.4A Active CN113009884B (zh) 2019-12-19 2019-12-19 无人设备的作业控制方法、装置、设备及存储介质

Country Status (1)

Country Link
CN (1) CN113009884B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114703553B (zh) * 2022-03-28 2023-03-21 青岛中科凯尔科技有限公司 一种用于形成纳米纤维的溶液喷射纺丝装置

Family Cites Families (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105955290B (zh) * 2016-04-27 2019-05-24 腾讯科技(深圳)有限公司 无人飞行器控制方法及装置
CN106774221A (zh) * 2017-01-22 2017-05-31 江苏中科院智能科学技术应用研究院 一种无人机与无人车协作巡逻系统及方法
CN107479368B (zh) * 2017-06-30 2021-09-21 北京百度网讯科技有限公司 一种基于人工智能的训练无人机控制模型的方法及系统
CN107544548B (zh) * 2017-10-20 2021-09-10 广州极飞科技股份有限公司 控制无人机作业的方法、装置及无人机
CN107807659A (zh) * 2017-10-24 2018-03-16 北京臻迪科技股份有限公司 一种无人机飞行控制方法及装置
WO2019084767A1 (zh) * 2017-10-31 2019-05-09 深圳市大疆创新科技有限公司 可移动设备作业控制方法及装置、路径规划方法及装置
CN108313295A (zh) * 2018-03-28 2018-07-24 湖南星思科技有限公司 一种无人机投放装置及其控制方法
CN108508430B (zh) * 2018-04-03 2020-07-17 中国人民解放军国防科技大学 用于目标检测的激光雷达转动控制方法
KR102117338B1 (ko) * 2018-05-08 2020-06-01 선종현 원통좌표계 기반 무인이동체 조종 방법, 이를 구현하기 위한 프로그램이 저장된 기록매체 및 이를 구현하기 위해 매체에 저장된 컴퓨터프로그램
CN108846325A (zh) * 2018-05-28 2018-11-20 广州极飞科技有限公司 目标区域作业的规划方法、装置、存储介质及处理器
CN109283937A (zh) * 2018-09-18 2019-01-29 广东省智能制造研究所 一种基于无人机的植保喷施作业的方法及系统
CN109491510A (zh) * 2018-12-17 2019-03-19 深圳市道通智能航空技术有限公司 一种无人机控制方法、装置、设备及存储介质
CN109712271A (zh) * 2019-01-08 2019-05-03 深圳市道通智能航空技术有限公司 一种无人机数据处理方法、装置、设备及存储介质
CN109739264A (zh) * 2019-02-27 2019-05-10 重庆邮电大学 一种基于飞行指令的小型无人机轨迹归航系统及方法
CN110140704B (zh) * 2019-05-17 2022-01-07 安徽舒州生态农业科技有限责任公司 一种用于植保无人机的智能农药喷洒方法及系统
CN110400023A (zh) * 2019-07-31 2019-11-01 北京三快在线科技有限公司 一种轨迹规划算法的切换方法及装置
CN110470301B (zh) * 2019-08-13 2020-12-11 上海交通大学 多动态任务目标点下的无人机路径规划方法

Also Published As

Publication number Publication date
CN113009884A (zh) 2021-06-22

Similar Documents

Publication Publication Date Title
CN109345596B (zh) 多传感器标定方法、装置、计算机设备、介质和车辆
CN110163903B (zh) 三维图像的获取及图像定位方法、装置、设备和存储介质
CN109118542B (zh) 激光雷达与相机之间的标定方法、装置、设备及存储介质
CN109242913B (zh) 采集器相对参数的标定方法、装置、设备和介质
US11644338B2 (en) Ground texture image-based navigation method and device, and storage medium
CN109242903B (zh) 三维数据的生成方法、装置、设备及存储介质
CN107888828B (zh) 空间定位方法及装置、电子设备、以及存储介质
CN110378966B (zh) 车路协同相机外参标定方法、装置、设备及存储介质
CN109116374B (zh) 确定障碍物距离的方法、装置、设备及存储介质
CN111815754B (zh) 一种三维信息确定方法、三维信息确定装置及终端设备
US20110115892A1 (en) Real-time embedded visible spectrum light vision-based human finger detection and tracking method
CN110471409B (zh) 机器人巡检方法、装置、计算机可读存储介质及机器人
CN110850807B (zh) 一种奇异点规避方法、装置、设备及介质
CN108876857B (zh) 无人驾驶车辆的定位方法、系统、设备及存储介质
CN110969687A (zh) 一种碰撞检测方法、装置、设备和介质
US20230325009A1 (en) Methods, devices, apparatuses, and storage media for mapping mouse models for computer mouses
CN110930444B (zh) 一种基于双边优化的点云匹配方法、介质、终端和装置
US20180114339A1 (en) Information processing device and method, and program
CN113009884B (zh) 无人设备的作业控制方法、装置、设备及存储介质
CN113009908A (zh) 一种无人设备的运动控制方法、装置、设备及存储介质
CN113763466B (zh) 一种回环检测方法、装置、电子设备和存储介质
CN111951328A (zh) 一种物体位置检测方法、装置、设备和存储介质
CN112414444B (zh) 一种数据标定方法、计算机设备、存储介质
CN109685851B (zh) 行走机器人的手眼标定方法、系统、设备及存储介质
CN113093715B (zh) 无人设备的运动控制方法、装置、设备及存储介质

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant