CN111650936B - 一种伺服控制方法、处理器、存储介质和可移动平台 - Google Patents

一种伺服控制方法、处理器、存储介质和可移动平台 Download PDF

Info

Publication number
CN111650936B
CN111650936B CN202010492674.3A CN202010492674A CN111650936B CN 111650936 B CN111650936 B CN 111650936B CN 202010492674 A CN202010492674 A CN 202010492674A CN 111650936 B CN111650936 B CN 111650936B
Authority
CN
China
Prior art keywords
pose
coordinate system
target
preset
preset target
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
CN202010492674.3A
Other languages
English (en)
Other versions
CN111650936A (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.)
Hangzhou Iplus Tech Co ltd
Original Assignee
Hangzhou Iplus Tech 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 Hangzhou Iplus Tech Co ltd filed Critical Hangzhou Iplus Tech Co ltd
Priority to CN202010492674.3A priority Critical patent/CN111650936B/zh
Publication of CN111650936A publication Critical patent/CN111650936A/zh
Priority to JP2022574677A priority patent/JP7443572B2/ja
Priority to PCT/CN2021/098060 priority patent/WO2021244598A1/zh
Priority to EP21817887.9A priority patent/EP4163752A4/en
Application granted granted Critical
Publication of CN111650936B publication Critical patent/CN111650936B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10—Complex mathematical operations
    • G06F17/18—Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06K—GRAPHICAL DATA READING; PRESENTATION OF DATA; RECORD CARRIERS; HANDLING RECORD CARRIERS
    • G06K17/00—Methods or arrangements for effecting co-operative working between equipments covered by two or more of main groups G06K1/00 - G06K15/00, e.g. automatic card files incorporating conveying and reading operations
    • G06K17/0022—Methods or arrangements for effecting co-operative working between equipments covered by two or more of main groups G06K1/00 - G06K15/00, e.g. automatic card files incorporating conveying and reading operations arrangements or provisious for transferring data to distant stations, e.g. from a sensing device
    • G06K17/0025—Methods or arrangements for effecting co-operative working between equipments covered by two or more of main groups G06K1/00 - G06K15/00, e.g. automatic card files incorporating conveying and reading operations arrangements or provisious for transferring data to distant stations, e.g. from a sensing device the arrangement consisting of a wireless interrogation device in combination with a device for optically marking the record carrier

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Theoretical Computer Science (AREA)
  • Data Mining & Analysis (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Pure & Applied Mathematics (AREA)
  • General Engineering & Computer Science (AREA)
  • Mathematical Physics (AREA)
  • Computational Mathematics (AREA)
  • Mathematical Analysis (AREA)
  • Mathematical Optimization (AREA)
  • Evolutionary Biology (AREA)
  • Probability & Statistics with Applications (AREA)
  • Operations Research (AREA)
  • Algebra (AREA)
  • Bioinformatics & Computational Biology (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • Bioinformatics & Cheminformatics (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

本发明提供一种采用非完整约束进行的高精度、高效率的伺服控制方法、处理器、存储介质和可移动平台。本发明公开了一种伺服控制方法，确定预设目标位姿；获取至少一个标识，得到当前位姿；根据预设目标位姿和当前位姿的相对位姿关系，确定偏移角度；基于标识和预设目标位姿得到目标直线，根据所述的目标直线和当前位姿的相对位姿关系，确定偏移位移；根据所述偏移位移和偏移角度获取控制指令。本发明还公开了用于执行上述操作的处理器、存储执行程序的存储介质，以及可移动平台。

Description

一种伺服控制方法、处理器、存储介质和可移动平台
技术领域
本发明涉及控制技术领域，尤其涉及一种伺服控制方法、处理器、存储介质和可移动平台。
背景技术
现代物流系统、仓储系统或工业生产线对精准程度的要求越来越高。工厂朝着智慧化，无人化工厂转型发展，每个零部件都造价不菲，这要求工厂每台生产设备都需要极高的运行精度，才能使工厂整个系统高度鲁棒闭环运作起来。可移动平台作为产线间的搬运设备，对接精度需达到毫米级以上才能满足搬运指标要求。
现有的可移动平台中，基于差分底盘或双舵轮底盘这类难于以三自由度快速调整位姿的底盘的移动平台被广泛使用，但与可三自由度快速调整位姿的全向轮底盘相比，上述类型底盘存在一些局限性。例如，对于差分底盘，由于非完整约束限制，无法在狭窄空间下快速收敛横向误差；对于双舵轮底盘，由于设计本身限制，在毫米级高精度横向对接时，高频率全向调整会使舵角频繁改变，无法精确满足运动学理论模型，同时会降低其使用寿命。对于某些应用场景，现有调整方法往往通过完整的约束精准调整到点，计算过程过于繁杂，并且效率低，但实际上可以忽略某些维度的误差，并达到同样的目的，以此简化计算与执行过程，提高执行效率。
发明内容
本发明针对上述现有产品存在的问题，提供一种采用非完整约束进行的高精度、高效率的伺服控制方法、处理器、存储介质和可移动平台。
本发明公开了一种伺服控制方法，
确定预设目标位姿；
获取至少一个标识，得到当前位姿；
根据预设目标位姿和当前位姿的相对位姿关系，确定偏移角度；
基于标识和预设目标位姿得到目标直线，根据所述的目标直线和当前位姿的相对位姿关系，确定偏移位移；
根据所述偏移位移和偏移角度获取控制指令。
作为优选，以预设规则间隔性获取至少同一标识，在每一预设规则间隔内根据所述的标识得到当前时刻的当前位姿，获取控制指令；利用在每一预设规则间隔内获取的控制指令对当前位姿进行伺服控制。
作为优选，所述的获取至少一个标识，得到当前位姿，包括：基于所述的标识建立标识坐标系
Figure 294961DEST_PATH_IMAGE001
，得到当前位姿在标识坐标系
Figure 836670DEST_PATH_IMAGE001
下的位移和角度坐标。
作为优选，所述的标识为垂直于地面设置的标识。
作为优选，根据所述的根据预设目标位姿和当前位姿的相对位姿关系，确定偏移角度包括：根据所述的预设目标位姿在标识坐标系
Figure 897030DEST_PATH_IMAGE001
下的姿态，以及所述的当前位姿在标识坐标系
Figure 60158DEST_PATH_IMAGE001
下的姿态，得到预设目标位姿和当前位姿之间的相对位姿关系，提取偏移角度。
作为优选，所述的根据目标直线和当前位姿的相对位姿关系，确定偏移位移，包括：基于所述的预设目标位姿的位移坐标创建虚拟目标点
Figure 446140DEST_PATH_IMAGE002
，根据预设目标位姿建立预设目标点坐标系
Figure 943986DEST_PATH_IMAGE003
；根据所述的虚拟目标点创建虚拟目标位姿；根据所述的虚拟目标位姿在所述的预设目标点坐标系
Figure 808037DEST_PATH_IMAGE003
下的位移和角度的坐标，以及当前位姿在预设目标点坐标系
Figure 825672DEST_PATH_IMAGE003
下的位移和角度的坐标，得到当前位姿与虚拟目标位姿的相对位姿关系，基于标识和预设目标位姿得到目标直线，提取在与目标直线垂直方向上当前位姿与虚拟目标位姿的偏差位移。
作为优选，所述的根据所述的虚拟目标位姿在所述的预设目标点坐标系
Figure 116976DEST_PATH_IMAGE003
下的位移和角度的坐标包括：基于所述的虚拟目标位姿建立虚拟目标点坐标系
Figure 99188DEST_PATH_IMAGE004
，根据所述的虚拟目标点坐标系
Figure 766930DEST_PATH_IMAGE004
与预设目标点坐标系
Figure 701388DEST_PATH_IMAGE003
坐标系的坐标轴原点的位移和坐标轴的角度偏差，计算所述的虚拟目标位姿和预设目标位姿的相对位姿关系。
作为优选，所述的基于所述的虚拟目标位姿建立虚拟目标点坐标系
Figure 163593DEST_PATH_IMAGE004
包括：根据在所述的标识坐标系
Figure 386764DEST_PATH_IMAGE001
下所述的标识与预设目标点坐标系
Figure 841885DEST_PATH_IMAGE003
原点的向量关系
Figure 834112DEST_PATH_IMAGE005
，和在标识坐标系
Figure 936060DEST_PATH_IMAGE001
下所述的标识与标识坐标系Z轴方向上距离预设目标点单位向量所取得的点P的向量关系
Figure 895795DEST_PATH_IMAGE006
，以及所述的预设目标点坐标系
Figure 170918DEST_PATH_IMAGE003
与所述的标识坐标系
Figure 17652DEST_PATH_IMAGE001
的转换关系，得到在预设目标点坐标系
Figure 821660DEST_PATH_IMAGE003
下的虚拟目标位姿在目标直线方向的单位向量
Figure 3111DEST_PATH_IMAGE007
，记为虚拟目标点坐标系的坐标轴Y轴；根据垂直于地面的方向取单位向量，记为虚拟目标点坐标系的坐标轴Z轴；基于空间直角坐标系原则，得到与所述的目标直线垂直的目标位姿坐标系的坐标轴X轴。
本发明公开了一种伺服控制的处理器，其用于调用程序代码，当所述程序代码被执行时，所述处理器用于执行以下操作：确定预设目标位姿 ；获取至少一个标识，得到当前位姿；根据预设目标位姿和当前位姿的相对位姿关系，确定偏移角度；基于标识和预设目标位姿得到目标直线，根据所述的目标直线和当前位姿的相对位姿关系，确定偏移位移；根据所述偏移位移和偏移角度进行伺服控制。
作为优选，所述的处理器，还用于基于所述的标识建立标识坐标系
Figure 613084DEST_PATH_IMAGE001
，得到当前位姿在标识坐标系
Figure 314324DEST_PATH_IMAGE001
下的位移和角度坐标。
作为优选，所述的处理器，以预设规则间隔性获取至少同一标识，在每一预设规则间隔内根据所述的标识得到当前时刻的当前位姿，获取控制指令；利用在每一预设规则间隔内获取的控制指令对当前位姿进行伺服控制。
作为优选，所述的处理器，还用于根据所述的预设目标位姿在标识坐标系
Figure 554812DEST_PATH_IMAGE001
下的姿态，以及所述的当前位姿在标识坐标系
Figure 708713DEST_PATH_IMAGE001
下的姿态，得到预设目标位姿和当前位姿之间的相对位姿关系，提取偏移角度。
作为优选，所述的处理器，还用于基于所述的预设目标位姿的位移坐标创建虚拟目标点
Figure 312257DEST_PATH_IMAGE002
，根据预设目标位姿建立预设目标点坐标系
Figure 133583DEST_PATH_IMAGE003
；根据所述的虚拟目标点创建虚拟目标位姿；根据所述的虚拟目标位姿在所述的预设目标点坐标系
Figure 544973DEST_PATH_IMAGE003
下的位移和角度的坐标，以及当前位姿在预设目标点坐标系
Figure 451749DEST_PATH_IMAGE003
下的位移和角度的坐标，得到当前位姿与虚拟目标位姿的相对位姿关系，基于标识和预设目标位姿得到目标直线，提取在与目标直线垂直方向上当前位姿与虚拟目标位姿的偏差位移。
作为优选，所述的处理器，还用于基于所述的虚拟目标位姿建立虚拟目标点坐标系
Figure 403524DEST_PATH_IMAGE004
，根据所述的虚拟目标点坐标系
Figure 328624DEST_PATH_IMAGE004
与预设目标点坐标系
Figure 910915DEST_PATH_IMAGE003
坐标系的坐标轴原点的位移和坐标轴的角度偏差，计算所述的虚拟目标位姿和预设目标位姿的相对位姿关系。
作为优选，所述的处理器，还用于根据在所述的标识坐标系
Figure 304987DEST_PATH_IMAGE001
下所述的标识与预设目标点坐标系
Figure 732557DEST_PATH_IMAGE003
原点的向量关系
Figure 777743DEST_PATH_IMAGE005
，和在标识坐标系
Figure 265356DEST_PATH_IMAGE001
下所述的标识与标识坐标系Z轴方向上距离预设目标点单位向量所取得的点P的向量关系
Figure 943462DEST_PATH_IMAGE006
，以及所述的预设目标点坐标系
Figure 440302DEST_PATH_IMAGE003
与所述的标识坐标系
Figure 90726DEST_PATH_IMAGE001
的转换关系，得到在预设目标点坐标系
Figure 264088DEST_PATH_IMAGE003
下的虚拟目标位姿在目标直线方向的单位向量
Figure 101594DEST_PATH_IMAGE007
，记为虚拟目标点坐标系的坐标轴Y轴；根据垂直于地面的方向取单位向量，记为虚拟目标点坐标系的坐标轴Z轴；基于空间直角坐标系原则，得到与所述的目标直线垂直的目标位姿坐标系的坐标轴X轴。
一种存储介质，所述存储介质上存储有计算机指令，所述计算机指令被执行时，实现所述的一种伺服控制方法。
一种可移动平台，包括：包括采集器，用于获取标识；还包括所述的处理器，或者，所述的存储介质。
采用以上技术后，本发明与现有技术相比，具有以下优点：
本发明用于在非完整约束下，通过只计算确定偏移角度和偏移位移进行伺服控制，以使控制对象调整至目标直线上。由于调整至目标直线上，不精确到点，故本发明计算过程只计算调整角度和一个位移分量，调整方法较简单，计算量小，同时目标直线和角度约束保证了高精度。本发明克服了非全向移动底盘在调节过程中的不足。本发明忽略某个维度上的误差，利用其它自由度进行补偿，达到类似完整约束下的可三自由度快速调整位姿的全向底盘快速、精确到点效果。
附图说明
图1是本发明的流程框图。
图2是本发明的伺服控制方法示意图。
图3是本发明的方法示意图。
图4是本发明的可移动平台的结构图。
附图标识说明：1、本体，2、移动底盘，3、对接装置，4、采集器。
具体实施方式
下面结合附图和具体实施例对本发明作进一步说明。本发明可运用在可移动平台进行高精度对接的场景中，也可以运用在其他非完整约束情况下的高精度定位场景。
在可移动平台进行高精度对接场景的实施例中，可应用于如图4所述的一种可移动平台，包括采集器，用于获取标识W；还包括所述的处理器或者所述的存储介质。所述的可移动平台包括安装在本体上的对接装置和移动底盘。所述的移动底盘包括但不限于非全向移动底盘，在如图4所示的可移动平台中，采用了一种容易高频抖动的双舵轮底盘，无法灵活地朝向任意方向前进，其控制难度更大。通过本发明所阐述的方法，可以最大化地减小控制难度、缩小误差。
更具体地，所述的对接装置，为伸缩式叉臂，所述的对接装置的伸出长度可依据现场需求进行调节。所述的伸缩式叉臂上安装传感器，用以识别叉臂伸出的长度。由于伸出长度可以调节，故只需将所述的可移动平台的对接装置调整至目标直线上的一个点位，将对接装置以目标角度进行伸缩，即可实现高精度对接。计算方法简便。在如图4所示的可移动平台中，为了实现其精准对接，通过本发明所阐述的方式，可将对接装置的对接精度控制在±2mm，保证了高精度对接。
所述的采集器安装在所述的对接装置上，可以避免对接装置与所述的车体之间存在机械误差。
在具体实施过程中，将可移动平台导航至目标位姿附近，位于采集器的视野范围之内，根据标识W对可移动平台进行伺服控制，以高精度地调整至目标位姿。
如图1所示，本发明公开的一种伺服控制方法，
步骤101，确定预设目标位姿。
在本发明中，预设目标位姿可以通过示教的方式先控制可移动平台移动到目标位姿读取标识W来实现。所述的预设目标位姿，并不一定是所述的可移动平台实际到达的目标位姿，仅用以实现对偏移角度和偏移位移的计算。
步骤102，获取至少一个标识W，得到当前位姿；
其中，包括从采集器采集的标识W，所述标识W可以为二维码，或者其他可以用于定位的图案或特征。进一步的，该采集器不限于采集的角度、类型型号、采集的频率。采集器进行多次采集，以保证即时性和准确性。采集器的采集方式包括但不限于：每间隔固定的移动距离采集一次所述的标识W，并计算当前位姿。如图2所示，当前位姿用如图2中的E点示意。可基于所述的标识W建立标识坐标系，再采用建立三维坐标系并进行换算的方式，计算得到当前位姿。所述的位姿包括位置和姿态。
步骤103，根据预设目标位姿和当前位姿的相对位姿关系，确定偏移角度
Figure 136546DEST_PATH_IMAGE008
；
所述的预设目标位姿和当前位姿转换至同一三维坐标系下，可确定相差的空间角度，即相对位姿关系，确定偏移角度
Figure 907056DEST_PATH_IMAGE008
。所述的偏移角度，即可移动平台移动至目标位姿，所需要旋转的角度。
步骤104，基于标识W和预设目标位姿得到目标直线，根据所述的目标直线和当前位姿的相对位姿关系，确定偏移位移
Figure 248388DEST_PATH_IMAGE009
；
图2所示，所述的目标直线用如图2中的L示意，所述的目标直线是可移动平台最终移动到的位置的线性约束。所述的可移动平台的目标位姿处于所述的目标直线上的任一可能的位置，所述的预设目标位姿为处于所述的目标直线上的一个具体的点位。所述的目标直线和所述的当前位姿可通过读取相同的标识W得到，误差更小，精度更高。
步骤105，根据所述偏移位移
Figure 838770DEST_PATH_IMAGE009
和偏移角度
Figure 677413DEST_PATH_IMAGE008
获取控制指令。
为了进一步提升精度，可以将上述执行步骤拆分成多次执行。更具体地，以预设规则间隔性获取至少同一标识W，在每一预设规则间隔内根据所述的标识W得到当前时刻的当前位姿，获取控制指令；利用在每一预设规则间隔内获取的控制指令对当前位姿进行伺服控制。所述的预设规则间隔，可以是固定时间间隔，也可以是固定距离间隔，或者其他形式。当预设规则间隔周期越短，频率越高，被控制指令控制到达目标位姿的精度越高。
如图2所示，路径S为所述的伺服控制可能发生的实际路径，目标位姿T为所述的伺服控制可能到达的实际位姿。其实现过程通过只识别至少一个标识W，可以同时调节角度和位移，无需单独反复调试。
在步骤102中，所述的获取至少一个标识W，得到当前位姿，包括：基于所述的标识W建立标识坐标系
Figure 99167DEST_PATH_IMAGE001
，得到当前位姿在标识坐标系
Figure 365063DEST_PATH_IMAGE001
下的位移和姿态。可以采用公告号为CN110209169A，专利名称为一种可移动平台的控制方法、控制装置及可移动平台所公开的方法，计算获取。所述的标识与所述的对接装置待对接的设备之间的相对位姿关系固定不变。在本实施例中，只例举了采用一个标识的方式，同理可证存在多个标识的其他拓展方式。
在本实施例中，所述的标识W为垂直于地面设置的标识W，如此，基于所述的标识W建立的标识坐标系的Z轴
Figure 692008DEST_PATH_IMAGE010
（垂直于标识W所处平面）便与地面平行。所述的标识坐标系的Z轴
Figure 272025DEST_PATH_IMAGE010
用以计算所述的目标直线。在本实施例中，所述的标识坐标系与所述的目标直线相互平行。进一步简化了计算的难度，提高了运算效率。
在步骤103中，根据所述的根据预设目标位姿和当前位姿的相对位姿关系，确定偏移角度包括：根据所述的预设目标位姿在标识坐标系
Figure 751548DEST_PATH_IMAGE001
下的姿态，以及所述的当前位姿在标识坐标系
Figure 985083DEST_PATH_IMAGE001
下的姿态，得到预设目标位姿和当前位姿之间的相对位姿关系，提取偏移角度。
更具体地，可以采用以下方法：
由
Figure 799324DEST_PATH_IMAGE011
得
Figure 183032DEST_PATH_IMAGE012
，即当前位姿在预设目标位姿坐标系
Figure 517062DEST_PATH_IMAGE003
下的位姿，提取姿态参数，即偏移角度ΔƟ。
在步骤104中，如图3所示，所述的根据目标直线和当前位姿的相对位姿关系，确定偏移位移，包括：基于所述的预设目标位姿的位移坐标创建虚拟目标点
Figure 921498DEST_PATH_IMAGE002
，根据预设目标位姿建立预设目标点坐标系
Figure 223035DEST_PATH_IMAGE003
；根据所述的虚拟目标点创建虚拟目标位姿；根据所述的虚拟目标位姿在所述的预设目标点坐标系
Figure 941593DEST_PATH_IMAGE003
下的位移和角度的坐标，以及当前位姿在预设目标点坐标系
Figure 130129DEST_PATH_IMAGE003
下的位移和角度的坐标，得到当前位姿与虚拟目标位姿的相对位姿关系，基于标识W和预设目标位姿得到目标直线，提取在与目标直线垂直方向上当前位姿与虚拟目标位姿的偏差位移。
更具体地，可以采用以下方法：
由
Figure 908729DEST_PATH_IMAGE013
得
Figure 966071DEST_PATH_IMAGE014
,即当前位姿在虚拟目标位姿坐标系
Figure 488319DEST_PATH_IMAGE004
下的位姿，提取垂直于目标直线的位移参数，即偏移位移
Figure 796941DEST_PATH_IMAGE009
。
所述的虚拟目标点、虚拟目标位姿，是计算过程中为了便于计算所引入的中间参数。为了方便计算，在本实施例中，所述的虚拟目标点与所述的预设目标点坐标系
Figure 480863DEST_PATH_IMAGE003
的原点重合，所述的虚拟目标位姿与所述的预设目标位姿之间需旋转矩阵换算。可以理解为，虚拟目标位姿是基于二维码坐标系Z轴
Figure 756992DEST_PATH_IMAGE010
所确定的目标直线上的目标位姿的一个点位，而预设目标位姿是基于实际示教结果所得的目标位姿中的一个点位。可以理解为，所述的虚拟目标位姿是从预设目标位姿中提取了位移参数，忽略了姿态的参数，简化了计算过程。其中，所述的虚拟目标点与所述的偏差位移，是可移动平台移动至所述的目标直线的最短直线距离。
所述的根据所述的虚拟目标位姿在所述的预设目标点坐标系
Figure 614090DEST_PATH_IMAGE003
下的位移和角度的坐标，包括但不限于：基于所述的虚拟目标位姿建立虚拟目标点坐标系
Figure 777218DEST_PATH_IMAGE004
，根据所述的虚拟目标点坐标系
Figure 163200DEST_PATH_IMAGE004
与预设目标点坐标系
Figure 146200DEST_PATH_IMAGE003
坐标系的坐标轴原点的位移和坐标轴的角度偏差，计算所述的虚拟目标位姿和预设目标位姿的相对位姿关系。
其中，所述的基于所述的虚拟目标位姿建立虚拟目标点坐标系
Figure 525097DEST_PATH_IMAGE004
包括：根据在所述的标识坐标系
Figure 542732DEST_PATH_IMAGE001
下所述的标识W与预设目标点坐标系
Figure 834036DEST_PATH_IMAGE003
原点的向量关系
Figure 569911DEST_PATH_IMAGE005
，和在标识坐标系
Figure 486920DEST_PATH_IMAGE001
下所述的标识W与标识坐标系Z轴
Figure 421378DEST_PATH_IMAGE010
方向上距离预设目标点单位向量所取得的点P的向量关系
Figure 883583DEST_PATH_IMAGE006
，以及所述的预设目标点坐标系
Figure 106754DEST_PATH_IMAGE003
与所述的标识坐标系
Figure 47028DEST_PATH_IMAGE001
的转换关系，得到在预设目标点坐标系
Figure 551172DEST_PATH_IMAGE003
下的虚拟目标位姿在目标直线方向的单位向量
Figure 449858DEST_PATH_IMAGE007
，记为虚拟目标点坐标系的坐标轴Y轴；根据垂直于地面的方向取单位向量，记为虚拟目标点坐标系的坐标轴Z轴
Figure 894746DEST_PATH_IMAGE010
；基于空间直角坐标系原则，得到与所述的目标直线垂直的目标位姿坐标系的坐标轴X轴。
更具体地，可以采用以下方法：
由
Figure 435449DEST_PATH_IMAGE015
，得在预设目标点坐标系
Figure 291DEST_PATH_IMAGE003
下的虚拟目标位姿在目标直线方向的单位向量，记为
Figure 804299DEST_PATH_IMAGE007
；其中，所述的点P为标识坐标系Z轴
Figure 798800DEST_PATH_IMAGE010
方向上距离预设目标点单位向量所取得的点。
如图3所示，所述的标识坐标系Z轴
Figure 346456DEST_PATH_IMAGE010
方向与目标直线方向平行。
一种非完整约束下的伺服控制的处理器，其用于调用程序代码，当所述程序代码被执行时，所述处理器用于执行以下操作：确定预设目标位姿 ；获取至少一个标识W，得到当前位姿；根据预设目标位姿和当前位姿的相对位姿关系，确定偏移角度；基于标识W和预设目标位姿得到目标直线，根据所述的目标直线和当前位姿的相对位姿关系，确定偏移位移；根据所述偏移位移和偏移角度进行伺服控制。
作为一种实施方式，所述的处理器，还用于基于所述的标识W建立标识坐标系
Figure 47696DEST_PATH_IMAGE001
，得到当前位姿在标识坐标系
Figure 537452DEST_PATH_IMAGE001
下的位移和角度坐标。
作为一种实施方式，所述的处理器，以预设规则间隔性获取至少同一标识W，在每一预设规则间隔内根据所述的标识W得到当前时刻的当前位姿，获取控制指令；利用在每一预设规则间隔内获取的控制指令对当前位姿进行伺服控制。
作为一种实施方式，所述的处理器，还用于根据所述的预设目标位姿在标识坐标系
Figure 753669DEST_PATH_IMAGE001
下的姿态，以及所述的当前位姿在标识坐标系
Figure 105016DEST_PATH_IMAGE001
下的姿态，得到预设目标位姿和当前位姿之间的相对位姿关系，提取偏移角度。
作为一种实施方式，所述的处理器，还用于基于所述的预设目标位姿的位移坐标创建虚拟目标点
Figure 660762DEST_PATH_IMAGE002
，根据预设目标位姿建立预设目标点坐标系
Figure 72152DEST_PATH_IMAGE003
；根据所述的虚拟目标点创建虚拟目标位姿；根据所述的虚拟目标位姿在所述的预设目标点坐标系下的位移和角度的坐标，以及当前位姿在预设目标点坐标系
Figure 228196DEST_PATH_IMAGE003
下的位移和角度的坐标，得到当前位姿与虚拟目标位姿的相对位姿关系，基于标识W和预设目标位姿得到目标直线，提取在与目标直线垂直方向上当前位姿与虚拟目标位姿的偏差位移。
作为一种实施方式，所述的处理器，还用于基于所述的虚拟目标位姿建立虚拟目标点坐标系
Figure 117655DEST_PATH_IMAGE004
，根据所述的虚拟目标点坐标系
Figure 855803DEST_PATH_IMAGE004
与预设目标点坐标系
Figure 438094DEST_PATH_IMAGE003
坐标系的坐标轴原点的位移和坐标轴的角度偏差，计算所述的虚拟目标位姿和预设目标位姿的相对位姿关系。
作为一种实施方式，所述的处理器，还用于根据在所述的标识坐标系
Figure 566588DEST_PATH_IMAGE001
下所述的标识W与预设目标点坐标系
Figure 777514DEST_PATH_IMAGE003
原点的向量关系
Figure 42273DEST_PATH_IMAGE005
，和在标识坐标系
Figure 795465DEST_PATH_IMAGE001
下所述的标识W与标识坐标系Z轴
Figure 676833DEST_PATH_IMAGE010
方向上距离预设目标点单位向量所取得的点P的向量关系
Figure 422941DEST_PATH_IMAGE006
，以及所述的预设目标点坐标系
Figure 870103DEST_PATH_IMAGE003
与所述的标识坐标系
Figure 263039DEST_PATH_IMAGE001
的转换关系，得到在预设目标点坐标系
Figure 631703DEST_PATH_IMAGE003
下的虚拟目标位姿在目标直线方向的单位向量
Figure 666655DEST_PATH_IMAGE007
，记为虚拟目标点坐标系的坐标轴Y轴；根据垂直于地面的方向取单位向量，记为虚拟目标点坐标系的坐标轴Z轴
Figure 686433DEST_PATH_IMAGE010
；基于空间直角坐标系原则，得到与所述的目标直线垂直的目标位姿坐标系的坐标轴X轴。
一种存储介质，所述存储介质上存储有计算机指令，所述计算机指令被执行时，实现所述的一种伺服控制方法。
在本说明书的描述中，参考术语“一种实施方式”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一种实施方式或示例中。在本说明书中，对上述术语的示意性表述不一定指的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管上面已经示出和描述了本发明的实施例，但不能理解为是对权利要求的限制。本发明不仅限于以上实施例，其具体结构允许有变化，凡在本发明独立权利要求的保护范围内所作的各种变化均在本发明的保护范围内。

Claims (17)

1.一种伺服控制方法，其特征在于，
确定预设目标位姿；
获取至少一个标识，得到当前位姿；
根据预设目标位姿和当前位姿的相对位姿关系，确定偏移角度；
基于所述的标识和预设目标位姿得到目标直线，根据所述的目标直线和当前位姿的相对位姿关系，确定偏移位移；所述的目标直线为所述的预设目标位姿的线性约束，所述的预设目标位姿处于所述的目标直线上的任一可能的位置；
基于所述的标识和预设目标位姿得到目标直线包括：基于所述的标识建立标识坐标系，基于所述标识坐标系和预设目标位姿得到目标直线；其中，所述目标直线与所述标识坐标系平行；
根据所述偏移位移和偏移角度获取控制指令。
2.根据权利要求1所述的一种伺服控制方法，其特征在于，以预设规则间隔性获取至少同一标识，在每一预设规则间隔内根据所述的标识得到当前时刻的当前位姿，获取控制指令；利用在每一预设规则间隔内获取的控制指令对当前位姿进行伺服控制。
3.根据权利要求1所述的一种伺服控制方法，其特征在于，所述的获取至少一个标识，得到当前位姿，包括：基于所述的标识建立标识坐标系
Figure 444300DEST_PATH_IMAGE001
，得到当前位姿在标识坐标系
Figure 664716DEST_PATH_IMAGE001
下的位移和角度坐标。
4.根据权利要求1所述的一种伺服控制方法，其特征在于，其中，所述的标识为垂直于地面设置的标识。
5.根据权利要求3所述的一种伺服控制方法，其特征在于，根据所述的根据预设目标位姿和当前位姿的相对位姿关系，确定偏移角度包括：根据所述的预设目标位姿在标识坐标系
Figure 716985DEST_PATH_IMAGE001
下的姿态，以及所述的当前位姿在标识坐标系
Figure 560176DEST_PATH_IMAGE001
下的姿态，得到预设目标位姿和当前位姿之间的相对位姿关系，提取偏移角度。
6.根据权利要求3所述的一种伺服控制方法，其特征在于，所述的基于标识和预设目标位姿得到目标直线，根据所述的目标直线和当前位姿的相对位姿关系，确定偏移位移包括：基于所述的预设目标位姿的位移坐标创建虚拟目标点
Figure 279871DEST_PATH_IMAGE002
，根据预设目标位姿建立预设目标点坐标系
Figure 668258DEST_PATH_IMAGE003
；根据所述的虚拟目标点创建虚拟目标位姿；根据所述的虚拟目标位姿在所述的预设目标点坐标系
Figure 473403DEST_PATH_IMAGE003
下的位移和角度的坐标，以及当前位姿在预设目标点坐标系
Figure 854706DEST_PATH_IMAGE003
下的位移和角度的坐标，得到当前位姿与虚拟目标位姿的相对位姿关系，基于标识和预设目标位姿得到目标直线，提取在与目标直线垂直方向上当前位姿与虚拟目标位姿的偏差位移。
7.根据权利要求6所述的一种伺服控制方法，其特征在于，所述的根据所述的虚拟目标位姿在所述的预设目标点坐标系
Figure 163327DEST_PATH_IMAGE003
下的位移和角度的坐标包括：基于所述的虚拟目标位姿建立虚拟目标点坐标系
Figure 988195DEST_PATH_IMAGE004
，根据所述的虚拟目标点坐标系
Figure 15057DEST_PATH_IMAGE004
与预设目标点坐标系
Figure 200050DEST_PATH_IMAGE003
坐标系的坐标轴原点的位移和坐标轴的角度偏差，计算所述的虚拟目标位姿和预设目标位姿的相对位姿关系。
8.根据权利要求7所述的一种伺服控制方法，其特征在于，所述的基于所述的虚拟目标位姿建立虚拟目标点坐标系
Figure 363178DEST_PATH_IMAGE004
包括：根据在所述的标识坐标系
Figure 358947DEST_PATH_IMAGE001
下所述的标识与预设目标点坐标系
Figure 138685DEST_PATH_IMAGE003
原点的向量关系
Figure 861790DEST_PATH_IMAGE005
，和在标识坐标系
Figure 145004DEST_PATH_IMAGE001
下所述的标识与标识坐标系Z轴方向上距离预设目标点单位向量所取得的点P的向量关系
Figure 308744DEST_PATH_IMAGE006
，以及所述的预设目标点坐标系
Figure 44619DEST_PATH_IMAGE003
与所述的标识坐标系
Figure 571415DEST_PATH_IMAGE001
的转换关系，得到在预设目标点坐标系
Figure 709136DEST_PATH_IMAGE003
下的虚拟目标位姿在目标直线方向的单位向量
Figure 312286DEST_PATH_IMAGE007
，记为虚拟目标点坐标系的坐标轴Y轴；根据垂直于地面的方向取单位向量，记为虚拟目标点坐标系的坐标轴Z轴；基于空间直角坐标系原则，得到与所述的目标直线垂直的目标位姿坐标系的坐标轴X轴。
9.一种伺服控制的处理器，其特征在于，用于调用程序代码，当所述程序代码被执行时，所述处理器用于执行以下操作：确定预设目标位姿 ；获取至少一个标识，得到当前位姿；根据预设目标位姿和当前位姿的相对位姿关系，确定偏移角度；基于标识和预设目标位姿得到目标直线，根据所述的目标直线和当前位姿的相对位姿关系，确定偏移位移；所述的目标直线为所述的预设目标位姿的线性约束，所述的预设目标位姿处于所述的目标直线上的任一可能的位置；基于所述的标识和预设目标位姿得到目标直线包括：基于所述的标识建立标识坐标系，基于所述标识坐标系和预设目标位姿得到目标直线；其中，所述目标直线与所述标识坐标系平行；根据所述偏移位移和偏移角度进行伺服控制。
10.根据权利要求9所述的处理器，其特征在于，所述的处理器，还用于基于所述的标识建立标识坐标系
Figure 269878DEST_PATH_IMAGE001
，目标直线得到当前位姿在标识坐标系
Figure 865945DEST_PATH_IMAGE001
下的位移和角度坐标。
11.根据权利要求10所述的处理器，其特征在于，所述的处理器，以预设规则间隔性获取至少同一标识，在每一预设规则间隔内根据所述的标识得到当前时刻的当前位姿，获取控制指令；利用在每一预设规则间隔内获取的控制指令对当前位姿进行伺服控制。
12.根据权利要求10所述的处理器，其特征在于，所述的处理器，还用于根据所述的预设目标位姿在标识坐标系
Figure 858171DEST_PATH_IMAGE001
下的姿态，以及所述的当前位姿在标识坐标系
Figure 366644DEST_PATH_IMAGE001
下的姿态，得到预设目标位姿和当前位姿之间的相对位姿关系，提取偏移角度。
13.根据权利要求10所述的处理器，其特征在于，所述的处理器，还用于基于所述的预设目标位姿的位移坐标创建虚拟目标点
Figure 77111DEST_PATH_IMAGE002
，根据预设目标位姿建立预设目标点坐标系
Figure 211289DEST_PATH_IMAGE003
；根据所述的虚拟目标点创建虚拟目标位姿；根据所述的虚拟目标位姿在所述的预设目标点坐标系
Figure 58023DEST_PATH_IMAGE003
下的位移和角度的坐标，以及当前位姿在预设目标点坐标系
Figure 2976DEST_PATH_IMAGE003
下的位移和角度的坐标，得到当前位姿与虚拟目标位姿的相对位姿关系，基于标识和预设目标位姿得到目标直线，提取在与目标直线垂直方向上当前位姿与虚拟目标位姿的偏差位移。
14.根据权利要求13所述的处理器，其特征在于，所述的处理器，还用于基于所述的虚拟目标位姿建立虚拟目标点坐标系
Figure 935160DEST_PATH_IMAGE004
，根据所述的虚拟目标点坐标系
Figure 873029DEST_PATH_IMAGE004
与预设目标点坐标系
Figure 839848DEST_PATH_IMAGE003
坐标系的坐标轴原点的位移和坐标轴的角度偏差，计算所述的虚拟目标位姿和预设目标位姿的相对位姿关系。
15.根据权利要求14所述的处理器，其特征在于，所述的处理器，还用于根据在所述的标识坐标系
Figure 439193DEST_PATH_IMAGE001
下所述的标识与预设目标点坐标系
Figure 389831DEST_PATH_IMAGE003
原点的向量关系，和在标识坐标系
Figure 600233DEST_PATH_IMAGE001
下所述的标识与标识坐标系Z轴方向上距离预设目标点单位向量所取得的点P目标直线的向量关系
Figure 687137DEST_PATH_IMAGE006
，以及所述的预设目标点坐标系
Figure 442735DEST_PATH_IMAGE003
与所述的标识坐标系
Figure 474145DEST_PATH_IMAGE001
的转换关系，得到在预设目标点坐标系
Figure 629183DEST_PATH_IMAGE003
下的虚拟目标位姿在目标直线方向的单位向量
Figure 180381DEST_PATH_IMAGE007
，记为虚拟目标点坐标系的坐标轴Y轴；根据垂直于地面的方向取单位向量，记为虚拟目标点坐标系的坐标轴Z轴；基于空间直角坐标系原则，得到与所述的目标直线垂直的目标位姿坐标系的坐标轴X轴。
16.一种存储介质，其特征在于，所述存储介质上存储有计算机指令，所述计算机指令被执行时，实现权利要求1至7任一项所述的一种伺服控制方法。
17.一种可移动平台，其特征在于，包括采集器，用于获取标识；还包括根据权利要求9-15任意一项所述的处理器，或者，根据权利要求16所述的存储介质。
CN202010492674.3A 2020-06-03 2020-06-03 一种伺服控制方法、处理器、存储介质和可移动平台 Active CN111650936B (zh)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN202010492674.3A CN111650936B (zh) 2020-06-03 2020-06-03 一种伺服控制方法、处理器、存储介质和可移动平台
JP2022574677A JP7443572B2 (ja) 2020-06-03 2021-06-03 サーボ制御方法、プロセッサ、記憶媒体及び可動ステージ
PCT/CN2021/098060 WO2021244598A1 (zh) 2020-06-03 2021-06-03 伺服控制方法、处理器、存储介质和可移动平台
EP21817887.9A EP4163752A4 (en) 2020-06-03 2021-06-03 SERVO CONTROL METHOD, PROCESSOR, STORAGE MEDIUM AND MOBILE PLATFORM

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010492674.3A CN111650936B (zh) 2020-06-03 2020-06-03 一种伺服控制方法、处理器、存储介质和可移动平台

Publications (2)

Publication Number Publication Date
CN111650936A CN111650936A (zh) 2020-09-11
CN111650936B true CN111650936B (zh) 2023-01-17

Family

ID=72351204

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010492674.3A Active CN111650936B (zh) 2020-06-03 2020-06-03 一种伺服控制方法、处理器、存储介质和可移动平台

Country Status (4)

Country Link
EP (1) EP4163752A4 (zh)
JP (1) JP7443572B2 (zh)
CN (1) CN111650936B (zh)
WO (1) WO2021244598A1 (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111650936B (zh) * 2020-06-03 2023-01-17 杭州迦智科技有限公司 一种伺服控制方法、处理器、存储介质和可移动平台
CN114227699B (zh) * 2022-02-10 2024-06-11 乐聚(深圳)机器人技术有限公司 机器人动作调整方法、设备以及存储介质
CN116277007B (zh) * 2023-03-28 2023-12-19 北京维卓致远医疗科技发展有限责任公司 位姿控制方法、装置、存储介质及控制器

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0949143A2 (en) * 1998-04-10 1999-10-13 Laser Communications International, L.L.C. Method and apparatus for improved attitude determination of spacecraft
KR20130099678A (ko) * 2012-02-29 2013-09-06 부산대학교 산학협력단 가상 조향륜을 이용한 유도라인 추적 ａｇｖ의 주행 제어 장치 및 그 방법
CN103324794A (zh) * 2013-06-17 2013-09-25 杭州电子科技大学 一种三维公差标注正确性的验证方法
CN107728633A (zh) * 2017-10-23 2018-02-23 广州极飞科技有限公司 获取目标物位置信息方法及装置、移动装置及其控制方法
CN108036786A (zh) * 2017-12-01 2018-05-15 安徽优思天成智能科技有限公司 基于辅助线的位姿检测方法、装置和计算机可读存储介质
CN109976324A (zh) * 2017-12-27 2019-07-05 深圳市优必选科技有限公司 控制机器人充电的方法、机器人及计算机可读存储介质

Family Cites Families (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100773271B1 (ko) * 2006-10-25 2007-11-05 전자부품연구원 단일 카메라를 이용한 이동 로봇의 위치 측정 방법
KR100951890B1 (ko) * 2008-01-25 2010-04-12 성균관대학교산학협력단 상황 모니터링을 적용한 실시간 물체 인식 및 자세 추정 방법
JP2009244965A (ja) 2008-03-28 2009-10-22 Yaskawa Electric Corp 移動体
JP5173636B2 (ja) 2008-07-14 2013-04-03 トヨタ自動車株式会社 回転電機
US10339389B2 (en) * 2014-09-03 2019-07-02 Sharp Laboratories Of America, Inc. Methods and systems for vision-based motion estimation
US9157757B1 (en) 2014-09-03 2015-10-13 Sharp Laboratories Of America, Inc. Methods and systems for mobile-agent navigation
KR20170134350A (ko) * 2015-02-05 2017-12-06 그레이 오렌지 피티이. 엘티디. 내비게이션 제어를 위한 방법 및 장치
CN104950893A (zh) * 2015-06-26 2015-09-30 浙江大学 基于单应性矩阵的最短路径视觉伺服控制方法
US10650270B2 (en) * 2017-04-21 2020-05-12 X Development Llc Methods and systems for simultaneous localization and calibration
CN106970629B (zh) * 2017-05-22 2020-03-03 北京京东尚科信息技术有限公司 无人搬运车的控制方法和装置
CN107656523A (zh) * 2017-07-31 2018-02-02 广州维绅科技有限公司 仓储agv导航方法及装置、计算机设备及存储介质
CN107741224A (zh) * 2017-08-28 2018-02-27 浙江大学 一种基于视觉测量及标定的agv自动调姿定位方法
KR102106100B1 (ko) * 2018-02-02 2020-05-06 엘지전자 주식회사 이동 로봇
CN109333531B (zh) * 2018-10-09 2021-01-26 深圳前海达闼云端智能科技有限公司 用于规划移动设备速度的方法及装置
CN110162038A (zh) * 2019-05-07 2019-08-23 杭州迦智科技有限公司 移动控制方法、装置、存储介质及处理器
CN111984001A (zh) * 2019-05-21 2020-11-24 北京京东尚科信息技术有限公司 用于控制机器人的方法和装置
CN110209169A (zh) * 2019-06-12 2019-09-06 杭州迦智科技有限公司 一种可移动平台的控制方法、控制装置及可移动平台
CN110398963A (zh) * 2019-07-13 2019-11-01 珠海格力智能装备有限公司 无轨导航纠偏控制方法、装置、存储介质及控制器
CN110262517B (zh) * 2019-07-18 2022-05-10 石家庄辰宙智能装备有限公司 Agv系统的轨迹跟踪控制方法
CN110955245B (zh) * 2019-12-09 2021-06-08 深圳市银星智能科技股份有限公司 路径追踪方法、装置、移动机器人及非暂态计算机可读存储介质
CN110928311B (zh) * 2019-12-16 2021-11-19 哈尔滨工业大学 一种基于全景相机下直线特征的室内移动机器人导航方法
CN111650936B (zh) * 2020-06-03 2023-01-17 杭州迦智科技有限公司 一种伺服控制方法、处理器、存储介质和可移动平台
CN112184819A (zh) * 2020-10-21 2021-01-05 苏州华兴源创科技股份有限公司 机器人的引导方法、装置、计算机设备和存储介质

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0949143A2 (en) * 1998-04-10 1999-10-13 Laser Communications International, L.L.C. Method and apparatus for improved attitude determination of spacecraft
KR20130099678A (ko) * 2012-02-29 2013-09-06 부산대학교 산학협력단 가상 조향륜을 이용한 유도라인 추적 ａｇｖ의 주행 제어 장치 및 그 방법
CN103324794A (zh) * 2013-06-17 2013-09-25 杭州电子科技大学 一种三维公差标注正确性的验证方法
CN107728633A (zh) * 2017-10-23 2018-02-23 广州极飞科技有限公司 获取目标物位置信息方法及装置、移动装置及其控制方法
CN108036786A (zh) * 2017-12-01 2018-05-15 安徽优思天成智能科技有限公司 基于辅助线的位姿检测方法、装置和计算机可读存储介质
CN109976324A (zh) * 2017-12-27 2019-07-05 深圳市优必选科技有限公司 控制机器人充电的方法、机器人及计算机可读存储介质

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
Coordinated Motion Planning: Reconfiguring a Swarm of Labeled Robots with Bounded Stretch;Erik D. Demaine等;《SIAM Journal on Computing》;20191124;第48卷(第06期);1727-1762 *
Path Planning for Mobile Robots by Means of Approximate Routes;Ghaida Al Zeer等;《2007 IEEE International Conference on Control and Automation》;20071105;2468-2473 *
基于直线特征的空间非合作目标位姿视觉测量方法研究;张跃强;《中国博士学位论文全文数据库 (工程科技Ⅱ辑)》;20171115(第11期);C031-91 *
长期运行移动机器人的定位与地图构建;王越;《中国博士学位论文全文数据库 (信息科技辑)》;20160815(第08期);I140-65 *
面向井下无人机自主飞行的人工路标辅助位姿估计方法;单春艳等;《煤炭学报》;20190815;387-398 *

Also Published As

Publication number Publication date
WO2021244598A1 (zh) 2021-12-09
JP7443572B2 (ja) 2024-03-05
CN111650936A (zh) 2020-09-11
EP4163752A4 (en) 2024-06-12
EP4163752A1 (en) 2023-04-12
JP2023528897A (ja) 2023-07-06

Similar Documents

Publication Publication Date Title
CN111650936B (zh) 一种伺服控制方法、处理器、存储介质和可移动平台
US10695910B2 (en) Automatic calibration method for robot system
CN108748159B (zh) 一种机械臂工具坐标系自标定方法
US9457470B2 (en) Robot system and method for calibration
CN113001535B (zh) 机器人工件坐标系自动校正系统与方法
US10525597B2 (en) Robot and robot system
US20200298411A1 (en) Method for the orientation of an industrial robot, and industrial robot
CN107214692B (zh) 机器人系统的自动标定方法
WO2020055903A9 (en) Robot calibration for ar and digital twin
CN104690551A (zh) 一种机器人自动化装配系统
CN110450150B (zh) 轨迹跟踪控制方法及轨迹跟踪系统
JP2006110705A (ja) ロボットのキャリブレーション方法
CN103512511A (zh) 一种基于激光跟踪仪的大型面自动化测量方法
CN113352345B (zh) 快换装置的更换系统、方法、装置、电子设备及存储介质
CN115752507A (zh) 基于二维码导航的在线单舵轮agv参数标定方法及系统
CN114654466B (zh) 自动标定方法、装置、系统、电子设备及存储介质
US7925382B2 (en) Robot controller and robot control method
CN108073163B (zh) 利用二维码反馈值补偿确定机器人精确位置的控制方法
CN109311163B (zh) 校正机器人的运动控制命令的方法及其相关设备
CN110456729B (zh) 一种轨迹跟踪控制方法及轨迹跟踪系统
CN114526740A (zh) 基于自然物体的单目自动驾驶导航方法、系统及装置
CN114102595B (zh) 一种机器人标定方法、标定组件及存储介质
Zhang et al. Robot Position Control Based on Uncalibrated Visual Servo
CN113442145B (zh) 欠约束下的最优位姿确定方法、装置、存储介质及机械臂
CN116061162A (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
CB03 Change of inventor or designer information

Inventor after: Sun Yichao

Inventor after: Dai Shuwei

Inventor after: Wu Haoxian

Inventor after: Liu Feng

Inventor before: Wang Yue

Inventor before: Sun Yichao

Inventor before: Dai Shuwei

Inventor before: Wu Haoxian

Inventor before: Liu Feng

CB03 Change of inventor or designer information
GR01 Patent grant
GR01 Patent grant