WO2023103326A1 - Control method, robot, robot charging base, and computer-readable storage medium - Google Patents

Control method, robot, robot charging base, and computer-readable storage medium Download PDF

Info

Publication number
WO2023103326A1
WO2023103326A1 PCT/CN2022/099744 CN2022099744W WO2023103326A1 WO 2023103326 A1 WO2023103326 A1 WO 2023103326A1 CN 2022099744 W CN2022099744 W CN 2022099744W WO 2023103326 A1 WO2023103326 A1 WO 2023103326A1
Authority
WO
WIPO (PCT)
Prior art keywords
robot
charging
charging stand
control method
preset
Prior art date
Application number
PCT/CN2022/099744
Other languages
French (fr)
Chinese (zh)
Inventor
唐旋来
杨亚运
李通
Original Assignee
上海擎朗智能科技有限公司
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 上海擎朗智能科技有限公司 filed Critical 上海擎朗智能科技有限公司
Publication of WO2023103326A1 publication Critical patent/WO2023103326A1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions

Definitions

  • the present invention generally relates to the technical field of robot control, in particular to a robot control method, a robot, a robot charging stand and a computer-readable storage medium.
  • the intelligent level of robots is getting higher and higher, and the application fields are getting wider and wider.
  • the application scenarios of most robots are relatively fixed, such as delivery robots, storage robots, tour robots, etc., all of which move within a predetermined area.
  • the usual method is to set up a charging stand at a fixed position in a predetermined area.
  • the robot is controlled to go to the charging stand to charge itself, but it is necessary to ensure that the robot and the charging stand are fully connected before charging.
  • the alignment of the charging interface is accurate.
  • the existing robot automatic charging scheme generally adopts infrared positioning technology, and installs an infrared transmitting or receiving module on the charging stand.
  • the robot starts the function of automatically searching for the charging stand. Search in spiral mode, or during the operation of the robot, continuously adjust the forward direction according to the running direction and the position of the charging pile, and finally realize the accurate alignment between the robot and the charging stand.
  • this method requires additional hardware support.
  • the corresponding infrared emitting device and infrared receiving device are installed on the structure of the robot and the charging stand, and the infrared emitting device and the infrared receiving device have a single function and are only used for alignment between the robot and the charging stand. Identifying and occupying the limited space inside the robot increases the complexity of the structural design and the cost of product production.
  • the present invention provides a robot control method, which realizes accurate alignment between the robot and the charging stand without additional sensors, simplifies the internal structure of the robot and the charging stand, and reduces the production process. Cost, optimize the control method for automatic charging of the robot.
  • the present invention also provides a robot and a charging stand for the robot, using the aforementioned robot control method to realize alignment connection and charge the robot.
  • the present invention also includes a computer-readable storage medium for storing and executing the aforementioned robot control method.
  • the robot is controlled to move to the charging base, and the charging slot of the robot is aligned with the charging interface of the charging base.
  • control method further includes: controlling the robot to move to the first H preset point, and then using the sensor of the robot to scan and determine the positioning surface of the charging stand, wherein the first preset point is the same as The distance between the charging base is not greater than a first preset distance.
  • the step of controlling the movement of the robot to the charging stand further includes:
  • the robot is controlled to move to the charging stand along the positioning line.
  • the first preset point is set on the positioning line.
  • the step of controlling the movement of the robot to the charging stand further includes:
  • the robot is controlled to move to the charging stand along the positioning line.
  • the step of controlling the robot to move to the charging stand along the positioning line further includes: controlling the robot to move to a second preset point or controlling the robot to move to a distance not greater than the first When the two preset distances are reached, the robot is controlled to rotate until its charging slot is aligned with the charging interface.
  • control method further includes: identifying a figure that conforms to the characteristics of the positioning surface according to the results of the sensor scanning, and confirming that The specific position and specific direction of the charging stand relative to the robot.
  • the step of confirming the specific position and specific direction of the charging base relative to the robot further includes:
  • segment the point cloud data of the charging stand According to the sensor data, segment the point cloud data of the charging stand
  • the posture of the charging base relative to the robot coordinate system is obtained by calculation method, and the relative distance and azimuth angle between the robot and the charging base are calculated.
  • control method further includes judging whether the remaining power of the robot is lower than the preset power, and when the remaining power of the robot is lower than the preset power, controlling the robot to go to the charging stand, when the robot is set in the active area When there are multiple charging stations, the robot is controlled to go to the idle charging station with the shortest movement distance.
  • a robot includes:
  • a main body a battery is arranged in the main body, and the battery supplies energy for the operation of the robot;
  • the driving device is arranged on the main body and can be controlled to drive the robot to move;
  • a charging slot, the charging slot is arranged on the main body and is configured to be powered by an external power supply to the battery;
  • the senor is disposed on the body, the sensor is configured to scan the environment around the robot;
  • control system is arranged on the main body, and communicates with the driving device and the sensor, and the control system is configured to execute the above-mentioned control method.
  • a robot charging stand includes:
  • a fixed seat, the fixed seat is fixedly connected to the ground and/or wall of the robot activity area;
  • a charging interface the charging interface is arranged on the fixed seat, the charging interface is configured to be able to cooperate with the charging slot, and supply power to the robot through the charging slot;
  • a positioning surface the positioning surface is arranged on the fixing seat, the positioning surface has preset structural features and/or optical features, and the positional relationship between the positioning surface and the charging interface is fixed.
  • a computer-readable storage medium includes computer-executable commands stored thereon, and the executable commands implement the aforementioned control method when executed by a processor.
  • the embodiment of the present invention provides a robot control method, which uses the sensor of the robot to achieve accurate alignment between the robot and the charging stand.
  • the sensor is an essential device for the robot without adding additional structures
  • the device simplifies the internal structure of the robot and the charging stand, reduces the cost of manufacturing, optimizes the control method of the automatic charging of the robot, achieves a one-time alignment success, and reduces the number of times the robot adjusts its direction.
  • the embodiment of the present invention also provides a robot and a robot charging stand, relying on the aforementioned control method, the robot is controlled to identify, locate and dock the charging stand, so as to realize the robot completely autonomously positioning and charging.
  • Embodiments of the present invention also include a computer-readable storage medium for storing and executing the aforementioned control method.
  • Fig. 1 is a schematic flow sheet of an embodiment of the present invention
  • Fig. 2 is a schematic flow chart when the first preset point is not on the positioning line in one embodiment of the present invention
  • Fig. 3 is a schematic flow diagram when the first preset point is located on the positioning line in one embodiment of the present invention.
  • Fig. 4 is a detailed flow diagram of an embodiment of the present invention.
  • Fig. 5 is a schematic flow chart of scanning and determining the charging stand in one embodiment of the present invention.
  • Fig. 6 is a schematic diagram of the motion route of the robot in one embodiment of the present invention.
  • Fig. 7 is the control block diagram of robot in one embodiment of the present invention.
  • Fig. 8 is a schematic structural view of the charging stand in an embodiment of the present invention.
  • first and second are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance or implicitly specifying the quantity of indicated technical features.
  • a feature defined as “first” or “second” may explicitly or implicitly include one or more of said features.
  • “plurality” means two or more, unless otherwise specifically defined.
  • connection should be understood in a broad sense, for example, it can be a fixed connection or a detachable connection.
  • Connected, or integrally connected it can be mechanically connected, or electrically connected, or can communicate with each other; it can be directly connected, or indirectly connected through an intermediary, and it can be the internal communication of two components or the interaction of two components relation.
  • a first feature being “on” or “under” a second feature may include that the first and second features are in direct contact, or may include the first and second features Not in direct contact but through another characteristic contact between them.
  • “above”, “above” and “above” a first feature on a second feature include that the first feature is directly above and obliquely above the second feature, or simply means that the level of the first feature is higher than that of the second feature.
  • "Below”, “below” and “under” the first feature to the second feature include that the first feature is directly above and obliquely above the second feature, or simply means that the first feature has a lower horizontal height than the second feature.
  • FIG. 1 shows a control method 100 for controlling automatic charging of a robot according to an embodiment of the present invention, which will be described in detail below with reference to FIG. 1 .
  • This embodiment is used to control the robot to move to the charging stand and charge it.
  • the robot moves in a specific area to perform tasks, such as a food delivery robot operating within the restaurant range, a storage robot operating within the warehouse range, etc.
  • the active area of the robot is the main working area, in order to ensure the battery life of the robot , it is necessary to set up a charging stand.
  • the conventional charging stand is usually arranged near the home line interface in the robot’s activity area, and is connected with the home circuit.
  • the charging stand can also be adjusted according to the specific use requirements, such as according to the location of the robot in the activity area. Different numbers of charging stations are allocated according to the degree of busyness.
  • the charging stand is provided with a positioning surface.
  • the fixed base 21 is used to support and protect the internal circuit of the charging base 2, and the charging interface 22 is arranged on the fixed base 21.
  • the installation position of the robot charging base 2 in the robot activity area can be set according to specific needs, and the charging interface should also be taken into consideration.
  • 22 cooperates with the design structure of the robot, and the fixing base 21 can be arranged on the ground and/or the wall.
  • the positioning surface 23 of the robot charging base 2 is arranged on the fixed base 21, and the positioning surface 23 has preset structural features and/or optical features, and the positional relationship between the positioning surface 23 and the charging interface 22 is fixed.
  • the positioning surface 23 is used to cooperate with the sensor of the robot to realize the purpose of positioning the charging stand 2 of the robot.
  • the specific structure or specific features of the positioning surface 23 can be determined according to the type of sensor on the robot.
  • step S101 the sensor of the robot is used to scan and determine the positioning surface of the charging stand, wherein the positioning surface has a predetermined positional relationship with the charging interface of the charging stand, for example, as shown in FIG.
  • the plane where the positioning surface 23 and the charging base 21 are located are perpendicular to each other, after obtaining the position information of the positioning surface 23, the position of the charging base can be determined according to the preset shape.
  • the sensors include lidar sensors and binocular vision sensors. Robots are generally equipped with one or both of them.
  • step S102 the distance and angle of the charging interface of the charging stand relative to the robot are obtained. Since the relative position of the positioning surface and the charging interface is fixed, after the robot obtains the position of the positioning surface by scanning, according to the positional relationship between the positioning surface and the charging interface, the positional relationship of the charging interface relative to the robot can be obtained, that is, the distance and angle.
  • step S103 according to the distance relationship and angle relationship between the robot and the charging interface, the robot is controlled to move to the charging stand, and the charging slot of the robot is aligned with the charging interface of the charging stand.
  • an infrared emitting device in the charging stand it is necessary to build an infrared emitting device in the charging stand to emit infrared signals to the outside. Decode the infrared signal to determine the location of the charging stand.
  • an infrared emitting device can also be arranged inside the robot, and an infrared receiving device can be arranged inside the charging stand.
  • this method of positioning the charging stand with the help of infrared signals requires the cooperation of additional equipment, which increases the structural complexity of the robot and the charging stand, and increases the manufacturing cost.
  • a positioning surface is set on the charging stand, and the sensor in the robot is used to position the charging stand. Without adding additional devices, the positional relationship between the robot and the charging stand can be accurately obtained, and the robot and the charging stand can be controlled.
  • the seat is accurately aligned, and the positioning surface only needs to be provided with features corresponding to the robot sensor on the structure of the charging stand, and no additional devices are required, which can simplify the structure of the robot and the charging stand and reduce production and processing costs.
  • Fig. 2 shows a robot control method 200 according to a preferred embodiment of the present invention, specifically including the motion path of the robot
  • Fig. 6 shows the motion path of the robot according to a preferred embodiment of the present invention, below in conjunction with Fig. 2 and Figure 6 is described in detail.
  • step S201 the robot is controlled to move to the first preset point Z1, wherein the distance between the first preset point Z1 and the charging base is not greater than the first preset distance R, and the first preset point Z1 is a point set in advance in the robot's activity area.
  • the first preset point Z1 it should be close to the charging stand to ensure that the sensor of the robot can scan the positioning surface of the charging stand.
  • the first preset distance R should not be greater than the field of view distance of the robot sensor.
  • the specific value can be determined according to the type of robot sensor. For example, the laser radar in the robot is used to scan the positioning surface of the charging stand.
  • the first preset distance R can be 5 meters.
  • the first preset point Z1 can be set within a circle with a first preset distance R from the charging stand. Since the charging stand is usually set at the edge or corner of the robot’s active area, the first preset The preset range of the point Z1 is basically a fan-shaped surface with a certain angle. In Figure 6, the charging stand is set close to the wall, and the first preset point Z1 can be set within a semicircular arc, but the robot’s movement position is not suitable for being close to the wall, which may make it difficult for the robot to scan accurately positioning surface. Furthermore, the sensors of the robot mainly include lidar sensors and binocular vision sensors, etc., which are positioned using optical principles. Therefore, in order to ensure that the robot can scan the positioning surface through the sensor at the first preset point Z1, the first preset There should be no obstacles between point Z1 and the charging stand, such as walls, shelves, etc.
  • step S202 use the sensor of the robot to scan and determine the positioning surface of the charging stand.
  • the position of the positioning surface can be selected according to the needs, and it is only necessary to ensure that the position between the positioning surface and the charging interface is relatively fixed, but In order to facilitate the sensor of the robot to accurately scan the position of the positioning surface, the positioning surface should not be set at the position where the charging stand faces the wall and the scanning blind area of the sensor.
  • the positioning surface can be set at the front side of the charging stand as shown in Figure 8.
  • the positioning surface can also be set at multiple positions of the charging stand, and it only needs to be distinguished to ensure that the sensor of the robot can scan the positioning surface, or by scanning multiple positioning surfaces Verify the specific position and angle of its charging stand.
  • step S203 is basically the same as step S102 in the control method 100, and will not be repeated here.
  • step S204 control the robot to rotate to be perpendicular to the positioning line O, and control the robot to move to the positioning line O, as shown by the route L1 in FIG. 6 .
  • the positioning line O is a virtual line that has a specific positional relationship with the charging interface of the charging stand. Taking Figure 8 as an example, the charging interface 22 of the charging stand 2 is two conductive shrapnels arranged in parallel.
  • the vertical line of the connection between them is aligned and connected, and the vertical line of the connection between the two conductive shrapnel is the positioning line O, that is, the direction and route of motion when the robot and the charging stand are accurately aligned.
  • the positioning line O is also the accurate alignment direction of the charging interface, and the robot can be accurately aligned with the charging base along the positioning line O.
  • the robot needs to determine the position of the robot itself, and determine the position of the charging stand through infrared signals.
  • the positioning line O in this embodiment is a virtual line in the active area of the robot, but the positional relationship between the positioning line O and the positioning surface and the charging interface is preset.
  • the specific position of the positioning line O can be determined.
  • the robot is controlled to move to the positioning line O in advance, which simplifies the alignment process between the robot and the charging stand, and reduces the number of robot fine-tuning.
  • step S205 the robot is controlled to rotate until the charging slot is located on the positioning line O.
  • step S206 the robot is controlled to move to the charging stand along the positioning line O, and is aligned with the charging stand.
  • the charging slot and the charging interface can be connected in advance. Alignment, after the robot obtains the specific position and attitude of the charging stand, the position of the positioning line O is also determined accordingly.
  • the robot moves to the positioning line O, it rotates the body to ensure that the charging slot is also located on the positioning line O.
  • the alignment can be ensured by fine-tuning.
  • FIG. 3 shows a robot control method 300 according to a preferred embodiment of the present invention, wherein the first preset point Z1 is directly set on the positioning line O, which will be described in detail below in conjunction with FIG. 3 and FIG. 6 .
  • steps S301, S303 and S304 are basically the same as steps S201, S205 and S206 in the control method 200, respectively, the only difference being the first preset point Z1 in this embodiment Located on the positioning line O of the charging stand.
  • step S302 use the sensor of the robot to scan and determine the positioning surface of the charging stand.
  • the robot is on the positioning line O, but in this case, it cannot be guaranteed that it is aligned accurately with the charging stand. There are deviations in distance and direction, and it is impossible to accurately judge the posture of the robot relative to the charging stand, so it is still necessary to scan and position the charging stand.
  • the positioning surface needs to be set at a position that the robot can scan, for example, the orientation of the positioning surface and the charging interface are the same or similar same direction.
  • Fig. 4 shows a detailed flow of a control method 400 according to a preferred embodiment of the present invention, and the robot control method 400 will be described in detail below.
  • step S401 it is judged whether the remaining power of the robot is lower than the preset power, wherein the preset power can be set according to the power consumption of the robot, such as 10% or 15%, to ensure that the remaining power of the robot can support the robot to move to the charging stand place and charge.
  • the preset power can be set according to the power consumption of the robot, such as 10% or 15%, to ensure that the remaining power of the robot can support the robot to move to the charging stand place and charge.
  • the preset power usually has a certain amount of redundancy. If the remaining power of the robot is lower than the preset power, it means that the robot needs to be charged. At this time, the robot is controlled to perform the next steps; if the remaining power of the robot is not lower than the preset power, the robot is controlled to continue to perform the task it is performing without charging. .
  • multiple robots are usually arranged to work at the same time in the activity area.
  • multiple charging stations are also set up in the activity area.
  • the robot is controlled to go to the place with the shortest movement
  • the working status of the charging stand can be reported to the server through the charging robot and recorded.
  • Steps S402, S403, and S404 are basically the same as steps S201, S202, and S203 respectively, and will not be repeated here.
  • step S405 the robot is controlled to move to the positioning line O. After the robot determines the position and posture of the charging stand, the position and direction of the positioning line O are also determined.
  • step S204 the robot is controlled to move perpendicular to the positioning line O It can try to avoid the deviation caused by the movement of the robot, but in the active scene of the robot, the positioning line O may be blocked by other objects, which does not guarantee that the robot can move to the vertical foot of the first preset point Z1 on the positioning line O. Avoid the situation that the robot cannot be in place.
  • the robot is controlled to move directly to the positioning line O, not limited to the point determined on the positioning line O.
  • the robot can be controlled to bias the charging The position of the seat moves to the positioning line O, as shown in the line L2 in Figure 6, to prevent other objects between the robot and the charging seat from being blocked, and to avoid new deviations caused by the positioning of the charging port caused by the robot in the process of bypassing obstacles. not allowed.
  • step S406 the robot is controlled to rotate until the charging tank is located on the positioning line O. Further, the current posture of the robot can be recorded.
  • the charging tank is generally located behind the forward direction of the robot. Although the robot can be controlled to move backward , but because most of its sensors are set in the forward direction of the robot, it is impossible to effectively control the stability of the robot’s position and attitude during the reverse process.
  • the charging tank of the robot is rotated to the positioning line O in advance, and after approaching the charging stand, it is still For example, the charging slot is located directly behind the forward direction of the robot. Control the robot to rotate 180° to achieve accurate positioning and minimize the backward movement distance of the robot.
  • step S407 the robot is controlled to move to a second preset point along the positioning line O or to a distance not greater than the second preset distance from the charging stand.
  • the second preset point is a point close to the charging stand, and its distance from the charging stand is not greater than the second preset distance.
  • This step includes two control methods, one of which is to control the robot to move to the second preset point position, so as to ensure that the distance between the robot and the charging stand is close enough, and the other is to directly use the distance to control the robot close enough to the charging stand to reduce the distance of the backward movement.
  • the second preset distance can be determined according to the characteristics of the robot, for example It is 20 cm, and the distance between the robot and the charging stand can be detected in real time by the sensor that comes with the robot, or the position and attitude of the charging stand detected by the robot at the first preset point Z1 can be recorded in the map of the robot , no real-time detection is required to prevent the charging stand from entering the blind zone of the robot sensor as the robot approaches the charging stand.
  • the robot is controlled to rotate until the charging slot is aligned with the charging interface, that is, the robot is controlled to rotate until the charging slot is located on the positioning line O and is electrically connected to the charging interface.
  • the positioning surface 23 of the charging base 2 has preset structural features and/or optical features. For example, as shown in FIG. The groove is scanned and positioned by the sensor, and an optical mark that can be captured by the robot sensor, such as a fluorescent mark or a two-dimensional code, can also be set on the positioning surface 23.
  • an optical mark that can be captured by the robot sensor such as a fluorescent mark or a two-dimensional code
  • FIG. 5 shows a step of confirming the specific position and direction of the charging base relative to the robot.
  • the sensor of the robot is controlled to scan and determine the positioning surface of the charging base
  • the positioning surface of the charging base For example, relying on the laser radar sensor to obtain the shape and structure of the positioning surface is characterized by a groove as shown in Figure 8, that is, to determine the approximate position and direction of the charging stand.
  • the point cloud data of the charging stand is divided according to the scanning result of the lidar sensor.
  • step S503 the point cloud template of the charging stand is placed at the center position of the point cloud data of the charging stand obtained in the previous step, wherein the point cloud template of the charging stand It is the shape and structure data of the charging stand installed within the robot’s activity range, and the point cloud template of the charging stand is positioned using the characteristic structure or characteristic graph on the positioning surface, and then the specific position and posture of the charging stand are determined.
  • step S504 by calculating The method obtains the attitude of the charging base relative to the robot coordinate system, calculates the relative distance and azimuth between the robot and the charging base, and fits the scanning results with the point cloud template of the charging base to obtain the accurate position and attitude of the charging base, namely The distance and angle of the charging stand relative to the robot can be calculated, and the robot can be accurately aligned with the charging stand.
  • the embodiment of the present invention also provides a kind of robot 1, comprises main body 11, driving device 12, charging tank 13, sensor 14 and control system 15, wherein main body 11 is the frame structure of robot 1, present embodiment
  • the robot 1 in the robot moves by electric power, and a battery 16 is arranged inside the main body 11, and the battery 16 supplies energy for the movement of the robot.
  • the driving device 12 is used to drive the robot 1 to move, and is arranged on the main body 11 of the robot 1 , such as a driving wheel fixedly arranged at the bottom of the main body 11 , powered by a battery 16 and controlled by a control system 15 .
  • the charging slot 13 is arranged on the main body 11, and is electrically connected with the battery in the main body 11 directly or through wires, and can be powered by an external power source, such as a conductive shrapnel arranged in the groove below the main body 11.
  • the sensor 14 is arranged on the main body 11 of the robot 1 and can scan and collect the surrounding environment of the robot 1 , such as a laser radar sensor and a binocular vision sensor.
  • the control system 15 is arranged on the main body 11 of the robot 1 and communicates with the driving device and the sensor. The control system can execute the aforementioned control method and control the robot 1 to go to the charging stand 2 for charging.
  • the embodiment of the present invention also provides a robot charging base 2, including a fixed base 21, a charging interface 22 and a positioning surface 23, wherein the fixed base 21 is the main load-bearing support structure of the robot charging base 2, and the fixed base 21 is fixedly connected to the ground and/or wall of the robot’s active area, such as being fixed on the ground by bolts. If the conductive groove 13 of the robot 1 is set at a higher position, the fixing seat 21 can also be fixed on the wall to cooperate with the conductive Groove 13, the shape of robot charging stand 2, structure and position are all matched with robot 1.
  • the charging interface 22 is arranged on the fixed seat 21 and is held by the fixed seat 21.
  • the charging interface 22 can cooperate with the charging slot 13, and only the charging slot 13 supplies power to the robot 1.
  • the charging interface 22 is also electrically connected to an external power supply, such as a warehouse or a restaurant. Entry circuit.
  • the positioning surface 23 is arranged on the fixed seat 21, the positioning surface 23 has preset structural features and/or optical features, and the positional relationship between the positioning surface 23 and the charging interface 21 is fixed, wherein the structural features and optical features mean that the robot 1 can
  • the sensor 14 captures and can recognize features, such as shape or optical markings.
  • the positioning surface 23 is used to cooperate with the sensor 14 of the robot 1, and the structural features and/or optical features on the positioning surface 23 can be used as the basis for confirming and positioning the charging stand 2, and can thus determine the connection between the charging interface 22 and the charging port 22.
  • An embodiment of the present invention also provides a computer-readable storage medium, including computer-executable commands stored thereon, and the executable commands implement the aforementioned control method when executed by a processor.

Abstract

A control method, used for controlling a robot to go to a charging base (2) for charging. The control method comprises: using a sensor of the robot to scan and determine a positioning surface (23) of the charging base (S101); obtaining the distance and angle of charging interfaces (22) of the charging base (2) relative to the robot (S102); and according to the distance relationship and the angle relationship between the robot and the charging interfaces (22), controlling the robot to move to the charging base (2), and enabling charging slots of the robot to be aligned and connected with the charging interfaces (22) of the charging base (2) (S103). The accurate alignment with the charging base (2) is realized by means of the sensor, thereby simplifying the internal structure, reducing the production cost, and optimizing the control method for automatic charging of the robot. Also provided are a robot and a robot charging base (2). The robot is controlled to perform recognition, positioning and docking on the charging base (2), so as to realize complete autonomous positioning and charging of the robot.

Description

控制方法、机器人、机器人充电座及计算机可读存储介质Control method, robot, robot charging stand, and computer-readable storage medium 技术领域technical field
本发明大致涉及机器人控制技术领域,尤其是一种机器人的控制方法,一种机器人,一种机器人充电座以及一种计算机可读存储介质。The present invention generally relates to the technical field of robot control, in particular to a robot control method, a robot, a robot charging stand and a computer-readable storage medium.
背景技术Background technique
随着自动控制技术的发展,机器人的智能化程度越来越高,应用领域也越来越广。大部分机器人的应用场景相对固定,例如配送机器人,仓储机器人,导览机器人等,都是在预定的区域内运动。为实现向机器人供电,通常采用的方法是在预定区域的固定位置设置充电座,当机器人的电量降低到某一阈值时,控制机器人自行前往充电座充电,但在充电前需要保证机器人与充电座的充电接口对位准确。With the development of automatic control technology, the intelligent level of robots is getting higher and higher, and the application fields are getting wider and wider. The application scenarios of most robots are relatively fixed, such as delivery robots, storage robots, tour robots, etc., all of which move within a predetermined area. In order to supply power to the robot, the usual method is to set up a charging stand at a fixed position in a predetermined area. When the power of the robot drops to a certain threshold, the robot is controlled to go to the charging stand to charge itself, but it is necessary to ensure that the robot and the charging stand are fully connected before charging. The alignment of the charging interface is accurate.
现有的机器人自动充电方案,一般都采用红外定位技术,在充电座上安装红外发射或接收模块,当机器人的电量低于阈值时,机器人启动自动查找充电座的功能,一般采用沿墙模式或螺旋模式查找,或者在机器人的运行过程中,根据运行方向和充电桩的位置不断调整前进方向,最终实现机器人和充电座的准确对位。但这种方式需要额外的硬件支持,在机器人和充电座的结构上安装对应的红外发射装置和红外接收装置,并且红外发射装置和红外接收装置功能单一,仅用于机器人和充电座的对位识别,挤占机器人内部有限的空间,增加了结构设计的复杂程度和产品生产成本。The existing robot automatic charging scheme generally adopts infrared positioning technology, and installs an infrared transmitting or receiving module on the charging stand. When the power of the robot is lower than the threshold, the robot starts the function of automatically searching for the charging stand. Search in spiral mode, or during the operation of the robot, continuously adjust the forward direction according to the running direction and the position of the charging pile, and finally realize the accurate alignment between the robot and the charging stand. However, this method requires additional hardware support. The corresponding infrared emitting device and infrared receiving device are installed on the structure of the robot and the charging stand, and the infrared emitting device and the infrared receiving device have a single function and are only used for alignment between the robot and the charging stand. Identifying and occupying the limited space inside the robot increases the complexity of the structural design and the cost of product production.
背景技术部分的内容仅仅是发明人所知晓的技术,并不当然代表本领域的现有技术。The content in the Background Art section is only the technology known to the inventors, and does not necessarily represent the prior art in the field.
发明内容Contents of the invention
针对现有技术中的一个或多个缺陷,本发明提供一种机器人的控制方法,不借助额外的传感器,实现机器人和充电座的准确对位,简化机器人和充电 座的内部结构,降低生产加工成本,优化机器人自动充电的控制方法。本发明还提供一种机器人及机器人充电座,应用前述的机器人控制方法实现对位连接并向机器人充电。本发明还包括一种计算机可读存储介质,用于存储执行前述的机器人控制方法。Aiming at one or more defects in the prior art, the present invention provides a robot control method, which realizes accurate alignment between the robot and the charging stand without additional sensors, simplifies the internal structure of the robot and the charging stand, and reduces the production process. Cost, optimize the control method for automatic charging of the robot. The present invention also provides a robot and a charging stand for the robot, using the aforementioned robot control method to realize alignment connection and charge the robot. The present invention also includes a computer-readable storage medium for storing and executing the aforementioned robot control method.
为解决上述技术问题,本发明采用如下的技术方案:In order to solve the problems of the technologies described above, the present invention adopts the following technical solutions:
一种控制方法,用于控制机器人前往充电座并充电,所述充电座设置在机器人运动区域的预设位置,并且充电座具有定位面,所述控制方法包括:A control method for controlling a robot to go to a charging stand and charge, the charging stand is set at a preset position in the robot's movement area, and the charging stand has a positioning surface, the control method includes:
利用机器人的传感器扫描并确定充电座的定位面,其中所述定位面与充电座的充电接口具有预定的位置关系;Using the sensor of the robot to scan and determine the positioning surface of the charging stand, wherein the positioning surface has a predetermined positional relationship with the charging interface of the charging stand;
获取充电座的充电接口相对于机器人的距离和角度;和Obtain the distance and angle of the charging interface of the charging stand relative to the robot; and
根据机器人与充电接口之间的距离关系和角度关系,控制机器人运动至充电座处,并使机器人的充电槽与充电座的充电接口对位连接。According to the distance relationship and angle relationship between the robot and the charging interface, the robot is controlled to move to the charging base, and the charging slot of the robot is aligned with the charging interface of the charging base.
根据本发明的一个方面,所述控制方法还包括:控制机器人运动至第一H预设点位,然后利用机器人的传感器扫描并确定充电座的定位面,其中所述第一预设点位与所述充电座的距离不大于第一预设距离。According to one aspect of the present invention, the control method further includes: controlling the robot to move to the first H preset point, and then using the sensor of the robot to scan and determine the positioning surface of the charging stand, wherein the first preset point is the same as The distance between the charging base is not greater than a first preset distance.
根据本发明的一个方面,其中所述控制机器人运动至充电座处的步骤还包括:According to one aspect of the present invention, the step of controlling the movement of the robot to the charging stand further includes:
控制机器人运动至定位线上;Control the movement of the robot to the positioning line;
控制机器人旋转,直至其充电槽位于所述定位线方向;和controlling the robot to rotate until its charging slot is in the direction of said positioning line; and
控制机器人沿所述定位线运动至充电座处。The robot is controlled to move to the charging stand along the positioning line.
根据本发明的一个方面,其中所述第一预设点位设置于定位线上。According to an aspect of the present invention, the first preset point is set on the positioning line.
根据本发明的一个方面,其中所述控制机器人运动至充电座处的步骤还包括:According to one aspect of the present invention, the step of controlling the movement of the robot to the charging stand further includes:
控制机器人旋转,直至其充电槽位于所述定位线方向;和controlling the robot to rotate until its charging slot is in the direction of said positioning line; and
控制机器人沿所述定位线运动至充电座处。The robot is controlled to move to the charging stand along the positioning line.
根据本发明的一个方面,其中所述控制机器人沿所述定位线运动至充电座处的步骤还包括:控制机器人运动至第二预设点位或控制机器人运动至与 充电座的距离不大于第二预设距离时,控制机器人转动,直至其充电槽与所述充电接口对齐。According to an aspect of the present invention, the step of controlling the robot to move to the charging stand along the positioning line further includes: controlling the robot to move to a second preset point or controlling the robot to move to a distance not greater than the first When the two preset distances are reached, the robot is controlled to rotate until its charging slot is aligned with the charging interface.
根据本发明的一个方面,其中所述充电座的定位面具有预设的结构特征和/或光学特征,所述控制方法还包括:根据传感器扫描后的结果,识别符合定位面特征的图形,确认充电座相对于机器人的具体位置和具体方向。According to one aspect of the present invention, wherein the positioning surface of the charging stand has preset structural features and/or optical features, the control method further includes: identifying a figure that conforms to the characteristics of the positioning surface according to the results of the sensor scanning, and confirming that The specific position and specific direction of the charging stand relative to the robot.
根据本发明的一个方面,其中所述确认充电座相对于机器人的具体位置和具体方向的步骤还包括:According to one aspect of the present invention, the step of confirming the specific position and specific direction of the charging base relative to the robot further includes:
根据传感器的数据,分割充电座的点云数据;According to the sensor data, segment the point cloud data of the charging stand;
在所述点云数据的中心位置放置充电座的点云模板;Place the point cloud template of the charging stand at the central position of the point cloud data;
通过计算方法得到充电座相对于机器人坐标系的姿态,计算机器人与充电座之间的相对距离和方位角。The posture of the charging base relative to the robot coordinate system is obtained by calculation method, and the relative distance and azimuth angle between the robot and the charging base are calculated.
根据本发明的一个方面,所述控制方法还包括判断机器人剩余电量的是否低于预设电量,当机器人的剩余电量低于预设电量时,控制机器人前往充电座,当机器人的活动区域内设置有多个充电座时,控制机器人前往运动距离最短的空闲充电座。According to one aspect of the present invention, the control method further includes judging whether the remaining power of the robot is lower than the preset power, and when the remaining power of the robot is lower than the preset power, controlling the robot to go to the charging stand, when the robot is set in the active area When there are multiple charging stations, the robot is controlled to go to the idle charging station with the shortest movement distance.
根据本发明的一个方面,一种机器人,包括:According to one aspect of the present invention, a robot includes:
主体,所述主体内设置有电池,所述电池为所述机器人运行供能;a main body, a battery is arranged in the main body, and the battery supplies energy for the operation of the robot;
驱动装置,所述驱动装置设置于所述主体上,并可受控以驱动机器人移动;a driving device, the driving device is arranged on the main body and can be controlled to drive the robot to move;
充电槽,所述充电槽设置于所述主体上,并且配置成可由外接电源向所述电池供电;A charging slot, the charging slot is arranged on the main body and is configured to be powered by an external power supply to the battery;
传感器,所述传感器设置于所述主体上,传感器配置成能够扫描所述机器人周边的环境;和a sensor, the sensor is disposed on the body, the sensor is configured to scan the environment around the robot; and
控制系统,所述控制系统设置于所述主体上,且与所述驱动装置和所述传感器通讯,控制系统配置成可执行如前所述的控制方法。A control system, the control system is arranged on the main body, and communicates with the driving device and the sensor, and the control system is configured to execute the above-mentioned control method.
根据本发明的一个方面,一种机器人充电座,包括:According to one aspect of the present invention, a robot charging stand includes:
固定座,所述固定座与机器人活动区域的地面和/或墙面固定连接;A fixed seat, the fixed seat is fixedly connected to the ground and/or wall of the robot activity area;
充电接口,所述充电接口设置于所述固定座上,充电接口配置成能够与充电槽配合,经充电槽向机器人供电;和A charging interface, the charging interface is arranged on the fixed seat, the charging interface is configured to be able to cooperate with the charging slot, and supply power to the robot through the charging slot; and
定位面,所述定位面设置于所述固定座上,定位面具有预设的结构特征和/或光学特征,且定位面和充电接口的位置关系固定。A positioning surface, the positioning surface is arranged on the fixing seat, the positioning surface has preset structural features and/or optical features, and the positional relationship between the positioning surface and the charging interface is fixed.
根据本发明的一个方面,一种计算机可读存储介质,包括存储于其上的计算机可执行命令,所述可执行命令在被处理器执行时实施如前所述的控制方法。According to one aspect of the present invention, a computer-readable storage medium includes computer-executable commands stored thereon, and the executable commands implement the aforementioned control method when executed by a processor.
与现有技术相比,本发明的实施例提供了一种机器人的控制方法,利用机器人的传感器实现机器人与充电座之间的准确对位,传感器是机器人的必备设备,无需增加额外的结构或装置,简化了机器人和充电座的内部结构,降低了生产制造的成本,优化了机器人自动充电的控制方法,实现一次性对位成功,减少机器人调整方向的次数。本发明的实施例还提供了一种机器人和一种机器人充电座,依靠前述的控制方法,控制机器人对充电座进行识别、定位和对接,实现机器人完全自主定位充电。本发明的实施例还包括一种计算机可读存储介质,用于存储执行前述的控制方法。Compared with the prior art, the embodiment of the present invention provides a robot control method, which uses the sensor of the robot to achieve accurate alignment between the robot and the charging stand. The sensor is an essential device for the robot without adding additional structures Or the device simplifies the internal structure of the robot and the charging stand, reduces the cost of manufacturing, optimizes the control method of the automatic charging of the robot, achieves a one-time alignment success, and reduces the number of times the robot adjusts its direction. The embodiment of the present invention also provides a robot and a robot charging stand, relying on the aforementioned control method, the robot is controlled to identify, locate and dock the charging stand, so as to realize the robot completely autonomously positioning and charging. Embodiments of the present invention also include a computer-readable storage medium for storing and executing the aforementioned control method.
附图说明Description of drawings
附图用来提供对本发明的进一步理解,并且构成说明书的一部分,与本发明的实施例一起用于解释本发明,并不构成对本发明的限制。在附图中:The accompanying drawings are used to provide a further understanding of the present invention, and constitute a part of the description, and are used together with the embodiments of the present invention to explain the present invention, and do not constitute a limitation to the present invention. In the attached picture:
图1是本发明中一个实施例的流程示意图;Fig. 1 is a schematic flow sheet of an embodiment of the present invention;
图2是本发明的一个实施例中第一预设点位不在定位线上时的流程示意图;Fig. 2 is a schematic flow chart when the first preset point is not on the positioning line in one embodiment of the present invention;
图3是本发明的一个实施例中第一预设点位位于定位线上时的流程示意图;Fig. 3 is a schematic flow diagram when the first preset point is located on the positioning line in one embodiment of the present invention;
图4是本发明中一个实施例的详细流程示意图;Fig. 4 is a detailed flow diagram of an embodiment of the present invention;
图5是本发明的一个实施例中扫描并确定充电座的流程示意图;Fig. 5 is a schematic flow chart of scanning and determining the charging stand in one embodiment of the present invention;
图6是本发明的一个实施例中机器人的运动路线示意图;Fig. 6 is a schematic diagram of the motion route of the robot in one embodiment of the present invention;
图7是本发明的一个实施例中机器人的控制框图;Fig. 7 is the control block diagram of robot in one embodiment of the present invention;
图8是本发明的一个实施例中充电座的结构示意图。Fig. 8 is a schematic structural view of the charging stand in an embodiment of the present invention.
具体实施方式Detailed ways
在下文中,仅简单地描述了某些示例性实施例。正如本领域技术人员可认识到的那样,在不脱离本发明的精神或范围的情况下,可通过各种不同方式修改所描述的实施例。因此,附图和描述被认为本质上是示例性的而非限制性的。In the following, only some exemplary embodiments are briefly described. As those skilled in the art would realize, the described embodiments may be modified in various different ways, all without departing from the spirit or scope of the present invention. Accordingly, the drawings and descriptions are to be regarded as illustrative in nature and not restrictive.
在本发明的描述中,需要理解的是,术语"中心"、"纵向"、"横向"、"长度"、"宽度"、"厚度"、"上"、"下"、"前"、"后"、"左"、"右"、"竖直"、"水平"、"顶"、"底"、"内"、"外"、"顺时针"、"逆时针"等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语"第一"、"第二"仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有"第一"、"第二"的特征可以明示或者隐含地包括一个或者更多个所述特征。在本发明的描述中,"多个"的含义是两个或两个以上,除非另有明确具体的限定。In describing the present invention, it is to be understood that the terms "center", "longitudinal", "transverse", "length", "width", "thickness", "upper", "lower", "front", " Back", "Left", "Right", "Vertical", "Horizontal", "Top", "Bottom", "Inner", "Outer", "Clockwise", "Counterclockwise", etc. or The positional relationship is based on the orientation or positional relationship shown in the drawings, which is only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the referred device or element must have a specific orientation, be constructed and operated in a specific orientation, Therefore, it should not be construed as limiting the invention. In addition, the terms "first" and "second" are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance or implicitly specifying the quantity of indicated technical features. Thus, a feature defined as "first" or "second" may explicitly or implicitly include one or more of said features. In the description of the present invention, "plurality" means two or more, unless otherwise specifically defined.
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语"安装"、"相连"、"连接"应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接:可以是机械连接,也可以是电连接或可以相互通讯;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通或两个元件的相互作用关系。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。In the description of the present invention, it should be noted that unless otherwise specified and limited, the terms "installation", "connection" and "connection" should be understood in a broad sense, for example, it can be a fixed connection or a detachable connection. Connected, or integrally connected: it can be mechanically connected, or electrically connected, or can communicate with each other; it can be directly connected, or indirectly connected through an intermediary, and it can be the internal communication of two components or the interaction of two components relation. Those of ordinary skill in the art can understand the specific meanings of the above terms in the present invention according to specific situations.
在本发明中,除非另有明确的规定和限定,第一特征在第二特征之"上"或之"下"可以包括第一和第二特征直接接触,也可以包括第一和第二特征不是直接接触而是通过它们之间的另外的特征接触。而且,第一特征在第二特 征"之上"、"上方"和"上面"包括第一特征在第二特征正上方和斜上方,或仅仅表示第一特征水平高度高于第二特征。第一特征在第二特征"之下"、"下方"和"下面"包括第一特征在第二特征正上方和斜上方,或仅仅表示第一特征水平高度小于第二特征。In the present invention, unless otherwise clearly specified and limited, a first feature being "on" or "under" a second feature may include that the first and second features are in direct contact, or may include the first and second features Not in direct contact but through another characteristic contact between them. Moreover, "above", "above" and "above" a first feature on a second feature include that the first feature is directly above and obliquely above the second feature, or simply means that the level of the first feature is higher than that of the second feature. "Below", "below" and "under" the first feature to the second feature include that the first feature is directly above and obliquely above the second feature, or simply means that the first feature has a lower horizontal height than the second feature.
下文的公开提供了许多不同的实施方式或例子用来实现本发明的不同结构。为了简化本发明的公开,下文中对特定例子的部件和设置进行描述。当然,它们仅仅为示例,并且目的不在于限制本发明。此外,本发明可以在不同例子中重复参考数字和/或参考字母,这种重复是为了简化和清楚的目的,其本身不指示所讨论各种实施方式和/或设置之间的关系。此外,本发明提供了的各种特定的工艺和材料的例子,但是本领域普通技术人员可以意识到其他工艺的应用和/或其他材料的使用。The following disclosure provides many different embodiments or examples for implementing different structures of the present invention. To simplify the disclosure of the present invention, components and arrangements of specific examples are described below. Of course, they are only examples and are not intended to limit the invention. Furthermore, the present disclosure may repeat reference numerals and/or reference letters in different instances, such repetition is for simplicity and clarity and does not in itself indicate a relationship between the various embodiments and/or arrangements discussed. In addition, various specific process and material examples are provided herein, but one of ordinary skill in the art may recognize the use of other processes and/or the use of other materials.
以下结合附图对本发明的优选实施例进行说明,应当理解,此处所描述的优选实施例仅用于说明和解释本发明,并不用于限定本发明。The preferred embodiments of the present invention will be described below in conjunction with the accompanying drawings. It should be understood that the preferred embodiments described here are only used to illustrate and explain the present invention, and are not intended to limit the present invention.
图1示出了根据本发明的一个实施例中控制机器人自动充电的控制方法100,下面结合图1详细描述。FIG. 1 shows a control method 100 for controlling automatic charging of a robot according to an embodiment of the present invention, which will be described in detail below with reference to FIG. 1 .
本实施例用于控制机器人运动到充电座,并进行充电。其中机器人在特定的区域运动,以执行任务,例如在餐厅范围内活动的送餐机器人,在仓库范围内活动的仓储机器人等等,其中机器人的活动区域为主要的工作区域,为保证机器人的续航,需要设置充电座,常规的充电座通常布置在机器人活动区域内入户线接口的附近,与入户电路连通,而且充电座还可以根据具体的使用要求调整位置,例如根据活动区域内机器人的繁忙程度分配不同数量的充电座。This embodiment is used to control the robot to move to the charging stand and charge it. The robot moves in a specific area to perform tasks, such as a food delivery robot operating within the restaurant range, a storage robot operating within the warehouse range, etc. The active area of the robot is the main working area, in order to ensure the battery life of the robot , it is necessary to set up a charging stand. The conventional charging stand is usually arranged near the home line interface in the robot’s activity area, and is connected with the home circuit. Moreover, the charging stand can also be adjusted according to the specific use requirements, such as according to the location of the robot in the activity area. Different numbers of charging stations are allocated according to the degree of busyness.
为了实现机器人和充电座的准确对位,充电座设置有定位面,根据本发明的一个优选实施例,如图8所示,机器人充电座2包括固定座21、充电接口22和定位面23,其中固定座21用于支撑并保护充电座2的内部线路,充电接口22设置在固定座21上,机器人充电座2在机器人活动区域的安装位置可以根据具体需要设定,同时也要兼顾充电接口22与机器人的设计结构相 配合,固定座21可以设置在地面和/或墙面上。机器人充电座2的定位面23设置在固定座21上,并且定位面23具有预设的结构特征和/或光学特征,并且定位面23和充电接口22的位置关系固定。定位面23用于配合机器人的传感器,实现定位机器人充电座2的目的,定位面23的具体结构或具体特征可以根据机器人上的传感器类型决定。In order to achieve accurate alignment between the robot and the charging stand, the charging stand is provided with a positioning surface. According to a preferred embodiment of the present invention, as shown in FIG. Among them, the fixed base 21 is used to support and protect the internal circuit of the charging base 2, and the charging interface 22 is arranged on the fixed base 21. The installation position of the robot charging base 2 in the robot activity area can be set according to specific needs, and the charging interface should also be taken into consideration. 22 cooperates with the design structure of the robot, and the fixing base 21 can be arranged on the ground and/or the wall. The positioning surface 23 of the robot charging base 2 is arranged on the fixed base 21, and the positioning surface 23 has preset structural features and/or optical features, and the positional relationship between the positioning surface 23 and the charging interface 22 is fixed. The positioning surface 23 is used to cooperate with the sensor of the robot to realize the purpose of positioning the charging stand 2 of the robot. The specific structure or specific features of the positioning surface 23 can be determined according to the type of sensor on the robot.
如图1所示,机器人的控制方法100中,在步骤S101,利用机器人的传感器扫描并确定充电座的定位面,其中定位面与充电座的充电接口具有预定的位置关系,例如图8中所示,定位面23与充电座21所在的平面相互垂直,获得定位面23的位置信息后,可以根据预设形状,确定充电座的位置。对于在工作区域内活动的机器人,一般都具有传感器,以进行工作点位定位并防止发生碰撞,传感器包括激光雷达传感器和双目视觉传感器,机器人普遍设置有其中一种或者两种。As shown in FIG. 1, in the robot control method 100, in step S101, the sensor of the robot is used to scan and determine the positioning surface of the charging stand, wherein the positioning surface has a predetermined positional relationship with the charging interface of the charging stand, for example, as shown in FIG. As shown, the plane where the positioning surface 23 and the charging base 21 are located are perpendicular to each other, after obtaining the position information of the positioning surface 23, the position of the charging base can be determined according to the preset shape. For robots moving in the working area, they generally have sensors to locate the working point and prevent collisions. The sensors include lidar sensors and binocular vision sensors. Robots are generally equipped with one or both of them.
在步骤S102,获取充电座的充电接口相对于机器人的距离和角度。由于定位面和充电接口的相对位置固定,在机器人通过扫描获取定位面的位置后,根据定位面和充电接口的位置关系,可以获得充电接口相对于机器人的位置关系,即距离和角度。In step S102, the distance and angle of the charging interface of the charging stand relative to the robot are obtained. Since the relative position of the positioning surface and the charging interface is fixed, after the robot obtains the position of the positioning surface by scanning, according to the positional relationship between the positioning surface and the charging interface, the positional relationship of the charging interface relative to the robot can be obtained, that is, the distance and angle.
在步骤S103,根据机器人与充电接口之间的距离关系和角度关系,控制机器人运动至充电座处,并使机器人的充电槽与充电座的充电接口对位连接。传统的定位过程中,需要在充电座中内置红外发射装置,向外发射红外信号,为了防止环境信号干扰,一般还会对红外信号进行编码,而机器人的内部设置红外接收模块,接收充电座发出的红外信号后进行解码,以此确定充电座的位置。相应的,也可以在机器人内部设置红外发射装置,在充电座内部设置红外接收装置。但这种借助红外信号进行充电座定位的方式需要额外设备配合,增加了机器人和充电座的结构复杂程度,提高了生产制造成本。而在本实施例中,在充电座上设置了定位面,利用机器人中的传感器对充电座进行定位,无需增加额外装置,即可准确获得机器人与充电座之间的位置关系,控制机器人与充电座准确对位,而定位面仅需要在充电座的结构上设置与机 器人传感器相对应的特征即可,并不需要额外增加其他装置,能够简化机器人和充电座的结构,降低生产加工成本。In step S103, according to the distance relationship and angle relationship between the robot and the charging interface, the robot is controlled to move to the charging stand, and the charging slot of the robot is aligned with the charging interface of the charging stand. In the traditional positioning process, it is necessary to build an infrared emitting device in the charging stand to emit infrared signals to the outside. Decode the infrared signal to determine the location of the charging stand. Correspondingly, an infrared emitting device can also be arranged inside the robot, and an infrared receiving device can be arranged inside the charging stand. However, this method of positioning the charging stand with the help of infrared signals requires the cooperation of additional equipment, which increases the structural complexity of the robot and the charging stand, and increases the manufacturing cost. However, in this embodiment, a positioning surface is set on the charging stand, and the sensor in the robot is used to position the charging stand. Without adding additional devices, the positional relationship between the robot and the charging stand can be accurately obtained, and the robot and the charging stand can be controlled. The seat is accurately aligned, and the positioning surface only needs to be provided with features corresponding to the robot sensor on the structure of the charging stand, and no additional devices are required, which can simplify the structure of the robot and the charging stand and reduce production and processing costs.
图2示出了根据本发明的一个优选实施例的机器人控制方法200,具体包括机器人的运动路径,图6示出了根据本发明的一个优选实施例中机器人的运动路径,下面结合图2和图6详细描述。Fig. 2 shows a robot control method 200 according to a preferred embodiment of the present invention, specifically including the motion path of the robot, and Fig. 6 shows the motion path of the robot according to a preferred embodiment of the present invention, below in conjunction with Fig. 2 and Figure 6 is described in detail.
如图2所示,在步骤S201,控制机器人运动至第一预设点位Z1,其中第一预设点位Z1与充电座的距离不大于第一预设距离R,第一预设点位Z1是预先在机器人的活动区域内设定的点位,设定第一预设点位Z1时应当靠近充电座,以保证机器人的传感器能够扫描到充电座的定位面,其中第一预设距离R应不大于机器人传感器的视野距离,具体的数值可以根据机器人传感器的类型确定,例如采用机器人中的激光雷达扫描充电座的定位面,第一预设距离R可以为5米。如图6所示,第一预设点位Z1可以设置在距离充电座第一预设距离R的圆形内,由于充电座通常设置在机器人活动区域的边缘位置或边角,第一预设点位Z1的预设范围基本是具有一定角度的扇形面。在图6中,充电座设置在靠近墙壁的位置处,第一预设点位Z1可以选择半圆弧线内的位置设定,但机器人的运动位置不适于靠近墙壁,可能会导致机器人难以准确扫描定位面。进一步的,机器人的传感器主要包括激光雷达传感器和双目视觉传感器等,均利用光学原理定位,所以,为保证机器人在第一预设点位Z1处能够通过传感器扫描到定位面,第一预设点位Z1与充电座之间不能有阻挡物,例如墙壁,货架等。As shown in Figure 2, in step S201, the robot is controlled to move to the first preset point Z1, wherein the distance between the first preset point Z1 and the charging base is not greater than the first preset distance R, and the first preset point Z1 is a point set in advance in the robot's activity area. When setting the first preset point Z1, it should be close to the charging stand to ensure that the sensor of the robot can scan the positioning surface of the charging stand. The first preset distance R should not be greater than the field of view distance of the robot sensor. The specific value can be determined according to the type of robot sensor. For example, the laser radar in the robot is used to scan the positioning surface of the charging stand. The first preset distance R can be 5 meters. As shown in Figure 6, the first preset point Z1 can be set within a circle with a first preset distance R from the charging stand. Since the charging stand is usually set at the edge or corner of the robot’s active area, the first preset The preset range of the point Z1 is basically a fan-shaped surface with a certain angle. In Figure 6, the charging stand is set close to the wall, and the first preset point Z1 can be set within a semicircular arc, but the robot’s movement position is not suitable for being close to the wall, which may make it difficult for the robot to scan accurately positioning surface. Furthermore, the sensors of the robot mainly include lidar sensors and binocular vision sensors, etc., which are positioned using optical principles. Therefore, in order to ensure that the robot can scan the positioning surface through the sensor at the first preset point Z1, the first preset There should be no obstacles between point Z1 and the charging stand, such as walls, shelves, etc.
在步骤S202,利用机器人的传感器扫描并确定充电座的定位面,在本实施例中,定位面的位置可以根据需要选择,仅需保证定位面和充电接口之间的位置相对固定即可,但为了便于机器人的传感器准确扫描到定位面的位置,定位面不应设置在充电座朝向墙壁的位置和传感器的扫描盲区,定位面可以设置在如图8所示的充电座的前侧面。进一步的,根据本发明的一个优选实施例,定位面还可以设置在充电座的多个位置,仅需进行区分即可,以确保机器人的传感器能够扫描到定位面,或通过扫描多个定位面对其充电座的具 体位置和角度进行核验。In step S202, use the sensor of the robot to scan and determine the positioning surface of the charging stand. In this embodiment, the position of the positioning surface can be selected according to the needs, and it is only necessary to ensure that the position between the positioning surface and the charging interface is relatively fixed, but In order to facilitate the sensor of the robot to accurately scan the position of the positioning surface, the positioning surface should not be set at the position where the charging stand faces the wall and the scanning blind area of the sensor. The positioning surface can be set at the front side of the charging stand as shown in Figure 8. Further, according to a preferred embodiment of the present invention, the positioning surface can also be set at multiple positions of the charging stand, and it only needs to be distinguished to ensure that the sensor of the robot can scan the positioning surface, or by scanning multiple positioning surfaces Verify the specific position and angle of its charging stand.
机器人的控制方法200中,步骤S203和控制方法100中的步骤S102基本相同,在此不再赘述。在步骤S204,控制机器人旋转至垂直于定位线O,并控制机器人运动至定位线O上,如图6中路线L1所示。定位线O为与充电座的充电接口存在特定位置关系的虚拟线,以图8为例,充电座2的充电接口22为两个平行布置的导电弹片,机器人的导电槽需要沿两个导电弹片之间连线的中垂线对位连接,两个导电弹片之间连线的中垂线即为定位线O,即机器人与充电座准确对位时运动方向和路线。当然,如果充电座的充电接口为单独的一个或者不对称的多个时,定位线O同样为充电接口的准确对位方向,机器人沿定位线O即可与充电座准确对位。现有的红外定位方式中,首先机器人需要确定机器人自身所在的位置,并通过红外信号确定充电座的位置,当机器人需要进行充电时,控制机器人运动到充电座附近,并利用红外信号反复调整位置和姿态,直到机器人的充电槽和充电座的充电接口对应,然后控制机器人与充电座对位连接。但利用红外信号对位的方式定位并不准确,因此,一般是在大致确定方向后,控制机器人逐渐靠近充电座,并在这一过程中反复微调机器人的姿态,速度较慢而且对位准确率不高,需要多次调整。本实施例中的定位线O是在机器人的活动区域内的虚拟线,但定位线O和定位面以及充电接口之间的位置关系是预先设定的,在机器人利用传感器确定了定位面后,即可确定定位线O的具体位置,在本实施例中,控制机器人预先运动到定位线O上,简化机器人和充电座之间的对位过程,减少机器人微调次数。In the robot control method 200, step S203 is basically the same as step S102 in the control method 100, and will not be repeated here. In step S204, control the robot to rotate to be perpendicular to the positioning line O, and control the robot to move to the positioning line O, as shown by the route L1 in FIG. 6 . The positioning line O is a virtual line that has a specific positional relationship with the charging interface of the charging stand. Taking Figure 8 as an example, the charging interface 22 of the charging stand 2 is two conductive shrapnels arranged in parallel. The vertical line of the connection between them is aligned and connected, and the vertical line of the connection between the two conductive shrapnel is the positioning line O, that is, the direction and route of motion when the robot and the charging stand are accurately aligned. Of course, if the charging interface of the charging base is single or asymmetrical, the positioning line O is also the accurate alignment direction of the charging interface, and the robot can be accurately aligned with the charging base along the positioning line O. In the existing infrared positioning method, first the robot needs to determine the position of the robot itself, and determine the position of the charging stand through infrared signals. When the robot needs to be charged, control the robot to move to the vicinity of the charging stand, and use the infrared signal to repeatedly adjust the position and posture until the charging slot of the robot corresponds to the charging interface of the charging stand, and then control the robot to connect with the charging stand. However, the positioning method using infrared signals is not accurate. Therefore, after roughly determining the direction, the robot is generally controlled to gradually approach the charging stand, and the attitude of the robot is repeatedly fine-tuned in the process. The speed is slow and the alignment accuracy is low. Not too high, need to adjust several times. The positioning line O in this embodiment is a virtual line in the active area of the robot, but the positional relationship between the positioning line O and the positioning surface and the charging interface is preset. After the robot uses the sensor to determine the positioning surface, The specific position of the positioning line O can be determined. In this embodiment, the robot is controlled to move to the positioning line O in advance, which simplifies the alignment process between the robot and the charging stand, and reduces the number of robot fine-tuning.
在步骤S205,控制机器人旋转至充电槽位于定位线O上,在步骤S206,控制机器人沿着定位线O运动至充电座处,并与充电座对位连接,可以预先将充电槽与充电接口进行对位,机器人在获取充电座的具体位置和姿态后,定位线O的位置也随之确定,当机器人运动到定位线O上后,通过旋转机身确保充电槽也位于定位线O上,预先完成对位,在机器人沿定位线O向充电座运动时,可以通过微调确保对位准确。In step S205, the robot is controlled to rotate until the charging slot is located on the positioning line O. In step S206, the robot is controlled to move to the charging stand along the positioning line O, and is aligned with the charging stand. The charging slot and the charging interface can be connected in advance. Alignment, after the robot obtains the specific position and attitude of the charging stand, the position of the positioning line O is also determined accordingly. When the robot moves to the positioning line O, it rotates the body to ensure that the charging slot is also located on the positioning line O. After the alignment is completed, when the robot moves to the charging stand along the positioning line O, the alignment can be ensured by fine-tuning.
图3示出了根据本发明的一个优选实施例的机器人控制方法300,其中第一预设点位Z1直接设定在定位线O上,下面结合图3和图6详细描述。FIG. 3 shows a robot control method 300 according to a preferred embodiment of the present invention, wherein the first preset point Z1 is directly set on the positioning line O, which will be described in detail below in conjunction with FIG. 3 and FIG. 6 .
如图3所示,机器人的控制方法300中,步骤S301、S303和S304分别与控制方法200中的步骤S201、S205和S206基本相同,区别仅在于本实施例中的第一预设点位Z1位于充电座的定位线O上。在步骤S302,利用机器人的传感器扫描并确定充电座的定位面,此时机器人位于定位线O上,但这种情况下并不能保证其与充电座对位准确,在机器人运动过程中,依然可能出现距离和方向上的偏差,并且无法准确判断机器人相对于充电座的姿态,因此仍然需要对充电座进行扫描定位。相应的,机器人的位置固定后,其传感器的扫描范围也相对固定,扫描盲区的位置也会发生变化,所以定位面需要设置在机器人能够扫描到的位置,例如定位面和充电接口朝向相同或近似相同的方向。As shown in FIG. 3 , in the robot control method 300, steps S301, S303 and S304 are basically the same as steps S201, S205 and S206 in the control method 200, respectively, the only difference being the first preset point Z1 in this embodiment Located on the positioning line O of the charging stand. In step S302, use the sensor of the robot to scan and determine the positioning surface of the charging stand. At this time, the robot is on the positioning line O, but in this case, it cannot be guaranteed that it is aligned accurately with the charging stand. There are deviations in distance and direction, and it is impossible to accurately judge the posture of the robot relative to the charging stand, so it is still necessary to scan and position the charging stand. Correspondingly, after the position of the robot is fixed, the scanning range of its sensor is also relatively fixed, and the position of the scanning blind area will also change, so the positioning surface needs to be set at a position that the robot can scan, for example, the orientation of the positioning surface and the charging interface are the same or similar same direction.
图4示出了根据本发明的一个优选实施例中控制方法400的详细流程,下面对机器人的控制方法400进行详细描述。Fig. 4 shows a detailed flow of a control method 400 according to a preferred embodiment of the present invention, and the robot control method 400 will be described in detail below.
在步骤S401,判断机器人的剩余电量是否低于预设电量,其中预设电量可以根据机器人的耗电情况进行设置,例如10%或15%,以确保机器人的剩余电量能够支持机器人运动至充电座处,并进行充电。根据机器人的具体应用场景,可能还需要计算机器人清空荷载所需要的电量,预设电量通常留有一定的冗余量。如果机器人的剩余电量低于预设电量,说明机器人需要进行充电,此时控制机器人执行后续步骤;如果机器人的剩余电量不低于预设电量,控制机器人继续执行其正在执行的任务,无需进行充电。在很多应用场景中,活动区域内通常会布置多个机器人同时工作,相应的,活动区域内也会设置多个充电座,在机器人剩余电量低于预设电量时,控制机器人前往运动距离最短的空闲充电座,充电座的工作状态可以通过正在充电的机器人上报服务器,并进行记录。In step S401, it is judged whether the remaining power of the robot is lower than the preset power, wherein the preset power can be set according to the power consumption of the robot, such as 10% or 15%, to ensure that the remaining power of the robot can support the robot to move to the charging stand place and charge. According to the specific application scenario of the robot, it may also be necessary to calculate the power required by the robot to empty the load. The preset power usually has a certain amount of redundancy. If the remaining power of the robot is lower than the preset power, it means that the robot needs to be charged. At this time, the robot is controlled to perform the next steps; if the remaining power of the robot is not lower than the preset power, the robot is controlled to continue to perform the task it is performing without charging. . In many application scenarios, multiple robots are usually arranged to work at the same time in the activity area. Correspondingly, multiple charging stations are also set up in the activity area. When the remaining power of the robot is lower than the preset power, the robot is controlled to go to the place with the shortest movement The working status of the charging stand can be reported to the server through the charging robot and recorded.
步骤S402、S403和S404分别与步骤S201、S202和S203基本相同,在此不再赘述。在步骤S405,控制机器人运动至定位线O上,机器人在确定了 充电座的位置和姿态后,定位线O的位置和方向也随之确定,步骤S204中控制机器人垂直于定位线O运动的情况能够尽量避免因机器人移动产生偏差,但在机器人的活动场景中,定位线O可能被其他物体阻挡,并不能保证机器人能够运动到第一预设点位Z1在定位线O上的垂足,为避免发生机器人无法到位的情况,本实施例中控制机器人直接运动到定位线O上,不限于定位线O上确定的点位,进一步的,根据本发明的一个优选实施例,可以控制机器人偏向充电座的位置运动至定位线O上,如图6中的线路L2,防止机器人与充电座之间还存在其他物体阻挡,避免机器人在绕过障碍物的过程中产生新的偏差导致于充电接口定位不准。Steps S402, S403, and S404 are basically the same as steps S201, S202, and S203 respectively, and will not be repeated here. In step S405, the robot is controlled to move to the positioning line O. After the robot determines the position and posture of the charging stand, the position and direction of the positioning line O are also determined. In step S204, the robot is controlled to move perpendicular to the positioning line O It can try to avoid the deviation caused by the movement of the robot, but in the active scene of the robot, the positioning line O may be blocked by other objects, which does not guarantee that the robot can move to the vertical foot of the first preset point Z1 on the positioning line O. Avoid the situation that the robot cannot be in place. In this embodiment, the robot is controlled to move directly to the positioning line O, not limited to the point determined on the positioning line O. Further, according to a preferred embodiment of the present invention, the robot can be controlled to bias the charging The position of the seat moves to the positioning line O, as shown in the line L2 in Figure 6, to prevent other objects between the robot and the charging seat from being blocked, and to avoid new deviations caused by the positioning of the charging port caused by the robot in the process of bypassing obstacles. not allowed.
在步骤S406,控制机器人旋转至充电槽位于定位线O上,进一步的,可以对机器人当前的姿态进行记录,常规机器人的结构设计中,充电槽一般位于机器人前进方向的后方,虽然能够控制机器人后退,但由于其传感器大部分设置于机器人的前进方向上,无法有效控制机器人在倒退的过程中位置和姿态稳定,提前将机器人的充电槽旋转至定位线O上,在靠近充电座后,仍然以充电槽位于机器人前进方向的正后方为例,控制机器人旋转180°即可准确定位,尽量减少机器人倒退运动的距离。在步骤S407,控制机器人沿定位线O运动至第二预设点位或运动至与充电座的距离不大于第二预设距离。其中第二预设点位为靠近充电座的点位,其与充电座的距离不大于第二预设距离,本步骤中包括两种控制方法,其中一个是控制机器人运动到第二预设点位,以此保证机器人与充电座之间的距离足够近,另一种是直接利用距离控制机器人足够靠近充电座,减少倒退运动的距离,其中第二预设距离可以根据机器人的特性确定,例如是20厘米,而机器人与充电座之间的距离可以通过机器人自带的传感器实时探测,也可以将机器人在第一预设点位Z1时探测到的充电座位置和姿态记录在机器人的地图中,无需实时探测,以防止随机器人靠近充电座,导致充电座进入机器人传感器的盲区中的情况。当机器人靠近充电座后,在步骤S408,控制机器人旋转至充电槽与充电接口对齐,即控制机器人旋转至充电槽位于定位线O上,并与充电接口电连接。In step S406, the robot is controlled to rotate until the charging tank is located on the positioning line O. Further, the current posture of the robot can be recorded. In the structural design of conventional robots, the charging tank is generally located behind the forward direction of the robot. Although the robot can be controlled to move backward , but because most of its sensors are set in the forward direction of the robot, it is impossible to effectively control the stability of the robot’s position and attitude during the reverse process. The charging tank of the robot is rotated to the positioning line O in advance, and after approaching the charging stand, it is still For example, the charging slot is located directly behind the forward direction of the robot. Control the robot to rotate 180° to achieve accurate positioning and minimize the backward movement distance of the robot. In step S407, the robot is controlled to move to a second preset point along the positioning line O or to a distance not greater than the second preset distance from the charging stand. Wherein the second preset point is a point close to the charging stand, and its distance from the charging stand is not greater than the second preset distance. This step includes two control methods, one of which is to control the robot to move to the second preset point position, so as to ensure that the distance between the robot and the charging stand is close enough, and the other is to directly use the distance to control the robot close enough to the charging stand to reduce the distance of the backward movement. The second preset distance can be determined according to the characteristics of the robot, for example It is 20 cm, and the distance between the robot and the charging stand can be detected in real time by the sensor that comes with the robot, or the position and attitude of the charging stand detected by the robot at the first preset point Z1 can be recorded in the map of the robot , no real-time detection is required to prevent the charging stand from entering the blind zone of the robot sensor as the robot approaches the charging stand. When the robot is close to the charging base, in step S408, the robot is controlled to rotate until the charging slot is aligned with the charging interface, that is, the robot is controlled to rotate until the charging slot is located on the positioning line O and is electrically connected to the charging interface.
根据本发明的一个优选实施例,充电座2的定位面23具有预设的结构特征和/或光学特征,例如图8所示,在充电座2的定位面23上设置两个预设形状的凹槽,通过传感器扫描凹槽并定位,还可以在定位面23上设置能够被机器人传感器捕捉的光学标记,例如荧光标记或二维码等,在利用机器人传感器扫描并确定充电座的定位面时,根据传感器扫描后的结果,识别出符合定位面特征的图形,例如根据扫描结果识别到二维码,以此确定充电座相对于机器人的具体位置和具体方向,而制作具有凹槽的充电座2外壳或在外壳上印刷标记相比于安装红外发射装置成本更低,效率更高。According to a preferred embodiment of the present invention, the positioning surface 23 of the charging base 2 has preset structural features and/or optical features. For example, as shown in FIG. The groove is scanned and positioned by the sensor, and an optical mark that can be captured by the robot sensor, such as a fluorescent mark or a two-dimensional code, can also be set on the positioning surface 23. When using the robot sensor to scan and determine the positioning surface of the charging stand , according to the results of the sensor scanning, identify the graphics that conform to the characteristics of the positioning surface, such as recognizing the two-dimensional code according to the scanning results, so as to determine the specific position and specific direction of the charging base relative to the robot, and make a charging base with grooves 2 Housing or printing marks on the housing is less costly and more efficient than installing an infrared emitting device.
进一步的,根据本发明的一个优选实施例,图5示出了一种确认充电座相对于机器人的具体位置和具体方向的步骤,在步骤S501,控制机器人的传感器扫描并确定充电座的定位面,例如依靠激光雷达传感器获取定位面的形状结构特征为如图8所示的凹槽,即确定充电座的大致位置和方向。在步骤S502,根据激光雷达传感器的扫描结果分割充电座点云数据,在步骤S503,在上一步获得的充电座的点云数据中心位置放置充电座的点云模板,其中充电座的点云模板为机器人活动范围内安装的充电座的形状结构数据,并且利用定位面上的特征结构或特征图形定位充电座的点云模板,进而确定出充电座的具体位置和姿态,在步骤S504,通过计算方法得到充电座相对于机器人坐标系的姿态,计算机器人与充电座之间的相对距离和方位角,将扫描结果和充电座的点云模板拟合后,得到充电座的准确位置和姿态,即可计算获得充电座相对于机器人的距离和角度,即可控制机器人与充电座准确对位。Further, according to a preferred embodiment of the present invention, FIG. 5 shows a step of confirming the specific position and direction of the charging base relative to the robot. In step S501, the sensor of the robot is controlled to scan and determine the positioning surface of the charging base For example, relying on the laser radar sensor to obtain the shape and structure of the positioning surface is characterized by a groove as shown in Figure 8, that is, to determine the approximate position and direction of the charging stand. In step S502, the point cloud data of the charging stand is divided according to the scanning result of the lidar sensor. In step S503, the point cloud template of the charging stand is placed at the center position of the point cloud data of the charging stand obtained in the previous step, wherein the point cloud template of the charging stand It is the shape and structure data of the charging stand installed within the robot’s activity range, and the point cloud template of the charging stand is positioned using the characteristic structure or characteristic graph on the positioning surface, and then the specific position and posture of the charging stand are determined. In step S504, by calculating The method obtains the attitude of the charging base relative to the robot coordinate system, calculates the relative distance and azimuth between the robot and the charging base, and fits the scanning results with the point cloud template of the charging base to obtain the accurate position and attitude of the charging base, namely The distance and angle of the charging stand relative to the robot can be calculated, and the robot can be accurately aligned with the charging stand.
如图7所示,本发明的实施例还提供一种机器人1,包括主体11,驱动装置12,充电槽13,传感器14和控制系统15,其中主体11是机器人1的框架结构,本实施例中的机器人1依靠电力运动,主体11的内部设置有电池16,电池16为机器人运动供能。驱动装置12用于驱动机器人1移动,设置在机器人1的主体11上,例如是固定设置在主体11底部的主动轮,由电池16供能,并受控制系统15控制。充电槽13设置在主体11上,并直接或通过导线与主体11内的电池电连接,能够由外接电源向电池供电,例如设置在 主体11下方凹槽内的导电弹片。传感器14设置在机器人1的主体11上,并能够扫描采集机器人1周边的环境,例如是激光雷达传感器和双目视觉传感器等。控制系统15设置在机器人1的主体11上,并且与驱动装置和传感器通讯,控制系统能够执行前述的控制方法,控制机器人1前往充电座2进行充电。As shown in Fig. 7, the embodiment of the present invention also provides a kind of robot 1, comprises main body 11, driving device 12, charging tank 13, sensor 14 and control system 15, wherein main body 11 is the frame structure of robot 1, present embodiment The robot 1 in the robot moves by electric power, and a battery 16 is arranged inside the main body 11, and the battery 16 supplies energy for the movement of the robot. The driving device 12 is used to drive the robot 1 to move, and is arranged on the main body 11 of the robot 1 , such as a driving wheel fixedly arranged at the bottom of the main body 11 , powered by a battery 16 and controlled by a control system 15 . The charging slot 13 is arranged on the main body 11, and is electrically connected with the battery in the main body 11 directly or through wires, and can be powered by an external power source, such as a conductive shrapnel arranged in the groove below the main body 11. The sensor 14 is arranged on the main body 11 of the robot 1 and can scan and collect the surrounding environment of the robot 1 , such as a laser radar sensor and a binocular vision sensor. The control system 15 is arranged on the main body 11 of the robot 1 and communicates with the driving device and the sensor. The control system can execute the aforementioned control method and control the robot 1 to go to the charging stand 2 for charging.
如图8所示,本发明的实施例还提供一种机器人充电座2,包括固定座21,充电接口22和定位面23,其中固定座21是机器人充电座2的主要承载支撑结构,固定座21与机器人活动区域的地面和/或墙面固定连接,例如通过螺栓固定在地面上,如果机器人1的导电槽13设置在较高的位置,固定座21也可以固定在墙面上以配合导电槽13,机器人充电座2的形状,结构和位置均与机器人1相配合。充电接口22设置在固定座21上,由固定座21保持,充电接口22能够与充电槽13配合,仅充电槽13向机器人1供电,充电接口22还与外接电源电连接,例如仓库或餐厅的入户电路。定位面23设置在固定座21上,定位面23具有预设的结构特征和/或光学特征,且定位面23和充电接口21的位置关系固定,其中结构特征和光学特征是指能够被机器人1传感器14获取并能够被识别的特征,例如形状或光学标识。如前所述,定位面23用于配合机器人1的传感器14,定位面23上的结构特征和/或光学特征可以作为确认和定位充电座2的依据,并能够由此确定充电接口22与充电槽13之间的具体距离和角度关系。As shown in Figure 8, the embodiment of the present invention also provides a robot charging base 2, including a fixed base 21, a charging interface 22 and a positioning surface 23, wherein the fixed base 21 is the main load-bearing support structure of the robot charging base 2, and the fixed base 21 is fixedly connected to the ground and/or wall of the robot’s active area, such as being fixed on the ground by bolts. If the conductive groove 13 of the robot 1 is set at a higher position, the fixing seat 21 can also be fixed on the wall to cooperate with the conductive Groove 13, the shape of robot charging stand 2, structure and position are all matched with robot 1. The charging interface 22 is arranged on the fixed seat 21 and is held by the fixed seat 21. The charging interface 22 can cooperate with the charging slot 13, and only the charging slot 13 supplies power to the robot 1. The charging interface 22 is also electrically connected to an external power supply, such as a warehouse or a restaurant. Entry circuit. The positioning surface 23 is arranged on the fixed seat 21, the positioning surface 23 has preset structural features and/or optical features, and the positional relationship between the positioning surface 23 and the charging interface 21 is fixed, wherein the structural features and optical features mean that the robot 1 can The sensor 14 captures and can recognize features, such as shape or optical markings. As mentioned above, the positioning surface 23 is used to cooperate with the sensor 14 of the robot 1, and the structural features and/or optical features on the positioning surface 23 can be used as the basis for confirming and positioning the charging stand 2, and can thus determine the connection between the charging interface 22 and the charging port 22. The specific distance and angular relationship between the grooves 13.
本发明的实施例还提供了一种计算机可读存储介质,包括存储于其上的计算机可执行命令,所述可执行命令在被处理器执行时实施如前所述的控制方法。An embodiment of the present invention also provides a computer-readable storage medium, including computer-executable commands stored thereon, and the executable commands implement the aforementioned control method when executed by a processor.
最后应说明的是:以上所述仅为本发明的优选实施例而已,并不用于限制本发明,尽管参照前述实施例对本发明进行了详细的说明,对于本领域的技术人员来说,其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换。凡在本发明的精神和原则之内,所作 的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。Finally, it should be noted that: the above is only a preferred embodiment of the present invention, and is not intended to limit the present invention. Although the present invention has been described in detail with reference to the foregoing embodiments, for those skilled in the art, it still The technical solutions recorded in the foregoing embodiments may be modified, or some technical features thereof may be equivalently replaced. Any modifications, equivalent replacements, improvements, etc. made within the spirit and principles of the present invention shall be included within the protection scope of the present invention.

Claims (12)

  1. 一种控制方法,用于控制机器人前往充电座并充电,所述充电座设置在机器人运动区域的预设位置,并且充电座具有定位面,所述控制方法包括:A control method for controlling a robot to go to a charging stand and charge, the charging stand is set at a preset position in the robot's movement area, and the charging stand has a positioning surface, the control method includes:
    利用机器人的传感器扫描并确定充电座的定位面,其中所述定位面与充电座的充电接口具有预定的位置关系;Using the sensor of the robot to scan and determine the positioning surface of the charging stand, wherein the positioning surface has a predetermined positional relationship with the charging interface of the charging stand;
    获取充电座的充电接口相对于机器人的距离和角度;和Obtain the distance and angle of the charging interface of the charging stand relative to the robot; and
    根据机器人与充电接口之间的距离关系和角度关系,控制机器人运动至充电座处,并使机器人的充电槽与充电座的充电接口对位连接。According to the distance relationship and angle relationship between the robot and the charging interface, the robot is controlled to move to the charging base, and the charging slot of the robot is aligned with the charging interface of the charging base.
  2. 根据权利要求1所述的控制方法,还包括:控制机器人运动至第一预设点位,然后利用机器人的传感器扫描并确定充电座的定位面,其中所述第一预设点位与所述充电座的距离不大于第一预设距离。The control method according to claim 1, further comprising: controlling the robot to move to a first preset point, and then using the sensor of the robot to scan and determine the positioning surface of the charging stand, wherein the first preset point is the same as the The distance of the charging base is not greater than the first preset distance.
  3. 根据权利要求2所述的控制方法,其中所述控制机器人运动至充电座处的步骤还包括:The control method according to claim 2, wherein the step of controlling the robot to move to the charging stand further comprises:
    控制机器人运动至定位线上;Control the movement of the robot to the positioning line;
    控制机器人旋转,直至其充电槽位于所述定位线方向;和controlling the robot to rotate until its charging slot is in the direction of said positioning line; and
    控制机器人沿所述定位线运动至充电座处。The robot is controlled to move to the charging stand along the positioning line.
  4. 根据权利要求2所述的控制方法,其中所述第一预设点位设置于定位线上。The control method according to claim 2, wherein the first preset point is set on the positioning line.
  5. 根据权利要求4所述的控制方法,其中所述控制机器人运动至充电座处的步骤还包括:The control method according to claim 4, wherein the step of controlling the robot to move to the charging stand further comprises:
    控制机器人旋转,直至其充电槽位于所述定位线方向;和controlling the robot to rotate until its charging slot is in the direction of said positioning line; and
    控制机器人沿所述定位线运动至充电座处。The robot is controlled to move to the charging stand along the positioning line.
  6. 根据权利要求3或5所述的控制方法,其中所述控制机器人沿所述定位线运动至充电座处的步骤还包括:控制机器人运动至第二预设点位或控制机 器人运动至与充电座的距离不大于第二预设距离时,控制机器人转动,直至其充电槽与所述充电接口对齐。The control method according to claim 3 or 5, wherein the step of controlling the robot to move to the charging stand along the positioning line further comprises: controlling the robot to move to the second preset point or controlling the robot to move to the charging stand When the distance is not greater than the second preset distance, the robot is controlled to rotate until its charging slot is aligned with the charging interface.
  7. 根据权利要求2-5中任一项所述的控制方法,其中所述充电座的定位面具有预设的结构特征和/或光学特征,所述控制方法还包括:根据传感器扫描后的结果,识别符合定位面特征的图形,确认充电座相对于机器人的具体位置和具体方向。The control method according to any one of claims 2-5, wherein the positioning surface of the charging stand has preset structural features and/or optical features, and the control method further includes: according to the result of scanning by the sensor, Identify the graphics that conform to the characteristics of the positioning surface, and confirm the specific position and specific direction of the charging base relative to the robot.
  8. 根据权利要求7所述的控制方法,其中所述确认充电座相对于机器人的具体位置和具体方向的步骤还包括:The control method according to claim 7, wherein the step of confirming the specific position and specific direction of the charging stand relative to the robot further comprises:
    根据传感器的数据,分割充电座的点云数据;According to the sensor data, segment the point cloud data of the charging stand;
    在所述点云数据的中心位置放置充电座的点云模板;Place the point cloud template of the charging stand at the central position of the point cloud data;
    通过计算方法得到充电座相对于机器人坐标系的姿态,计算机器人与充电座之间的相对距离和方位角。The posture of the charging base relative to the robot coordinate system is obtained by calculation method, and the relative distance and azimuth angle between the robot and the charging base are calculated.
  9. 根据权利要求1-5中任一项所述的控制方法,还包括判断机器人剩余电量的是否低于预设电量,当机器人的剩余电量低于预设电量时,控制机器人前往充电座,当机器人的活动区域内设置有多个充电座时,控制机器人前往运动距离最短的空闲充电座。The control method according to any one of claims 1-5, further comprising judging whether the remaining power of the robot is lower than the preset power, and when the remaining power of the robot is lower than the preset power, controlling the robot to go to the charging stand, when the robot When there are multiple charging stations in the activity area, the robot is controlled to go to the idle charging station with the shortest movement distance.
  10. 一种机器人,包括:A robot comprising:
    主体,所述主体内设置有电池,所述电池为所述机器人运行供能;a main body, a battery is arranged in the main body, and the battery supplies energy for the operation of the robot;
    驱动装置,所述驱动装置设置于所述主体上,并可受控以驱动机器人移动;a driving device, the driving device is arranged on the main body and can be controlled to drive the robot to move;
    充电槽,所述充电槽设置于所述主体上,并且配置成可由外接电源向所述电池供电;A charging slot, the charging slot is arranged on the main body and is configured to be powered by an external power supply to the battery;
    传感器,所述传感器设置于所述主体上,传感器配置成能够扫描所述机器人周边的环境;和a sensor, the sensor is disposed on the body, the sensor is configured to scan the environment around the robot; and
    控制系统,所述控制系统设置于所述主体上,且与所述驱动装置和所述传感器通讯,控制系统配置成可执行如权利要求1-9中任一项所述的控制方法。A control system, the control system is arranged on the main body and communicates with the driving device and the sensor, and the control system is configured to execute the control method according to any one of claims 1-9.
  11. 一种机器人充电座,包括:A charging stand for a robot, comprising:
    固定座,所述固定座与机器人活动区域的地面和/或墙面固定连接;A fixed seat, the fixed seat is fixedly connected to the ground and/or wall of the robot activity area;
    充电接口,所述充电接口设置于所述固定座上,充电接口配置成能够与充电槽配合,经充电槽向机器人供电;和A charging interface, the charging interface is arranged on the fixed seat, the charging interface is configured to be able to cooperate with the charging slot, and supply power to the robot through the charging slot; and
    定位面,所述定位面设置于所述固定座上,定位面具有预设的结构特征和/或光学特征,且定位面和充电接口的位置关系固定。A positioning surface, the positioning surface is arranged on the fixing seat, the positioning surface has preset structural features and/or optical features, and the positional relationship between the positioning surface and the charging interface is fixed.
  12. 一种计算机可读存储介质,包括存储于其上的计算机可执行命令,所述可执行命令在被处理器执行时实施如权利要求1-9中任一项所述的控制方法。A computer-readable storage medium, including computer-executable commands stored thereon, the executable commands implement the control method according to any one of claims 1-9 when executed by a processor.
PCT/CN2022/099744 2021-12-08 2022-06-20 Control method, robot, robot charging base, and computer-readable storage medium WO2023103326A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202111490286.2A CN114355889A (en) 2021-12-08 2021-12-08 Control method, robot charging stand, and computer-readable storage medium
CN202111490286.2 2021-12-08

Publications (1)

Publication Number Publication Date
WO2023103326A1 true WO2023103326A1 (en) 2023-06-15

Family

ID=81098079

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/099744 WO2023103326A1 (en) 2021-12-08 2022-06-20 Control method, robot, robot charging base, and computer-readable storage medium

Country Status (2)

Country Link
CN (1) CN114355889A (en)
WO (1) WO2023103326A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116700262A (en) * 2023-06-19 2023-09-05 国广顺能(上海)能源科技有限公司 Automatic recharging control method, device, equipment and medium for mobile robot

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115373375B (en) * 2021-05-18 2023-08-18 未岚大陆(北京)科技有限公司 Method and device for returning charging pile of robot, robot and storage medium
CN114355889A (en) * 2021-12-08 2022-04-15 上海擎朗智能科技有限公司 Control method, robot charging stand, and computer-readable storage medium

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20140184144A1 (en) * 2012-12-28 2014-07-03 Irobot Corporation Coverage Robot Docking Station
CN107765688A (en) * 2017-09-27 2018-03-06 深圳市神州云海智能科技有限公司 The control method and device of a kind of autonomous mobile robot and its automatic butt
US20210046205A1 (en) * 2019-08-16 2021-02-18 Patten Seed Company Autonomous robot to remove pathogens from a target area
CN112947441A (en) * 2021-02-06 2021-06-11 湖南擎谱数字科技有限公司 Control method for automatic butt-joint charging of robot and charging seat
CN112971616A (en) * 2021-02-07 2021-06-18 美智纵横科技有限责任公司 Charging seat avoiding method and device, sweeping robot and storage medium
CN113675923A (en) * 2021-08-23 2021-11-19 追觅创新科技(苏州)有限公司 Charging method, charging device and robot
CN114355889A (en) * 2021-12-08 2022-04-15 上海擎朗智能科技有限公司 Control method, robot charging stand, and computer-readable storage medium

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106843198B (en) * 2015-12-07 2020-09-11 北京奇虎科技有限公司 Automatic returning and charging method for sweeping robot, sweeping robot and charging seat
CN109976324B (en) * 2017-12-27 2022-06-28 深圳市优必选科技有限公司 Method for controlling robot charging, robot, and computer-readable storage medium
CN112198871A (en) * 2020-09-02 2021-01-08 创新工场(北京)企业管理股份有限公司 Method and apparatus for autonomous charging of mobile robot
CN112346453A (en) * 2020-10-14 2021-02-09 深圳市杉川机器人有限公司 Automatic robot recharging method and device, robot and storage medium
CN112792820B (en) * 2021-03-16 2021-09-14 千里眼(广州)人工智能科技有限公司 Automatic robot recharging method and device and robot system
CN113325841A (en) * 2021-05-14 2021-08-31 科沃斯机器人股份有限公司 Robot traveling control method and device
CN113696180A (en) * 2021-08-31 2021-11-26 千里眼(广州)人工智能科技有限公司 Robot automatic recharging method and device, storage medium and robot system

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20140184144A1 (en) * 2012-12-28 2014-07-03 Irobot Corporation Coverage Robot Docking Station
CN107765688A (en) * 2017-09-27 2018-03-06 深圳市神州云海智能科技有限公司 The control method and device of a kind of autonomous mobile robot and its automatic butt
US20210046205A1 (en) * 2019-08-16 2021-02-18 Patten Seed Company Autonomous robot to remove pathogens from a target area
CN112947441A (en) * 2021-02-06 2021-06-11 湖南擎谱数字科技有限公司 Control method for automatic butt-joint charging of robot and charging seat
CN112971616A (en) * 2021-02-07 2021-06-18 美智纵横科技有限责任公司 Charging seat avoiding method and device, sweeping robot and storage medium
CN113675923A (en) * 2021-08-23 2021-11-19 追觅创新科技(苏州)有限公司 Charging method, charging device and robot
CN114355889A (en) * 2021-12-08 2022-04-15 上海擎朗智能科技有限公司 Control method, robot charging stand, and computer-readable storage medium

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116700262A (en) * 2023-06-19 2023-09-05 国广顺能(上海)能源科技有限公司 Automatic recharging control method, device, equipment and medium for mobile robot
CN116700262B (en) * 2023-06-19 2024-03-15 国广顺能(上海)能源科技有限公司 Automatic recharging control method, device, equipment and medium for mobile robot

Also Published As

Publication number Publication date
CN114355889A (en) 2022-04-15

Similar Documents

Publication Publication Date Title
WO2023103326A1 (en) Control method, robot, robot charging base, and computer-readable storage medium
US20180120852A1 (en) Mobile robot and navigating method for mobile robot
CN107765688B (en) Autonomous mobile robot and automatic docking control method and device thereof
CN105700522B (en) A kind of robot charging method and its charging system
JP6816830B2 (en) A position estimation system and a mobile body equipped with the position estimation system.
US20170261975A1 (en) Systems and methods employing coded light to dock aerial drones, self-driving cars and surface robots
US20190278281A1 (en) Vehicle, method for controlling vehicle, and computer program
CN105958578B (en) The cradle and automatic charging system and method for a kind of robot
CN108431713B (en) Docking system and method for charging a mobile robot
WO2022246901A1 (en) Automatic charging system for substation inspection robot and method
TW201833702A (en) A vehicle performing obstacle avoidance operation and recording medium storing computer program thereof
CN111090284B (en) Method for returning self-walking equipment to base station and self-walking equipment
CN113359769B (en) Indoor autonomous mobile robot composite navigation method and device
CN110928307B (en) Automatic recharging method and system based on infrared laser, robot and charging dock
WO2021248844A1 (en) Charging connection system and laser connection method
CN111509801B (en) Control method and system for automatic equipment, automatic equipment and readable storage medium
CN110758152B (en) Intelligent robot, charging pile and intelligent robot autonomous charging and docking method
CN111476166B (en) Self-service charging alignment method for ground inspection robot
CN112236733A (en) Computerized system for guiding mobile robot to docking station and using method thereof
CN111240342A (en) Robot obstacle avoidance control method and device, robot and robot system
WO2023025028A1 (en) Charging method, charging apparatus, and robot
CN108627171A (en) The intelligent method of localization for Mobile Robot recharging base based on wireless signal strength gradient
CN112947441A (en) Control method for automatic butt-joint charging of robot and charging seat
CN112947440A (en) Charging seat searching method for automatic charging of robot
EP3842885A1 (en) Autonomous movement device, control method and storage medium

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22902764

Country of ref document: EP

Kind code of ref document: A1