CN113093715A - 无人设备的运动控制方法、装置、设备及存储介质 - Google Patents

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

Info

Publication number
CN113093715A
CN113093715A CN201911319462.9A CN201911319462A CN113093715A CN 113093715 A CN113093715 A CN 113093715A CN 201911319462 A CN201911319462 A CN 201911319462A CN 113093715 A CN113093715 A CN 113093715A
Authority
CN
China
Prior art keywords
point
target
position information
points
track
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.)
Granted
Application number
CN201911319462.9A
Other languages
English (en)
Other versions
CN113093715B (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 CN201911319462.9A priority Critical patent/CN113093715B/zh
Publication of CN113093715A publication Critical patent/CN113093715A/zh
Application granted granted Critical
Publication of CN113093715B publication Critical patent/CN113093715B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0242Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0259Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • G05D1/0263Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using magnetic strips
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/028Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Image Analysis (AREA)
  • Manipulator (AREA)

Abstract

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

Description

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

Claims (18)

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

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911319462.9A CN113093715B (zh) 2019-12-19 2019-12-19 无人设备的运动控制方法、装置、设备及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911319462.9A CN113093715B (zh) 2019-12-19 2019-12-19 无人设备的运动控制方法、装置、设备及存储介质

Publications (2)

Publication Number Publication Date
CN113093715A true CN113093715A (zh) 2021-07-09
CN113093715B CN113093715B (zh) 2024-06-14

Family

ID=76662764

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911319462.9A Active CN113093715B (zh) 2019-12-19 2019-12-19 无人设备的运动控制方法、装置、设备及存储介质

Country Status (1)

Country Link
CN (1) CN113093715B (zh)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104035446A (zh) * 2014-05-30 2014-09-10 深圳市大疆创新科技有限公司 无人机的航向生成方法和系统
CN107544548A (zh) * 2017-10-20 2018-01-05 广州极飞科技有限公司 控制无人机作业的方法、装置及无人机
CN109116867A (zh) * 2018-09-28 2019-01-01 拓攻(南京)机器人有限公司 一种无人机飞行避障方法、装置、电子设备及存储介质
CN110261736A (zh) * 2019-06-26 2019-09-20 国网青海省电力公司西宁供电公司 一种输电线路杆塔的巡检导航系统及方法
CN110262506A (zh) * 2019-07-02 2019-09-20 华人运通(上海)自动驾驶科技有限公司 预瞄点的确认方法、车辆行驶控制方法、装置及设备
CN110533730A (zh) * 2019-08-26 2019-12-03 智久(厦门)机器人科技有限公司 基于b样条曲线的路径规划方法、装置、计算机可读存储介质

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104035446A (zh) * 2014-05-30 2014-09-10 深圳市大疆创新科技有限公司 无人机的航向生成方法和系统
CN107544548A (zh) * 2017-10-20 2018-01-05 广州极飞科技有限公司 控制无人机作业的方法、装置及无人机
CN109116867A (zh) * 2018-09-28 2019-01-01 拓攻(南京)机器人有限公司 一种无人机飞行避障方法、装置、电子设备及存储介质
CN110261736A (zh) * 2019-06-26 2019-09-20 国网青海省电力公司西宁供电公司 一种输电线路杆塔的巡检导航系统及方法
CN110262506A (zh) * 2019-07-02 2019-09-20 华人运通(上海)自动驾驶科技有限公司 预瞄点的确认方法、车辆行驶控制方法、装置及设备
CN110533730A (zh) * 2019-08-26 2019-12-03 智久(厦门)机器人科技有限公司 基于b样条曲线的路径规划方法、装置、计算机可读存储介质

Also Published As

Publication number Publication date
CN113093715B (zh) 2024-06-14

Similar Documents

Publication Publication Date Title
CN110163903B (zh) 三维图像的获取及图像定位方法、装置、设备和存储介质
CN110378966B (zh) 车路协同相机外参标定方法、装置、设备及存储介质
CN109344755B (zh) 视频动作的识别方法、装置、设备及存储介质
CN111815754B (zh) 一种三维信息确定方法、三维信息确定装置及终端设备
CN106951484B (zh) 图片检索方法及装置、计算机设备及计算机可读介质
CN110471409B (zh) 机器人巡检方法、装置、计算机可读存储介质及机器人
CN110850807B (zh) 一种奇异点规避方法、装置、设备及介质
CN111402413B (zh) 三维视觉定位方法、装置及计算设备、存储介质
CN111209978A (zh) 三维视觉重定位方法、装置及计算设备、存储介质
CN111292420A (zh) 用于构建地图的方法和装置
CN110930444B (zh) 一种基于双边优化的点云匹配方法、介质、终端和装置
CN113099111A (zh) 点胶轨迹生成方法、装置、电子设备和存储介质
CN115409808A (zh) 焊缝识别方法、装置、焊接机器人及存储介质
CN113009884B (zh) 无人设备的作业控制方法、装置、设备及存储介质
CN110853098B (zh) 机器人定位方法、装置、设备及存储介质
CN112085842B (zh) 深度值确定方法及装置、电子设备和存储介质
CN113093715A (zh) 无人设备的运动控制方法、装置、设备及存储介质
CN109816726B (zh) 一种基于深度滤波器的视觉里程计地图更新方法和系统
CN113009908A (zh) 一种无人设备的运动控制方法、装置、设备及存储介质
CN100549977C (zh) 芯片验证的预处理方法和预处理装置
CN113091755B (zh) 运动轨迹的跟踪方法、装置、设备及存储介质
CN115409809A (zh) 焊缝识别方法、装置、焊接机器人及存储介质
CN106303153A (zh) 一种图像处理方法及装置
CN111959496B (zh) 用于车辆横向控制的模型生成方法、装置及电子设备
CN113758481A (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