[go: up one dir, main page]

CN112147994A - Robot and recharging control method and device thereof - Google Patents

Robot and recharging control method and device thereof Download PDF

Info

Publication number
CN112147994A
CN112147994A CN201910575121.1A CN201910575121A CN112147994A CN 112147994 A CN112147994 A CN 112147994A CN 201910575121 A CN201910575121 A CN 201910575121A CN 112147994 A CN112147994 A CN 112147994A
Authority
CN
China
Prior art keywords
robot
charging pile
distance
intermediate point
charging
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
CN201910575121.1A
Other languages
Chinese (zh)
Other versions
CN112147994B (en
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.)
Shenzhen Ubtech Technology Co ltd
Original Assignee
Shenzhen Ubtech 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 Shenzhen Ubtech Technology Co ltd filed Critical Shenzhen Ubtech Technology Co ltd
Priority to CN201910575121.1A priority Critical patent/CN112147994B/en
Publication of CN112147994A publication Critical patent/CN112147994A/en
Application granted granted Critical
Publication of CN112147994B publication Critical patent/CN112147994B/en
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/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0225Control 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)

Abstract

一种机器人的回充控制方法包括:获取机器人在充电桩坐标系的位置;根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点,且在所述中间点中的一个或者多个位于所述充电桩的充电口正对方向;根据所述中间点位置、机器人位置和充电桩位置,确定多个移动路段;根据移动路段的目标位置和机器人当前位置,确定该移动路段的移动参数,根据所述移动参数控制机器人移动。在机器人移动至每个中间点时确定移动参数,可以多次根据移动参数进行对准校正,从而使得移动至充电桩位置时,能够更加准确可靠的对准充电桩进行充电。

Figure 201910575121

A method for controlling recharging of a robot includes: acquiring the position of the robot in the coordinate system of the charging pile; determining two or more between the position of the robot and the position of the charging pile according to the position of the robot in the coordinate system of the charging pile and one or more of the intermediate points are located in the opposite direction of the charging port of the charging pile; according to the position of the intermediate point, the position of the robot and the position of the charging pile, a plurality of moving sections are determined; The target position of the road section and the current position of the robot determine the movement parameters of the moving road section, and control the movement of the robot according to the movement parameters. When the robot moves to each intermediate point, the movement parameters are determined, and the alignment and correction can be performed according to the movement parameters for many times, so that when the robot moves to the position of the charging pile, it can be more accurately and reliably aligned with the charging pile for charging.

Figure 201910575121

Description

一种机器人及其回充控制方法和装置A robot and its recharging control method and device

技术领域technical field

本申请属于机器人领域,尤其涉及一种机器人及其回充控制方法和装置。The present application belongs to the field of robots, and in particular, relates to a robot and a method and device for controlling its recharging.

背景技术Background technique

移动机器人,包括服务机器人,巡检机器人等,都需要使用自动回充技术。当机器人完成任务,或者电量低于一定值时,机器人通过自动回充技术登录充电桩进行充电。机器人在使用自动回充技术时,首先通过定位技术寻找周围的充电桩,然后导航至充电桩前方,登陆充电桩并接通电源。Mobile robots, including service robots, inspection robots, etc., all need to use automatic recharging technology. When the robot completes the task or the power is lower than a certain value, the robot logs into the charging pile for charging through the automatic recharging technology. When the robot uses the automatic recharging technology, it first finds the surrounding charging piles through the positioning technology, then navigates to the front of the charging pile, logs in the charging pile and connects to the power supply.

在机器人导航至充电桩前方时,由于受到运动误差和里程计的反馈误差的影响,机器人移动至充电桩时存在一定的偏差,不利于准确可靠的与充电桩对准充电。When the robot navigates to the front of the charging pile, due to the influence of the motion error and the feedback error of the odometer, there is a certain deviation when the robot moves to the charging pile, which is not conducive to accurate and reliable charging with the charging pile.

发明内容SUMMARY OF THE INVENTION

有鉴于此,本申请实施例提供了个种机器人及其回充控制方法和装置,以解决现有技术中机器人移动至充电桩时会存在一定的偏差,不利于准确可靠的与充电桩对准充电的问题。In view of this, the embodiments of the present application provide various robots and their recharging control methods and devices, so as to solve the problem that there is a certain deviation when the robot moves to the charging pile in the prior art, which is not conducive to accurate and reliable alignment with the charging pile charging problem.

本申请实施例的第一方面提供了一种机器人的回充控制方法,所述机器人的回充控制方法包括:A first aspect of the embodiments of the present application provides a method for controlling recharging of a robot, and the method for controlling recharging of a robot includes:

获取机器人在充电桩坐标系的位置;Get the position of the robot in the coordinate system of the charging pile;

根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点,且在所述中间点中的一个或者多个位于所述充电桩的充电口正对方向;According to the position of the robot in the charging pile coordinate system, two or more intermediate points are determined between the robot position and the charging pile position, and one or more of the intermediate points are located in the charging pile. The charging port of the pile is facing the direction;

根据所述中间点位置、机器人位置和充电桩位置,确定多个移动路段;According to the position of the intermediate point, the position of the robot and the position of the charging pile, determine a plurality of moving sections;

根据移动路段的目标位置和机器人当前位置,确定该移动路段的移动参数,根据所述移动参数控制机器人移动。According to the target position of the moving section and the current position of the robot, the moving parameters of the moving section are determined, and the robot is controlled to move according to the moving parameters.

结合第一方面,在第一方面的第一种可能实现方式中,所述根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点的步骤包括:With reference to the first aspect, in a first possible implementation manner of the first aspect, according to the position of the robot in the charging pile coordinate system, two or more are determined between the robot position and the charging pile position The steps for the intermediate point include:

根据所述机器人在与充电桩坐标系的位置,确定机器人与充电桩之间的距离;Determine the distance between the robot and the charging pile according to the position of the robot in the coordinate system with the charging pile;

根据预先设定的距离与中间点个数的对应关系,查找所述机器人与充电桩之间的距离所对应的中间点个数。According to the correspondence between the preset distance and the number of intermediate points, the number of intermediate points corresponding to the distance between the robot and the charging pile is searched.

结合第一方面,在第一方面的第二种可能实现方式中,所述根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点的步骤包括:With reference to the first aspect, in a second possible implementation manner of the first aspect, according to the position of the robot in the charging pile coordinate system, two or more are determined between the robot position and the charging pile position The steps for the intermediate point include:

将确定了数量的中间点设置在所述充电桩的充电口正对方向;Set the determined number of intermediate points in the direction opposite to the charging port of the charging pile;

根据相邻中间点的距离,机器人与其最近中间点的距离,以及充电桩与其最近中间点的距离的均衡性,确定所述中间点的位置。The position of the intermediate point is determined according to the distance between adjacent intermediate points, the distance between the robot and its nearest intermediate point, and the balance of the distance between the charging pile and its nearest intermediate point.

结合第一方面,在第一方面的第三种可能实现方式中,所述根据移动路段的目标位置和机器人当前位置,确定该移动路段的移动参数的步骤包括:With reference to the first aspect, in a third possible implementation manner of the first aspect, the step of determining the movement parameters of the moving section according to the target position of the moving section and the current position of the robot includes:

根据机器人当前指向,以及机器人当前位置和目标位置的指向,确定机器人的第一转角;Determine the first turning angle of the robot according to the current pointing of the robot, as well as the pointing of the current position of the robot and the target position;

根据机器人当前位置和所述目标位置,确定机器人的第一距离。The first distance of the robot is determined according to the current position of the robot and the target position.

结合第一方面,在第一方面的第四种可能实现方式中,所述根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点的步骤包括:With reference to the first aspect, in a fourth possible implementation manner of the first aspect, according to the position of the robot in the charging pile coordinate system, two or more are determined between the robot position and the charging pile position The steps for the intermediate point include:

获取机器人完成充电时的中间点个数、机器人与充电桩之间的距离与对准率的对应关系;Obtain the number of intermediate points when the robot completes charging, the corresponding relationship between the distance between the robot and the charging pile and the alignment rate;

根据所述对应关系,选择大于预定阈值的对准率所对应的中间点个数。According to the corresponding relationship, the number of intermediate points corresponding to the alignment ratio greater than the predetermined threshold is selected.

本申请实施例的第二方面提供了一种机器人的回充控制装置,所述机器人的回充控制装置包括:A second aspect of the embodiments of the present application provides a recharging control device for a robot, and the recharging control device for the robot includes:

位置获取单元,用于获取机器人在充电桩坐标系的位置;The position acquisition unit is used to acquire the position of the robot in the coordinate system of the charging pile;

中间点确定单元,用于根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点,且在所述中间点中的一个或者多个位于所述充电桩的充电口正对方向;an intermediate point determination unit, configured to determine two or more intermediate points between the robot position and the charging pile position according to the position of the robot in the charging pile coordinate system, and one of the intermediate points is Or a plurality of charging ports located in the opposite direction of the charging pile;

移动路段确定单元,用于根据所述中间点位置、机器人位置和充电桩位置,确定多个移动路段;a moving road segment determining unit, configured to determine a plurality of moving road segments according to the position of the intermediate point, the robot location and the charging pile location;

移动参数确定单元,用于根据移动路段的目标位置和机器人当前位置,确定该移动路段的移动参数,根据所述移动参数控制机器人移动。The movement parameter determination unit is configured to determine the movement parameters of the movement section according to the target position of the movement section and the current position of the robot, and control the movement of the robot according to the movement parameters.

结合第二方面,在第二方面的第一种可能实现方式中,所述中间点确定单元包括:With reference to the second aspect, in a first possible implementation manner of the second aspect, the intermediate point determining unit includes:

距离确定子单元,用于根据所述机器人在与充电桩坐标系的位置,确定机器人与充电桩之间的距离;a distance determination sub-unit for determining the distance between the robot and the charging pile according to the position of the robot in the coordinate system with the charging pile;

中间点确定子单元,用于根据预先设定的距离与中间点个数的对应关系,查找所述机器人与充电桩之间的距离所对应的中间点个数。The intermediate point determination sub-unit is used for finding the number of intermediate points corresponding to the distance between the robot and the charging pile according to the corresponding relationship between the preset distance and the number of intermediate points.

结合第二方面,在第二方面的第二种可能实现方式中,所述中间点确定单元包括:With reference to the second aspect, in a second possible implementation manner of the second aspect, the intermediate point determining unit includes:

中间点设置子单元,用于将确定了数量的中间点设置在所述充电桩的充电口正对方向;an intermediate point setting subunit, used for setting the determined number of intermediate points in the direction opposite to the charging port of the charging pile;

中间点位置确定子单元,用于根据相邻中间点的距离,机器人与其最近中间点的距离,以及充电桩与其最近中间点的距离的均衡性,确定所述中间点的位置。The intermediate point position determination subunit is used to determine the position of the intermediate point according to the distance between adjacent intermediate points, the distance between the robot and its closest intermediate point, and the balance of the distance between the charging pile and its closest intermediate point.

本申请实施例的第三方面提供了一种机器人,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如第一方面任一项所述机器人的回充控制方法的步骤。A third aspect of the embodiments of the present application provides a robot, including a memory, a processor, and a computer program stored in the memory and executable on the processor, which is implemented when the processor executes the computer program The steps of the recharging control method for a robot according to any one of the first aspects.

本申请实施例的第四方面提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现如第一方面任一项所述机器人的回充控制方法的步骤。A fourth aspect of the embodiments of the present application provides a computer-readable storage medium, where the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, implements the robot according to any one of the first aspects The steps of the recharge control method.

本申请实施例与现有技术相比存在的有益效果是:通过获取机器人在充电桩坐标系的位置,并根据该位置确定两个或者两个以上的,位于充电桩的充电口正对的方向的中间点,在机器人移动至每个中间点时确定移动参数,可以多次根据移动参数进行对准校正,从而使得移动至充电桩位置时,能够更加准确可靠的对准充电桩进行充电。Compared with the prior art, the embodiment of the present application has the beneficial effect of obtaining the position of the robot in the coordinate system of the charging pile, and determining two or more according to the position, which are located in the direction opposite to the charging port of the charging pile When the robot moves to each intermediate point, the movement parameters are determined, and the alignment and correction can be performed according to the movement parameters for many times, so that when moving to the position of the charging pile, the charging pile can be more accurately and reliably aligned for charging.

附图说明Description of drawings

为了更清楚地说明本申请实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。In order to illustrate the technical solutions in the embodiments of the present application more clearly, the following briefly introduces the accompanying drawings that need to be used in the description of the embodiments or the prior art. Obviously, the drawings in the following description are only for the present application. In some embodiments, for those of ordinary skill in the art, other drawings can also be obtained according to these drawings without any creative effort.

图1是本申请实施例提供的一种机器人的回充控制的实现流程示意图;FIG. 1 is a schematic flowchart of the implementation of recharging control of a robot provided by an embodiment of the present application;

图2是本申请实施例提供的一种充电桩坐标系示意图;2 is a schematic diagram of a charging pile coordinate system provided by an embodiment of the present application;

图3是本申请实施例提供的一种确定中间点个数方法的实现流程示意图;FIG. 3 is a schematic diagram of the implementation flow of a method for determining the number of intermediate points provided by an embodiment of the present application;

图4是本申请实施例提供的一种确定中间点位置方法的实现流程示意图;FIG. 4 is a schematic diagram of an implementation flow of a method for determining a position of an intermediate point provided by an embodiment of the present application;

图5是本申请实施例提供的一种中间点的位置分布示意图;5 is a schematic diagram of the position distribution of an intermediate point provided by an embodiment of the present application;

图6为本申请实施例提供的一种移动参数示意图;FIG. 6 is a schematic diagram of a movement parameter provided by an embodiment of the present application;

图7为本申请实施例提供的一种机器人的回充控制装置的示意图;FIG. 7 is a schematic diagram of a recharging control device for a robot according to an embodiment of the present application;

图8是本申请实施例提供的机器人的示意图。FIG. 8 is a schematic diagram of a robot provided by an embodiment of the present application.

具体实施方式Detailed ways

以下描述中,为了说明而不是为了限定,提出了诸如特定系统结构、技术之类的具体细节,以便透彻理解本申请实施例。然而,本领域的技术人员应当清楚,在没有这些具体细节的其它实施例中也可以实现本申请。在其它情况中,省略对众所周知的系统、装置、电路以及方法的详细说明,以免不必要的细节妨碍本申请的描述。In the following description, for the purpose of illustration rather than limitation, specific details such as a specific system structure and technology are set forth in order to provide a thorough understanding of the embodiments of the present application. However, it will be apparent to those skilled in the art that the present application may be practiced in other embodiments without these specific details. In other instances, detailed descriptions of well-known systems, devices, circuits, and methods are omitted so as not to obscure the description of the present application with unnecessary detail.

为了说明本申请所述的技术方案,下面通过具体实施例来进行说明。In order to illustrate the technical solutions described in the present application, the following specific embodiments are used for description.

图1为本申请实施例提供的一种机器人的回充控制方法的实现流程示意图,详述如下:FIG. 1 is a schematic diagram of the implementation flow of a method for controlling recharging of a robot according to an embodiment of the present application, which is described in detail as follows:

在步骤S101中,获取机器人在充电桩坐标系的位置;In step S101, the position of the robot in the charging pile coordinate system is obtained;

具体的,本申请所述机器人,可以通过无线通讯的方式,查找机器人当前场景中的充电桩,选择所需要充电的充电桩后,确定充电桩相对于所述机器人的位置。Specifically, the robot described in the present application can search for the charging pile in the current scene of the robot by means of wireless communication, and after selecting the charging pile to be charged, determine the position of the charging pile relative to the robot.

可以根据充电桩的位置为圆点,建立充电桩坐标系,如图2所示,所述充电桩坐标系为X’O’Y’,所述机器人坐标系为XOY。所述充电桩坐标系的其中一条轴的方向可以设置为充电桩的充电进出方向。通过建立充电桩坐标系后,可以方便根据机器人的坐标位置和朝向,更加高效准确的计算机器人的移动距离和转动方向,从而有利于提高机器人的旋转和移动的控制效率。A charging pile coordinate system can be established according to the position of the charging pile as a dot, as shown in Figure 2, the charging pile coordinate system is X'O'Y', and the robot coordinate system is XOY. The direction of one of the axes of the charging pile coordinate system may be set as the charging in and out direction of the charging pile. After establishing the charging pile coordinate system, it is convenient to calculate the moving distance and rotation direction of the robot more efficiently and accurately according to the coordinate position and orientation of the robot, thereby improving the control efficiency of the robot's rotation and movement.

在步骤S102中,根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点,且在所述中间点中的一个或者多个位于所述充电桩的充电口正对方向;In step S102, according to the position of the robot in the charging pile coordinate system, two or more intermediate points are determined between the robot position and the charging pile position, and one or more intermediate points are One is located in the opposite direction of the charging port of the charging pile;

在所述机器人位置和充电桩位置之间确定两个或两个以上的中间点时,可以包括确定中间点的个数和确定中间点的位置两个步骤。其中,确定所述中间点的个数时,可以如图3所示,包括:When two or more intermediate points are determined between the robot position and the charging pile position, two steps of determining the number of intermediate points and determining the positions of the intermediate points may be included. Wherein, when determining the number of the intermediate points, as shown in Figure 3, including:

在步骤S301中,根据所述机器人在与充电桩坐标系的位置,确定机器人与充电桩之间的距离;In step S301, the distance between the robot and the charging pile is determined according to the position of the robot in the coordinate system with the charging pile;

由于机器人在完成任务时,或者检测到电量需要回充时,机器人所在的位置与充电桩位置之间的距离会有不同。可以根据充电桩的位置与机器人位置,确定机器人与充电桩之间的距离,并根据该确定来确定中间点个数。When the robot completes the task or detects that the battery needs to be recharged, the distance between the robot's location and the charging pile location will be different. The distance between the robot and the charging pile can be determined according to the position of the charging pile and the position of the robot, and the number of intermediate points can be determined according to the determination.

在步骤S302中,根据预先设定的距离与中间点个数的对应关系,查找所述机器人与充电桩之间的距离所对应的中间点个数。In step S302, the number of intermediate points corresponding to the distance between the robot and the charging pile is searched according to the preset correspondence between the distance and the number of intermediate points.

可以根据机器人在移动过程中产生较小误差的有效距离作为划分所述中间点个数的依据,使得机器人根据多个产生误差较小的有效距离。在确定所述有效距离后,对所述机器人与充电桩之间的距离进行划分,得到所需要的中间点的个数。The number of the intermediate points can be divided according to the effective distances at which the robot generates small errors during the moving process, so that the robot can generate effective distances with small errors according to a plurality of effective distances. After the effective distance is determined, the distance between the robot and the charging pile is divided to obtain the required number of intermediate points.

或者,也可以根据预先设定的距离阈值,建立距离范围与中间点个数的对应关系,从而可以根据该对应关系,快速的查找机器人与充电桩之间的距离所在的距离范围,从而确定需要的中间点个数。Alternatively, the corresponding relationship between the distance range and the number of intermediate points can also be established according to the preset distance threshold, so that the distance range between the robot and the charging pile can be quickly found according to the corresponding relationship, so as to determine the required distance. the number of intermediate points.

图3只是一种中间点个数的确定方法,还可以根据统计得到的中间点个数、机器人与充电桩之间的距离与对准率的对应关系,选择对准率大于预定阈值时的中间点个数,从而可以根据选择的中间点个数,进一步提高充电对准精度,提高充电效率。Figure 3 is only a method for determining the number of intermediate points. According to the number of intermediate points obtained by statistics, the corresponding relationship between the distance between the robot and the charging pile and the alignment rate, the middle point when the alignment rate is greater than a predetermined threshold can be selected. Therefore, according to the selected number of intermediate points, the charging alignment accuracy can be further improved, and the charging efficiency can be improved.

在确定了中间点个数后,可以根据图4所述的中间点设置方法,来确定所述中间点的位置,包括:After the number of intermediate points is determined, the position of the intermediate point can be determined according to the intermediate point setting method shown in FIG. 4 , including:

在步骤S401中,将确定了数量的中间点设置在所述充电桩的充电口正对方向;In step S401, the determined number of intermediate points are set in the direction opposite to the charging port of the charging pile;

当所述机器人到所述充电桩的充电口方向所在直线的距离较小,比如小于预定的距离时,可以将所述中间点全部设置在所述充电口方向所在直线上。本申请中,所述充电口正对方向,即为机器人可以根据该方向移动并完成有效的对准充电的方向。所述中间点设置在充电桩的充电口正对方向时,可以通过多个位于所述充电口正对方向的中间点对所述机器人进行调整,从而有利于提高机器人的对准精度。When the distance from the robot to the straight line in the direction of the charging port of the charging pile is small, for example, less than a predetermined distance, all the intermediate points may be set on the straight line in the direction of the charging port. In this application, the charging port is facing the direction, that is, the direction in which the robot can move according to this direction and complete effective alignment charging. When the intermediate point is set in the direction facing the charging port of the charging pile, the robot can be adjusted through a plurality of intermediate points located in the facing direction of the charging port, thereby helping to improve the alignment accuracy of the robot.

在步骤S402中,根据相邻中间点的距离,机器人与其最近中间点的距离,以及充电桩与其最近中间点的距离的均衡性,确定所述中间点的位置。In step S402, the position of the intermediate point is determined according to the distance between adjacent intermediate points, the distance between the robot and its closest intermediate point, and the balance of the distance between the charging pile and its closest intermediate point.

如图5所示,可以根据全部位于充电口正对方向的中间点point2、point3和point4,调整中间点之间的距离,并使得调整后的相邻的两个中间点的距离,与距离充电桩最近的中间点到充电桩的距离,以及距离机器人最近的中间点到机器人point1的距离均衡,从而使得机器人可以在多个有效的距离范围内,对机器人进行调整,减少机器人出现对准误差的机率。当然,可选的实施方式中,充电桩与其最接近的中间点之间的距离可以选择较小值。As shown in Figure 5, the distance between the intermediate points can be adjusted according to the intermediate points point2, point3 and point4 that are all located in the opposite direction of the charging port, so that the adjusted distance between the two adjacent intermediate points is the same as the distance charging The distance from the nearest middle point of the pile to the charging pile, and the distance from the nearest middle point to the robot to the point1 of the robot are balanced, so that the robot can adjust the robot within multiple effective distances and reduce the alignment error of the robot. chance. Of course, in an optional embodiment, the distance between the charging pile and its closest intermediate point can be selected as a smaller value.

当然,可选的实施方式中,如果机器人距离充电桩的充电口正对方向所在直线的距离较远时,可以取不局限于各个移动路段的距离完全相等,可以取机器人移动至所述充电口正对方向所在直线的垂线段,或者其它指定角度的线段,作为机器移动至第一中间点的路线。对于剩余下的中间点之间,以及中间点至充电桩的路段,则可以平均划分的方式来确定中间点的位置。Of course, in an optional embodiment, if the distance between the robot and the straight line where the charging port of the charging pile is facing is relatively far, the distance of each moving road section may not be limited to be completely equal, and the robot may be moved to the charging port. The vertical line segment of the straight line where the facing direction is located, or other line segments with a specified angle, is used as the route for the machine to move to the first intermediate point. For the road sections between the remaining intermediate points and between the intermediate points and the charging piles, the position of the intermediate points can be determined by dividing them equally.

在步骤S103中,根据所述中间点位置、机器人位置和充电桩位置,确定多个移动路段;In step S103, according to the position of the intermediate point, the position of the robot and the position of the charging pile, a plurality of moving road sections are determined;

在确定了机器人移动至充电桩过程中的多个中间点位置后,可以根据机器人与其最近的中间点确定一个移动路段,以及,可以根据相邻的两个中间点,或最靠近充电桩的中间点与充电桩来确定多个移动路段。After determining the positions of multiple intermediate points in the process of the robot moving to the charging pile, a moving section can be determined according to the robot and its nearest intermediate point, and, according to the two adjacent intermediate points, or the center closest to the charging pile Points and charging piles to determine multiple moving segments.

值得注意的是,本申请所确定的移动路段,与机器人实际运行的移动路段,会再现较小的误差,包括如轨迹误差,或者机器人的旋转角度的误差等。因此,在所述充电桩的充电口正对方向,对所述机器人进行多次误差校正,从而有利于提高充电对准精度的提高。It is worth noting that the moving sections determined in this application and the moving sections actually operated by the robot will reproduce small errors, including trajectory errors or errors in the rotation angle of the robot. Therefore, in the direction facing the charging port of the charging pile, the robot is subjected to multiple error corrections, thereby helping to improve the accuracy of charging alignment.

在步骤S104中,根据移动路段的目标位置和机器人当前位置,确定该移动路段的移动参数,根据所述移动参数控制机器人移动。In step S104, according to the target position of the moving section and the current position of the robot, the moving parameters of the moving section are determined, and the robot is controlled to move according to the moving parameters.

在机器人从初始位置移动至第一中间点,或者从第一中间点移动至第二中间点,或者从第N中间点移动至充电桩时,可以确定如图6所示的移动参数,第一转角、第一距离和第二转角,其中:When the robot moves from the initial position to the first intermediate point, or moves from the first intermediate point to the second intermediate point, or moves from the Nth intermediate point to the charging pile, the movement parameters shown in Figure 6 can be determined. Corner, first distance, and second corner, where:

根据机器人当前指向,以及机器人当前位置和目标位置的指向,确定机器人的第一转角;Determine the first turning angle of the robot according to the current pointing of the robot, as well as the pointing of the current position of the robot and the target position;

根据机器人当前位置和所述目标位置,确定机器人的第一距离。The first distance of the robot is determined according to the current position of the robot and the target position.

如图6所示,机器人由点A移动至点B时,根据点A和点B的连线所确定的指向,确定所述机器人需要转动的第一角度theta1,根据点A与点B的距离确定机器人按照调整了第一角度后移动第一距离,As shown in Figure 6, when the robot moves from point A to point B, the first angle theta1 that the robot needs to rotate is determined according to the direction determined by the connection line between point A and point B, and according to the distance between point A and point B Make sure that the robot moves the first distance after adjusting the first angle,

然后根据移动了所述第一距离后,根据机器人当前的朝向,以及机器人的下一目标位置,重新调整机器人的朝向theta2,继续完成下一移动路段的移动,直到机器人到达充电桩位置,并可以根据充电桩位置,进一步调整所述机器人的朝向,提高机器人对准精度。Then, after moving the first distance, according to the current orientation of the robot and the next target position of the robot, re-adjust the robot's orientation theta2, and continue to complete the movement of the next moving section until the robot reaches the charging pile position, and can According to the position of the charging pile, the orientation of the robot is further adjusted to improve the alignment accuracy of the robot.

应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本申请实施例的实施过程构成任何限定。It should be understood that the size of the sequence numbers of the steps in the above embodiments does not mean the sequence of execution, and the execution sequence of each process should be determined by its function and internal logic, and should not constitute any limitation to the implementation process of the embodiments of the present application.

图7为本申请实施例提供的一种机器人的回充控制装置的结构示意图,详述如下:FIG. 7 is a schematic structural diagram of a recharging control device for a robot provided by an embodiment of the present application, which is described in detail as follows:

所述机器人的回充控制装置包括:The recharging control device of the robot includes:

位置获取单元701,用于获取机器人在充电桩坐标系的位置;a position obtaining unit 701, used for obtaining the position of the robot in the coordinate system of the charging pile;

中间点确定单元702,用于根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点,且在所述中间点中的一个或者多个位于所述充电桩的充电口正对方向;An intermediate point determining unit 702 is configured to determine two or more intermediate points between the robot position and the charging pile position according to the position of the robot in the charging pile coordinate system, and the intermediate point among the intermediate points is One or more charging ports located in the opposite direction of the charging pile;

移动路段确定单元703,用于根据所述中间点位置、机器人位置和充电桩位置,确定多个移动路段;a moving road segment determining unit 703, configured to determine a plurality of moving road segments according to the position of the intermediate point, the robot location and the charging pile location;

移动参数确定单元704,用于根据移动路段的目标位置和机器人当前位置,确定该移动路段的移动参数,根据所述移动参数控制机器人移动。The movement parameter determination unit 704 is configured to determine the movement parameters of the movement section according to the target position of the movement section and the current position of the robot, and control the movement of the robot according to the movement parameters.

优选的,所述中间点确定单元包括:Preferably, the intermediate point determining unit includes:

距离确定子单元,用于根据所述机器人在与充电桩坐标系的位置,确定机器人与充电桩之间的距离;a distance determination sub-unit for determining the distance between the robot and the charging pile according to the position of the robot in the coordinate system with the charging pile;

中间点确定子单元,用于根据预先设定的距离与中间点个数的对应关系,查找所述机器人与充电桩之间的距离所对应的中间点个数。The intermediate point determination sub-unit is used for finding the number of intermediate points corresponding to the distance between the robot and the charging pile according to the corresponding relationship between the preset distance and the number of intermediate points.

优选的,所述中间点确定单元包括:Preferably, the intermediate point determining unit includes:

中间点设置子单元,用于将确定了数量的中间点设置在所述充电桩的充电口正对方向;an intermediate point setting subunit, used for setting the determined number of intermediate points in the direction opposite to the charging port of the charging pile;

中间点位置确定子单元,用于根据相邻中间点的距离,机器人与其最近中间点的距离,以及充电桩与其最近中间点的距离的均衡性,确定所述中间点的位置。The intermediate point position determination subunit is used to determine the position of the intermediate point according to the distance between adjacent intermediate points, the distance between the robot and its closest intermediate point, and the balance of the distance between the charging pile and its closest intermediate point.

图7所述机器人的回充控制装置,与图1所述的机器人的回充控制方法对应。The recharging control device of the robot shown in FIG. 7 corresponds to the recharging control method of the robot shown in FIG. 1 .

图8是本申请一实施例提供的机器人的示意图。如图8所示,该实施例的机器人8包括:处理器80、存储器81以及存储在所述存储器81中并可在所述处理器80上运行的计算机程序82,例如机器人的回充控制程序。所述处理器80执行所述计算机程序82时实现上述各个机器人的回充控制方法实施例中的步骤。或者,所述处理器80执行所述计算机程序82时实现上述各装置实施例中各模块/单元的功能。FIG. 8 is a schematic diagram of a robot provided by an embodiment of the present application. As shown in FIG. 8 , the robot 8 of this embodiment includes: a processor 80 , a memory 81 , and a computer program 82 stored in the memory 81 and executable on the processor 80 , such as a recharging control program of the robot . When the processor 80 executes the computer program 82, the steps in the above-mentioned embodiments of the recharging control method for each robot are implemented. Alternatively, when the processor 80 executes the computer program 82, the functions of the modules/units in the above-mentioned device embodiments are implemented.

示例性的,所述计算机程序82可以被分割成一个或多个模块/单元,所述一个或者多个模块/单元被存储在所述存储器81中,并由所述处理器80执行,以完成本申请。所述一个或多个模块/单元可以是能够完成特定功能的一系列计算机程序指令段,该指令段用于描述所述计算机程序82在所述机器人8中的执行过程。例如,所述计算机程序82可以被分割成:Exemplarily, the computer program 82 may be divided into one or more modules/units, and the one or more modules/units are stored in the memory 81 and executed by the processor 80 to complete the this application. The one or more modules/units may be a series of computer program instruction segments capable of performing specific functions, and the instruction segments are used to describe the execution process of the computer program 82 in the robot 8 . For example, the computer program 82 can be divided into:

位置获取单元,用于获取机器人在充电桩坐标系的位置;The position acquisition unit is used to acquire the position of the robot in the coordinate system of the charging pile;

中间点确定单元,用于根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点,且在所述中间点中的一个或者多个位于所述充电桩的充电口正对方向;an intermediate point determination unit, configured to determine two or more intermediate points between the robot position and the charging pile position according to the position of the robot in the charging pile coordinate system, and one of the intermediate points is Or a plurality of charging ports located in the opposite direction of the charging pile;

移动路段确定单元,用于根据所述中间点位置、机器人位置和充电桩位置,确定多个移动路段;a moving road segment determining unit, configured to determine a plurality of moving road segments according to the position of the intermediate point, the robot location and the charging pile location;

移动参数确定单元,用于根据移动路段的目标位置和机器人当前位置,确定该移动路段的移动参数,根据所述移动参数控制机器人移动。The movement parameter determination unit is configured to determine the movement parameters of the movement section according to the target position of the movement section and the current position of the robot, and control the movement of the robot according to the movement parameters.

所述机器人可包括,但不仅限于,处理器80、存储器81。本领域技术人员可以理解,图8仅仅是机器人8的示例,并不构成对机器人8的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件,例如所述机器人还可以包括输入输出设备、网络接入设备、总线等。The robot may include, but is not limited to, a processor 80 and a memory 81 . Those skilled in the art can understand that FIG. 8 is only an example of the robot 8, and does not constitute a limitation to the robot 8. It may include more or less components than the one shown in the figure, or combine some components, or different components, such as The robot may also include input and output devices, network access devices, buses, and the like.

所称处理器80可以是中央处理单元(Central Processing Unit,CPU),还可以是其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现成可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。The so-called processor 80 may be a central processing unit (Central Processing Unit, CPU), and may also be other general-purpose processors, digital signal processors (Digital Signal Processors, DSP), application specific integrated circuits (Application Specific Integrated Circuit, ASIC), Off-the-shelf programmable gate array (Field-Programmable Gate Array, FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, and the like. A general purpose processor may be a microprocessor or the processor may be any conventional processor or the like.

所述存储器81可以是所述机器人8的内部存储单元,例如机器人8的硬盘或内存。所述存储器81也可以是所述机器人8的外部存储设备,例如所述机器人8上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。进一步地,所述存储器81还可以既包括所述机器人8的内部存储单元也包括外部存储设备。所述存储器81用于存储所述计算机程序以及所述机器人所需的其他程序和数据。所述存储器81还可以用于暂时地存储已经输出或者将要输出的数据。The memory 81 may be an internal storage unit of the robot 8 , such as a hard disk or a memory of the robot 8 . The memory 81 may also be an external storage device of the robot 8, such as a plug-in hard disk, a smart memory card (Smart Media Card, SMC), a secure digital (Secure Digital, SD) card equipped on the robot 8, Flash card (Flash Card) and so on. Further, the memory 81 may also include both an internal storage unit of the robot 8 and an external storage device. The memory 81 is used to store the computer program and other programs and data required by the robot. The memory 81 can also be used to temporarily store data that has been output or will be output.

所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,仅以上述各功能单元、模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能单元、模块完成,即将所述装置的内部结构划分成不同的功能单元或模块,以完成以上描述的全部或者部分功能。实施例中的各功能单元、模块可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中,上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。另外,各功能单元、模块的具体名称也只是为了便于相互区分,并不用于限制本申请的保护范围。上述系统中单元、模块的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。Those skilled in the art can clearly understand that, for the convenience and simplicity of description, only the division of the above-mentioned functional units and modules is used as an example for illustration. In practical applications, the above-mentioned functions can be allocated to different functional units, Module completion, that is, dividing the internal structure of the device into different functional units or modules to complete all or part of the functions described above. Each functional unit and module in the embodiment may be integrated in one processing unit, or each unit may exist physically alone, or two or more units may be integrated into one unit, and the above-mentioned integrated units may adopt hardware. It can also be realized in the form of software functional units. In addition, the specific names of the functional units and modules are only for the convenience of distinguishing from each other, and are not used to limit the protection scope of the present application. For the specific working processes of the units and modules in the above-mentioned system, reference may be made to the corresponding processes in the foregoing method embodiments, which will not be repeated here.

在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述或记载的部分,可以参见其它实施例的相关描述。In the foregoing embodiments, the description of each embodiment has its own emphasis. For parts that are not described or described in detail in a certain embodiment, reference may be made to the relevant descriptions of other embodiments.

本领域普通技术人员可以意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、或者计算机软件和电子硬件的结合来实现。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本申请的范围。Those of ordinary skill in the art can realize that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, or a combination of computer software and electronic hardware. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Skilled artisans may implement the described functionality using different methods for each particular application, but such implementations should not be considered beyond the scope of this application.

在本申请所提供的实施例中,应该理解到,所揭露的装置/终端设备和方法,可以通过其它的方式实现。例如,以上所描述的装置/终端设备实施例仅仅是示意性的,例如,所述模块或单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通讯连接可以是通过一些接口,装置或单元的间接耦合或通讯连接,可以是电性,机械或其它的形式。In the embodiments provided in this application, it should be understood that the disclosed apparatus/terminal device and method may be implemented in other manners. For example, the apparatus/terminal device embodiments described above are only illustrative. For example, the division of the modules or units is only a logical function division. In actual implementation, there may be other division methods, such as multiple units. Or components may be combined or may be integrated into another system, or some features may be omitted, or not implemented. On the other hand, the shown or discussed mutual coupling or direct coupling or communication connection may be through some interfaces, indirect coupling or communication connection of devices or units, and may be in electrical, mechanical or other forms.

所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。The units described as separate components may or may not be physically separated, and components displayed as units may or may not be physical units, that is, may be located in one place, or may be distributed to multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution in this embodiment.

另外,在本申请各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, or each unit may exist physically alone, or two or more units may be integrated into one unit. The above-mentioned integrated units may be implemented in the form of hardware, or may be implemented in the form of software functional units.

所述集成的模块/单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本申请实现上述实施例方法中的全部或部分流程,也可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一计算机可读存储介质中,该计算机程序在被处理器执行时,可实现上述各个方法实施例的步骤。其中,所述计算机程序包括计算机程序代码,所述计算机程序代码可以为源代码形式、对象代码形式、可执行文件或某些中间形式等。所述计算机可读介质可以包括:能够携带所述计算机程序代码的任何实体或装置、记录介质、U盘、移动硬盘、磁碟、光盘、计算机存储器、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、电载波信号、电信信号以及软件分发介质等。需要说明的是,所述计算机可读介质包含的内容可以根据司法管辖区内立法和专利实践的要求进行适当的增减,例如在某些司法管辖区,根据立法和专利实践,计算机可读介质不包括是电载波信号和电信信号。The integrated modules/units, if implemented in the form of software functional units and sold or used as independent products, may be stored in a computer-readable storage medium. Based on this understanding, the present application can implement all or part of the processes in the methods of the above embodiments, and can also be completed by instructing the relevant hardware through a computer program. The computer program can be stored in a computer-readable storage medium, and the computer When the program is executed by the processor, the steps of the foregoing method embodiments can be implemented. Wherein, the computer program includes computer program code, and the computer program code may be in the form of source code, object code, executable file or some intermediate form, and the like. The computer-readable medium may include: any entity or device capable of carrying the computer program code, a recording medium, a U disk, a removable hard disk, a magnetic disk, an optical disk, a computer memory, a read-only memory (ROM, Read-Only Memory) , Random Access Memory (RAM, Random Access Memory), electric carrier signal, telecommunication signal and software distribution medium, etc. It should be noted that the content contained in the computer-readable media may be appropriately increased or decreased according to the requirements of legislation and patent practice in the jurisdiction, for example, in some jurisdictions, according to legislation and patent practice, the computer-readable media Excluded are electrical carrier signals and telecommunication signals.

以上所述实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施例技术方案的精神和范围,均应包含在本申请的保护范围之内。The above-mentioned embodiments are only used to illustrate the technical solutions of the present application, but not to limit them; although the present application has been described in detail with reference to the above-mentioned embodiments, those of ordinary skill in the art should understand that: it can still be used for the above-mentioned implementations. The technical solutions described in the examples are modified, or some technical features thereof are equivalently replaced; and these modifications or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions in the embodiments of the application, and should be included in the within the scope of protection of this application.

Claims (10)

1.一种机器人的回充控制方法,其特征在于,所述机器人的回充控制方法包括:1. a recharge control method of a robot is characterized in that, the recharge control method of the robot comprises: 获取机器人在充电桩坐标系的位置;Get the position of the robot in the coordinate system of the charging pile; 根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点,且在所述中间点中的一个或者多个位于所述充电桩的充电口正对方向;According to the position of the robot in the charging pile coordinate system, two or more intermediate points are determined between the robot position and the charging pile position, and one or more of the intermediate points are located in the charging pile. The charging port of the pile is facing the direction; 根据所述中间点位置、机器人位置和充电桩位置,确定多个移动路段;According to the position of the intermediate point, the position of the robot and the position of the charging pile, determine a plurality of moving sections; 根据移动路段的目标位置和机器人当前位置,确定该移动路段的移动参数,根据所述移动参数控制机器人移动。According to the target position of the moving section and the current position of the robot, the moving parameters of the moving section are determined, and the robot is controlled to move according to the moving parameters. 2.根据权利要求1所述的机器人的回充控制方法,其特征在于,所述根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点的步骤包括:2 . The recharging control method for a robot according to claim 1 , wherein, according to the position of the robot in the charging pile coordinate system, two or two are determined between the robot position and the charging pile position. 3 . The steps for more than one intermediate point include: 根据所述机器人在与充电桩坐标系的位置,确定机器人与充电桩之间的距离;Determine the distance between the robot and the charging pile according to the position of the robot in the coordinate system with the charging pile; 根据预先设定的距离与中间点个数的对应关系,查找所述机器人与充电桩之间的距离所对应的中间点个数。According to the correspondence between the preset distance and the number of intermediate points, the number of intermediate points corresponding to the distance between the robot and the charging pile is searched. 3.根据权利要求1所述的机器人的回充控制方法,其特征在于,所述根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点的步骤包括:3 . The recharging control method for a robot according to claim 1 , wherein, according to the position of the robot in the charging pile coordinate system, two or two are determined between the robot position and the charging pile position. 4 . The steps for more than one intermediate point include: 将确定了数量的中间点设置在所述充电桩的充电口正对方向;Set the determined number of intermediate points in the direction opposite to the charging port of the charging pile; 根据相邻中间点的距离,机器人与其最近中间点的距离,以及充电桩与其最近中间点的距离的均衡性,确定所述中间点的位置。The position of the intermediate point is determined according to the distance between adjacent intermediate points, the distance between the robot and its nearest intermediate point, and the balance of the distance between the charging pile and its nearest intermediate point. 4.根据权利要求1所述的机器人的回充控制方法,其特征在于,所述根据移动路段的目标位置和机器人当前位置,确定该移动路段的移动参数的步骤包括:4. The recharging control method of a robot according to claim 1, wherein the step of determining the movement parameters of the moving road section according to the target position of the moving road section and the current position of the robot comprises: 根据机器人当前指向,以及机器人当前位置和目标位置的指向,确定机器人的第一转角;Determine the first turning angle of the robot according to the current pointing of the robot, as well as the pointing of the current position of the robot and the target position; 根据机器人当前位置和所述目标位置,确定机器人的第一距离。The first distance of the robot is determined according to the current position of the robot and the target position. 5.根据权利要求1所述的机器人的回充控制方法,其特征在于,所述根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点的步骤包括:5 . The recharging control method for a robot according to claim 1 , wherein, according to the position of the robot in the charging pile coordinate system, two or two are determined between the robot position and the charging pile position. 6 . The steps for more than one intermediate point include: 获取机器人完成充电时的中间点个数、机器人与充电桩之间的距离与对准率的对应关系;Obtain the number of intermediate points when the robot completes charging, the corresponding relationship between the distance between the robot and the charging pile and the alignment rate; 根据所述对应关系,选择大于预定阈值的对准率所对应的中间点个数。According to the corresponding relationship, the number of intermediate points corresponding to the alignment ratio greater than the predetermined threshold is selected. 6.一种机器人的回充控制装置,其特征在于,所述机器人的回充控制装置包括:6. A recharging control device for a robot, wherein the recharging control device for the robot comprises: 位置获取单元,用于获取机器人在充电桩坐标系的位置;The position acquisition unit is used to acquire the position of the robot in the coordinate system of the charging pile; 中间点确定单元,用于根据所述机器人在充电桩坐标系的位置,在所述机器人位置和充电桩位置之间确定两个或者两个以上的中间点,且在所述中间点中的一个或者多个位于所述充电桩的充电口正对方向;an intermediate point determination unit, configured to determine two or more intermediate points between the robot position and the charging pile position according to the position of the robot in the charging pile coordinate system, and one of the intermediate points is Or a plurality of charging ports located in the opposite direction of the charging pile; 移动路段确定单元,用于根据所述中间点位置、机器人位置和充电桩位置,确定多个移动路段;a moving road segment determination unit, configured to determine a plurality of moving road segments according to the position of the intermediate point, the robot location and the charging pile location; 移动参数确定单元,用于根据移动路段的目标位置和机器人当前位置,确定该移动路段的移动参数,根据所述移动参数控制机器人移动。The movement parameter determination unit is configured to determine the movement parameters of the movement section according to the target position of the movement section and the current position of the robot, and control the movement of the robot according to the movement parameters. 7.根据权利要求6所述的机器人的回充控制装置,其特征在于,所述中间点确定单元包括:7. The recharging control device for a robot according to claim 6, wherein the intermediate point determining unit comprises: 距离确定子单元,用于根据所述机器人在与充电桩坐标系的位置,确定机器人与充电桩之间的距离;a distance determination sub-unit for determining the distance between the robot and the charging pile according to the position of the robot in the coordinate system with the charging pile; 中间点确定子单元,用于根据预先设定的距离与中间点个数的对应关系,查找所述机器人与充电桩之间的距离所对应的中间点个数。The intermediate point determination sub-unit is used for finding the number of intermediate points corresponding to the distance between the robot and the charging pile according to the corresponding relationship between the preset distance and the number of intermediate points. 8.根据权利要求6所述的机器人的回充控制装置,其特征在于,所述中间点确定单元包括:8. The recharging control device for a robot according to claim 6, wherein the intermediate point determining unit comprises: 中间点设置子单元,用于将确定了数量的中间点设置在所述充电桩的充电口正对方向;an intermediate point setting subunit, used for setting the determined number of intermediate points in the direction opposite to the charging port of the charging pile; 中间点位置确定子单元,用于根据相邻中间点的距离,机器人与其最近中间点的距离,以及充电桩与其最近中间点的距离的均衡性,确定所述中间点的位置。The intermediate point position determination subunit is used to determine the position of the intermediate point according to the distance between adjacent intermediate points, the distance between the robot and its closest intermediate point, and the balance of the distance between the charging pile and its closest intermediate point. 9.一种机器人,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至5任一项所述机器人的回充控制方法的步骤。9. A robot comprising a memory, a processor and a computer program stored in the memory and running on the processor, wherein the processor implements the computer program as claimed in claim 1 when the processor executes the computer program Steps of any one of the steps of the recharging control method of the robot described in to 5. 10.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至5任一项所述机器人的回充控制方法的步骤。10. A computer-readable storage medium storing a computer program, characterized in that, when the computer program is executed by a processor, the robot according to any one of claims 1 to 5 is implemented to perform a return operation. The steps of the charging control method.
CN201910575121.1A 2019-06-28 2019-06-28 Robot and recharging control method and device thereof Active CN112147994B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910575121.1A CN112147994B (en) 2019-06-28 2019-06-28 Robot and recharging control method and device thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910575121.1A CN112147994B (en) 2019-06-28 2019-06-28 Robot and recharging control method and device thereof

Publications (2)

Publication Number Publication Date
CN112147994A true CN112147994A (en) 2020-12-29
CN112147994B CN112147994B (en) 2024-06-14

Family

ID=73869393

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910575121.1A Active CN112147994B (en) 2019-06-28 2019-06-28 Robot and recharging control method and device thereof

Country Status (1)

Country Link
CN (1) CN112147994B (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113138596A (en) * 2021-03-31 2021-07-20 深圳市优必选科技股份有限公司 Robot automatic charging method, system, terminal device and storage medium
CN113359777A (en) * 2021-07-20 2021-09-07 山东新一代信息产业技术研究院有限公司 Automatic pile returning and charging method and system for robot
CN113459852A (en) * 2021-09-01 2021-10-01 北京智行者科技有限公司 Path planning method and device and mobile tool
CN113703456A (en) * 2021-08-30 2021-11-26 山东新一代信息产业技术研究院有限公司 Automatic pile returning and charging method of robot based on multiple sensors

Citations (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005078383A (en) * 2003-08-29 2005-03-24 Sony Corp Guiding system and guiding method, robot device and its control method, and charging device
US20060247849A1 (en) * 2005-04-27 2006-11-02 Proxemics, Inc. Wayfinding
KR20110027972A (en) * 2009-09-11 2011-03-17 성균관대학교산학협력단 Position Error Estimation and Correction Method of Mobile Robot Using Hall Sensor
CN102018481A (en) * 2009-09-11 2011-04-20 德国福维克控股公司 Method for operating a cleaning robot
CN103022586A (en) * 2012-12-21 2013-04-03 深圳先进技术研究院 Automatic charging method and system for AGV
CN107092264A (en) * 2017-06-21 2017-08-25 北京理工大学 Towards the service robot autonomous navigation and automatic recharging method of bank's hall environment
CN107390685A (en) * 2017-07-14 2017-11-24 深圳市优必选科技有限公司 Robot recharging control method, robot and robot system
CN107462869A (en) * 2017-06-27 2017-12-12 深圳市优必选科技有限公司 Robot recharging alignment method, robot, system and storage medium
CN107577236A (en) * 2017-09-27 2018-01-12 上海有个机器人有限公司 Robot automatic homing charging method, robot, system and storage medium
WO2018028361A1 (en) * 2016-08-09 2018-02-15 深圳光启合众科技有限公司 Charging method, apparatus, and device for robot
US20180056801A1 (en) * 2016-09-01 2018-03-01 Powerhydrant Llc Robotic Charger Alignment
CN107943054A (en) * 2017-12-20 2018-04-20 北京理工大学 Automatic recharging method based on robot
WO2018077164A1 (en) * 2016-10-28 2018-05-03 北京进化者机器人科技有限公司 Method and system for enabling robot to automatically return for charging
CN109066861A (en) * 2018-08-20 2018-12-21 四川超影科技有限公司 Intelligent inspection robot charging controller method based on machine vision
CN109141398A (en) * 2018-07-28 2019-01-04 江苏苏宁物流有限公司 A kind of unmanned plane paths planning method and device for logistics
CN109345697A (en) * 2018-08-31 2019-02-15 成都越凡创新科技有限公司 Vending machine recharges air navigation aid automatically
CN109407675A (en) * 2018-12-19 2019-03-01 珠海市微半导体有限公司 The barrier-avoiding method and chip and autonomous mobile robot of robot time seat
CN109648602A (en) * 2018-09-11 2019-04-19 深圳优地科技有限公司 Automatic recharging method, device and terminal device
CN109828280A (en) * 2018-11-29 2019-05-31 亿嘉和科技股份有限公司 A kind of localization method and autonomous charging of robots method based on three-dimensional laser grid

Patent Citations (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005078383A (en) * 2003-08-29 2005-03-24 Sony Corp Guiding system and guiding method, robot device and its control method, and charging device
US20060247849A1 (en) * 2005-04-27 2006-11-02 Proxemics, Inc. Wayfinding
KR20110027972A (en) * 2009-09-11 2011-03-17 성균관대학교산학협력단 Position Error Estimation and Correction Method of Mobile Robot Using Hall Sensor
CN102018481A (en) * 2009-09-11 2011-04-20 德国福维克控股公司 Method for operating a cleaning robot
CN103022586A (en) * 2012-12-21 2013-04-03 深圳先进技术研究院 Automatic charging method and system for AGV
WO2018028361A1 (en) * 2016-08-09 2018-02-15 深圳光启合众科技有限公司 Charging method, apparatus, and device for robot
US20180056801A1 (en) * 2016-09-01 2018-03-01 Powerhydrant Llc Robotic Charger Alignment
WO2018077164A1 (en) * 2016-10-28 2018-05-03 北京进化者机器人科技有限公司 Method and system for enabling robot to automatically return for charging
CN107092264A (en) * 2017-06-21 2017-08-25 北京理工大学 Towards the service robot autonomous navigation and automatic recharging method of bank's hall environment
CN107462869A (en) * 2017-06-27 2017-12-12 深圳市优必选科技有限公司 Robot recharging alignment method, robot, system and storage medium
CN107390685A (en) * 2017-07-14 2017-11-24 深圳市优必选科技有限公司 Robot recharging control method, robot and robot system
CN107577236A (en) * 2017-09-27 2018-01-12 上海有个机器人有限公司 Robot automatic homing charging method, robot, system and storage medium
CN107943054A (en) * 2017-12-20 2018-04-20 北京理工大学 Automatic recharging method based on robot
CN109141398A (en) * 2018-07-28 2019-01-04 江苏苏宁物流有限公司 A kind of unmanned plane paths planning method and device for logistics
CN109066861A (en) * 2018-08-20 2018-12-21 四川超影科技有限公司 Intelligent inspection robot charging controller method based on machine vision
CN109345697A (en) * 2018-08-31 2019-02-15 成都越凡创新科技有限公司 Vending machine recharges air navigation aid automatically
CN109648602A (en) * 2018-09-11 2019-04-19 深圳优地科技有限公司 Automatic recharging method, device and terminal device
CN109828280A (en) * 2018-11-29 2019-05-31 亿嘉和科技股份有限公司 A kind of localization method and autonomous charging of robots method based on three-dimensional laser grid
CN109407675A (en) * 2018-12-19 2019-03-01 珠海市微半导体有限公司 The barrier-avoiding method and chip and autonomous mobile robot of robot time seat

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113138596A (en) * 2021-03-31 2021-07-20 深圳市优必选科技股份有限公司 Robot automatic charging method, system, terminal device and storage medium
CN113138596B (en) * 2021-03-31 2024-09-17 深圳市优必选科技股份有限公司 Robot automatic charging method, system, terminal equipment and storage medium
CN113359777A (en) * 2021-07-20 2021-09-07 山东新一代信息产业技术研究院有限公司 Automatic pile returning and charging method and system for robot
CN113703456A (en) * 2021-08-30 2021-11-26 山东新一代信息产业技术研究院有限公司 Automatic pile returning and charging method of robot based on multiple sensors
CN113459852A (en) * 2021-09-01 2021-10-01 北京智行者科技有限公司 Path planning method and device and mobile tool

Also Published As

Publication number Publication date
CN112147994B (en) 2024-06-14

Similar Documents

Publication Publication Date Title
CN112147994A (en) Robot and recharging control method and device thereof
CN109974727B (en) Robot charging method and device and robot
US10852139B2 (en) Positioning method, positioning device, and robot
WO2019184179A1 (en) Method and device for controlling movement of autonomous mobile machine, machine and storage medium
WO2021115331A1 (en) Triangulation-based coordinate positioning method, apparatus, and device and storage medium
US10875178B2 (en) Motion target direction angle obtaining method, apparatus and robot using the same
CN112330752B (en) Multi-camera joint calibration method, device, terminal equipment and readable storage medium
CN109807885B (en) Visual calibration method and device for manipulator and intelligent terminal
WO2018205276A1 (en) Motion trajectory smooth transition method and device and related equipment
CN111288995B (en) Route planning method and route planning device of mobile robot and terminal equipment
CN111380532A (en) Path planning method, device, terminal and computer storage medium
CN112148017B (en) Error calibration method and device, electronic equipment and storage medium
CN105509748B (en) Robot navigation method and device
CN110039548A (en) Control method, device and equipment for assembling machine
CN109564417A (en) The interpolating method and relevant device of Spline Path
CN107263469A (en) mechanical arm posture compensation method, device, storage medium and mechanical arm
CN117798933B (en) Dynamic following method and device for machine tail end based on intelligent robot
CN111504335B (en) Map construction method and device, electronic equipment and storage medium
CN116424279B (en) Posture adjustment method, posture adjustment device, control equipment and storage medium
CN112223281A (en) Robot and its positioning method and device
CN116038698B (en) Robot guiding method and device, electronic equipment and storage medium
CN112847340B (en) Control method, control device and robot
CN113137730B (en) Air supply control method, device and computer readable storage medium
CN115338872A (en) Gluing robot pose calculation method, device, equipment and storage medium
CN111628040B (en) A battery interconnection method, system and solar battery interconnection device

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