WO2019205001A1 - Method and apparatus for positioning robot - Google Patents

Method and apparatus for positioning robot Download PDF

Info

Publication number
WO2019205001A1
WO2019205001A1 PCT/CN2018/084331 CN2018084331W WO2019205001A1 WO 2019205001 A1 WO2019205001 A1 WO 2019205001A1 CN 2018084331 W CN2018084331 W CN 2018084331W WO 2019205001 A1 WO2019205001 A1 WO 2019205001A1
Authority
WO
WIPO (PCT)
Prior art keywords
encoder
robot
track
predetermined
processor
Prior art date
Application number
PCT/CN2018/084331
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 深圳市大疆创新科技有限公司
Priority to PCT/CN2018/084331 priority Critical patent/WO2019205001A1/en
Priority to CN201880011046.XA priority patent/CN110546462A/en
Publication of WO2019205001A1 publication Critical patent/WO2019205001A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C22/00Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass

Definitions

  • the present invention relates to the field of robot positioning, and in particular, to a robot positioning method and device.
  • the invention provides a robot positioning method and device.
  • a robot positioning method wherein an encoder is mounted on a robot, wherein the robot cooperates with a predetermined track, and the predetermined track is provided with a fitting member adapted to the encoder;
  • the method includes:
  • the route is calibrated according to the position information of the fitting
  • the real-time position of the robot is determined based on the real-time distance of the encoder.
  • a robot positioning apparatus comprising an encoder and a processor each mounted on the robot, wherein the encoder is electrically connected to the processor, the robot and a predetermined a track fit, the predetermined track being provided with a fitting member adapted to the encoder;
  • the processor includes one or more, operating separately or collectively; the processor is configured to:
  • the route is calibrated according to the position information of the fitting
  • the real-time position of the robot is determined based on the real-time distance of the encoder.
  • a computer readable storage medium having stored thereon is a computer program that, when executed by a processor, implements the following steps:
  • the route is calibrated according to the position information of the fitting
  • the real-time position of the robot is determined based on the real-time distance of the encoder.
  • the present invention eliminates the cumulative error of the encoder by the cooperation of the encoder on the robot and the matching component on the predetermined track, thereby realizing the precise positioning of the robot and facilitating the execution strategy of the subsequent robot. (such as base defense, combating the fortress and other decisions) implementation; lower cost.
  • FIG. 1 is a diagram showing an application scenario of a robot in an embodiment of the present invention
  • FIG. 2 is a flow chart of a method for positioning a robot according to an embodiment of the present invention
  • FIG. 3 is a diagram showing an application scenario of a robot in another embodiment of the present invention.
  • FIG. 4 is a block diagram showing the structure of a robot positioning device in an embodiment of the present invention.
  • the robot 100 of the embodiment of the present invention is provided with an encoder.
  • the robot 100 cooperates with a predetermined rail 200
  • the predetermined rail 200 is provided with a fitting 210 adapted to the encoder.
  • the mating member 210 may be disposed at an intermediate position of the preset track along the length direction, or may be disposed at other positions of the predetermined track 200. Further, the mating component 210 may be directly mounted on the predetermined rail 200 or may be mounted on other structures but on the predetermined rail 200. Referring to FIG. 3, the fitting member 210 is located above the predetermined rail 200.
  • the predetermined rail 200 includes a rail body and a support column for supporting the predetermined rail 200, and the mating member 210 is assembled on The support post is aligned with a certain position of the track body.
  • the fitting 210 is hung on the support column.
  • the fitting 210 may include one or at least two. When the fitting member 210 includes at least two, at least two fitting members 210 are disposed at different positions of the predetermined rail 200.
  • the position of the encoder mounted on the robot 100 is not specifically limited in this embodiment.
  • the robot 100 includes a first driving wheel and a second driving wheel that are sandwiched on both sides of the predetermined rail 200.
  • the encoder is mounted between the first drive wheel and the second drive wheel.
  • the robot 100 of the embodiment may further include a referee lamp post for monitoring parameters such as the blood volume of the robot 100.
  • a referee lamp post for monitoring parameters such as the blood volume of the robot 100.
  • the referee lamp post faces outward, so that the back end monitors the referee lamp post of the current robot 100 in real time.
  • the robot 100 when the robot 100 is in a straight section (the rails are parallel on both sides), the two first driving wheels and the second driving wheel are parallelly sandwiched on both sides of the straight section, the first driving wheel
  • the line between the second drive wheel and the second drive wheel e.g., the center line of the first drive wheel and the second drive wheel
  • the sides of the straight section are vertical.
  • FIG. 2 is a flowchart of a method for positioning a robot according to an embodiment of the present invention.
  • the execution body of the robot positioning method of the embodiment is a processor, and the processor may be a central controller of the robot 100 or a separately set controller. As shown in FIG. 2, the method may include the following steps:
  • Step S201 controlling the robot 100 to move along the predetermined track 200;
  • the processor drives the drive wheel to move along the predetermined track 200 by a drive mechanism.
  • the driving mechanism may comprise a motor
  • the processor drives the driving wheel to rotate by controlling the rotation of the motor
  • the control mode of the processor controlling the rotation of the motor may select any existing control mode.
  • the first drive wheel and the second drive wheel are driven by respective drive mechanisms.
  • step S201 specifically includes: controlling the robot 100 to start moving along the predetermined track 200 from a specific position of the predetermined track 200.
  • the robot 100 of the present embodiment starts the movement with the specific position of the predetermined track 200 as a starting point, thereby using the specific position as a reference to facilitate subsequent positioning.
  • the robot 100 can also be controlled to move back and forth on the predetermined track 200 to calibrate the position of the robot 100.
  • step S201 further includes: controlling the robot 100 to reciprocate along a specific area range of the predetermined track 200.
  • the specific area range may be set according to the game requirements, for example, in some examples, the specific area range is the entire track. In other examples, the particular area ranges to a certain area of the predetermined track 200.
  • Step S202 Acquire a path of movement of the robot 100 based on the encoder
  • the encoder of this embodiment may be a quadrature encoder (ie, a photoelectric rotary incremental encoder), may also be a Hall element, or may be other encoders, such as an absolute encoder (relative to incremental). , electromagnetic encoder (relative to photoelectric).
  • Step S203 When the encoder meets the trigger condition, the route is calibrated according to the location information of the mating component 210;
  • the encoder is a quadrature encoder, and the occlusion cooperation of the quadrature encoder and the mating member 210 determines whether the robot 100 is running to the position where the mating member 210 is located, which is low in cost. In this embodiment, when it is determined that the orthogonal encoder is occluded by the fitting 210, it is determined that the encoder satisfies a trigger condition.
  • determining that the encoder satisfies a trigger condition comprises detecting that the quadrature encoder generates a hopping signal.
  • the quadrature encoder when the quadrature encoder is unoccluded, the output is low; when the quadrature encoder is occluded, the output is high.
  • detecting that the quadrature encoder generates the hopping signal includes detecting that the quadrature encoder jumps from a low level to a high level.
  • the quadrature encoder outputs a high level when the quadrature encoder is unoccluded, and outputs a low level when the quadrature encoder is occluded.
  • the quadrature encoder is blocked by the mating component 210 for a period of time, and the output of the quadrature encoder jumps from a high level to a low level.
  • the encoder is a Hall element
  • the mating member 210 is a magnet
  • the cooperation of the Hall element and the magnet determines whether the current robot 100 is running to the position of the magnet.
  • the encoder satisfies a trigger condition.
  • determining that the encoder satisfies a trigger condition comprises detecting that the Hall element generates a hopping signal.
  • detecting that the Hall element generates a transition signal includes: detecting The Hall element transitions from a low level to a high level.
  • detecting that the Hall element generates a transition signal includes: detecting The Hall element transitions from a high level to a low level.
  • the calibrating the route according to the position information of the mating component 210 includes: determining an error correction value according to the route and the position information of the mating component 210; and according to the error correction value, The route is corrected.
  • the position information of the fitting 210 refers to the distance between the fitting 210 and the specific position.
  • the control robot 100 starts to move from a specific position.
  • the encoder obtains the path S1, and the position information of the mating member 210 is S2, the error correction value can be determined according to S1 and S2.
  • ⁇ S S1 is corrected according to ⁇ S, that is, the calibration of the path is realized.
  • Step S204 Determine the real-time location of the robot 100 according to the real-time path of the encoder.
  • the present embodiment divides the predetermined track 200 into a plurality of segments in the length direction according to a preset rule.
  • the predetermined track 200 is divided along the length direction according to the shape of the predetermined track 200.
  • the predetermined track 200 includes a straight section and a curved section.
  • the predetermined track 200 is formed by a plurality of track splicings (such as welding), and the present embodiment divides the predetermined track 200 into a plurality of segments according to the splicing position.
  • the specific position is located on a specific segment of the plurality of tracks, and the mating member 210 is disposed at a designated position of the specific segment of the track.
  • the particular location is an end location of the particular segment of track, the designated location being a central location of the particular segment of the track.
  • the method further includes: acquiring a length of each segment of the track.
  • the manner of acquiring the length of each segment of the track may be selected according to requirements.
  • acquiring the length of each segment of the track specifically includes: controlling the robot 100 to run along each segment of the track; and detecting the track of each segment based on the encoder. length.
  • other existing ranging methods may also be used to measure the length of each segment of the track.
  • Step S204 specifically includes determining a real-time location of the robot 100 according to the real-time path of the encoder, the length of each segment of the track, and the location information of the specific location.
  • the length of each track is saved in advance as a coordinate reference, and the position of the current robot 100 can be calculated by combining the length of each segment and the current value of the encoder.
  • the predetermined track 200 includes a track 1, a track 2, a track 3, a track 4, and a track 5, and the track 1 is connected to the track 2, and the track 2 is connected to the track 3 away from one end of the track 1, and the track 3 is away from One end of the rail 2 is connected to the rail 4, and one end of the rail 4 away from the rail 3 is connected to the rail 5.
  • the length of the track 1 is 4000 mm
  • the control robot 100 starts from the end of the track 1 away from the track 2, and the encoder value is 0 before the robot 100 operates.
  • the path detected by the encoder is 2000 mm
  • the encoder on the robot 100 and the mating component 210 on the predetermined track 200 by the cooperation of the encoder on the robot 100 and the mating component 210 on the predetermined track 200, the cumulative error of the encoder is eliminated, and the precise positioning of the robot 100 is realized, which is beneficial to the execution strategy of the subsequent robot 100 (such as the base). Execution of defense, combating fortresses, etc.; lower cost.
  • an embodiment of the present invention further provides a robot 100 positioning device, which includes an encoder and a processor respectively mounted on the robot 100, wherein the encoder and the processor are electrically Connected, the robot 100 cooperates with a predetermined track 200, and the predetermined track 200 is provided with a fitting 210 adapted to the encoder;
  • the processor includes one or more, operating separately or collectively; the processor is configured to control movement of the robot 100 along the predetermined track 200; obtaining a path of movement of the robot 100 based on the encoder; When the encoder satisfies the trigger condition, the route is calibrated according to the position information of the fitting 210; and the real-time position of the robot 100 is determined according to the real-time distance of the encoder.
  • the processor may be a central processing unit (CPU).
  • the processor may further include a hardware chip.
  • the hardware chip may be an application-specific integrated circuit (ASIC), a programmable logic device (PLD), or a combination thereof.
  • the PLD may be a complex programmable logic device (CPLD), a field-programmable gate array (FPGA), a general array logic (GAL), or any combination thereof.
  • the robot 100 positioning device may further include a storage device.
  • the storage device may include a volatile memory such as a random-access memory (RAM); the storage device may also include a non-volatile memory such as a flash memory. (flash memory), hard disk drive (HDD) or solid-state drive (SSD); the first storage device may further include a combination of the above types of memories.
  • the storage device is configured to store program instructions.
  • the processor may invoke the program instructions to implement a cornering control method applied to the robot 100 as in the above embodiment.
  • the device embodiment since it basically corresponds to the method embodiment, reference may be made to the partial description of the method embodiment.
  • the device embodiments described above are merely illustrative, wherein the units described as separate components may or may not be physically separate, and the components displayed as units may or may not be physical units, ie may be located A place, or it can be distributed to multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the solution of the embodiment. Those of ordinary skill in the art can understand and implement without any creative effort.
  • the embodiment of the invention further provides a computer readable storage medium, on which a computer program is stored, which is implemented by the processor to implement the steps of the robot positioning method shown in FIG. 2.
  • a "computer-readable medium” can be any apparatus that can contain, store, communicate, propagate, or transport a program for use in an instruction execution system, apparatus, or device, or in conjunction with the instruction execution system, apparatus, or device.
  • computer readable media include the following: electrical connections (electronic devices) having one or more wires, portable computer disk cartridges (magnetic devices), random access memory (RAM), Read only memory (ROM), erasable editable read only memory (EPROM or flash memory), fiber optic devices, and portable compact disk read only memory (CDROM).
  • the computer readable medium may even be a paper or other suitable medium on which the program can be printed, as it may be optically scanned, for example by paper or other medium, followed by editing, interpretation or, if appropriate, other suitable The method is processed to obtain the program electronically and then stored in computer memory.
  • portions of the invention may be implemented in hardware, software, firmware or a combination thereof.
  • multiple steps or methods may be implemented in software or firmware stored in a memory and executed by a suitable instruction execution system.
  • a suitable instruction execution system For example, if implemented in hardware, as in another embodiment, it can be implemented with any one or combination of the following techniques well known in the art: having logic gates for implementing logic functions on data signals. Discrete logic circuits, application specific integrated circuits with suitable combinational logic gates, programmable gate arrays (PGAs), field programmable gate arrays (FPGAs), etc.
  • each functional unit in each embodiment of the present invention may be integrated into one processing module, or each unit may exist physically separately, or two or more units may be integrated into one module.
  • the above integrated modules can be implemented in the form of hardware or in the form of software functional modules.
  • the integrated modules, if implemented in the form of software functional modules and sold or used as stand-alone products, may also be stored in a computer readable storage medium.
  • the above mentioned storage medium may be a read only memory, a magnetic disk or an optical disk or the like.

Landscapes

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

Abstract

A method and apparatus for positioning a robot (100). An encoder is installed on the robot (100). The robot (100) matches with a predetermined rail (200). A fitting member (210) adapted to the encoder is provided on the predetermined rail (200). The method comprises: controlling the robot (100) to move along the predetermined rail (200); obtaining a movement path of the robot (100) based on the encoder; when the encoder meets a trigger condition, calibrating the path according to position information of the fitting member (210); and determining the real-time position of the robot (100) according to the real-time path of the encoder. By means of the method and apparatus for positioning a robot (100), the accumulative error of the encoder is eliminated by matching the encoder on the robot (100) with the fitting member (210) on the predetermined rail (200), the accurate positioning of the robot (100) is achieved, and it is beneficial to the subsequent execution of an executive strategy of the robot (100) (such as base defense and fortress fight), and the cost is low.

Description

机器人定位方法和装置Robot positioning method and device 技术领域Technical field
本发明涉及机器人定位领域,尤其涉及一种机器人定位方法和装置。The present invention relates to the field of robot positioning, and in particular, to a robot positioning method and device.
背景技术Background technique
近年来,为了普及机器人实践教育,引导参赛人员学习多领域知识点,国内外会组织各种机器人对抗比赛。在机器人对抗比赛中,有些机器人可以在专用的单条轨道上运行,并可以发射弹丸,机器人定位的精确性影响该种机器人的打击精度。In recent years, in order to popularize robot practice education and guide participants to learn multi-domain knowledge points, various robots will compete in competitions at home and abroad. In the robot confrontation competition, some robots can run on a dedicated single track and can launch projectiles. The accuracy of the robot positioning affects the accuracy of the robot.
目前,采用GPS、激光雷达扫图定位或者UWB室内定位方式对所有机器人进行定位。由于机器人对抗比赛大都在室内进行,GPS在室内使用会受到影响;激光雷达扫图定位,首先成本较高,其次机器人对抗比赛对这种机器人的尺寸和重量有所限制,而激光雷达扫图定位对空间有一定需求,难以满足;UWB室内定位需要基站才可运行,而机器人对抗比赛中只能使用指定的UWB定位,若参赛队要做赛前的调试,需要自行购买套装,成本较高。At present, all robots are positioned using GPS, lidar scan map positioning or UWB indoor positioning. Since the robots are mostly played indoors, the GPS will be affected indoors. The laser radar scanning position is first costly. Secondly, the robot confrontation competition limits the size and weight of the robot, and the laser radar scan map is positioned. There is a certain demand for space, which is difficult to meet; UWB indoor positioning requires a base station to operate, and the robot can only use the specified UWB positioning in the competition. If the team wants to debug before the game, it needs to purchase the package by itself, and the cost is high.
发明内容Summary of the invention
本发明提供一种机器人定位方法和装置。The invention provides a robot positioning method and device.
具体地,本发明是通过如下技术方案实现的:Specifically, the present invention is achieved by the following technical solutions:
根据本发明的第一方面,提供一种机器人定位方法,机器人上装设有编码器,其中,所述机器人与预定轨道配合,所述预定轨道上设有与所述编码器适配的配合件;所述方法包括:According to a first aspect of the present invention, a robot positioning method is provided, wherein an encoder is mounted on a robot, wherein the robot cooperates with a predetermined track, and the predetermined track is provided with a fitting member adapted to the encoder; The method includes:
控制所述机器人沿着所述预定轨道运动;Controlling the robot to move along the predetermined orbit;
基于所述编码器获取所述机器人运动的路程;Acquiring a distance of the robot motion based on the encoder;
当所述编码器满足触发条件时,根据所述配合件的位置信息,对所述路程进行校准;When the encoder meets the trigger condition, the route is calibrated according to the position information of the fitting;
根据所述编码器的实时路程,确定所述机器人的实时位置。The real-time position of the robot is determined based on the real-time distance of the encoder.
根据本发明的第二方面,提供一种机器人定位装置,包括均装设于所述机器人上的编码器和处理器,其中,所述编码器与所述处理器电连接,所述机器人与预定轨道配合,所述预定轨道上设有与所述编码器适配的配合件;According to a second aspect of the present invention, there is provided a robot positioning apparatus comprising an encoder and a processor each mounted on the robot, wherein the encoder is electrically connected to the processor, the robot and a predetermined a track fit, the predetermined track being provided with a fitting member adapted to the encoder;
所述处理器包括一个或多个,单独地或共同地工作;所述处理器用于:The processor includes one or more, operating separately or collectively; the processor is configured to:
控制所述机器人沿着所述预定轨道运动;Controlling the robot to move along the predetermined orbit;
基于所述编码器获取所述机器人运动的路程;Acquiring a distance of the robot motion based on the encoder;
当所述编码器满足触发条件时,根据所述配合件的位置信息,对所述路程进行校准;When the encoder meets the trigger condition, the route is calibrated according to the position information of the fitting;
根据所述编码器的实时路程,确定所述机器人的实时位置。The real-time position of the robot is determined based on the real-time distance of the encoder.
根据本发明的第三方面,提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现如下步骤:According to a third aspect of the present invention, a computer readable storage medium having stored thereon is a computer program that, when executed by a processor, implements the following steps:
控制所述机器人沿着所述预定轨道运动;Controlling the robot to move along the predetermined orbit;
基于所述编码器获取所述机器人运动的路程;Acquiring a distance of the robot motion based on the encoder;
当所述编码器满足触发条件时,根据所述配合件的位置信息,对所述路程进行校准;When the encoder meets the trigger condition, the route is calibrated according to the position information of the fitting;
根据所述编码器的实时路程,确定所述机器人的实时位置。The real-time position of the robot is determined based on the real-time distance of the encoder.
由以上本发明实施例提供的技术方案可见,本发明通过机器人上的编码器和预定轨道上的配合件的配合,消除编码器的累积误差,实现机器人的精确定位,有利于后续机器人的执行策略(比如基地防御、打击堡垒等决策)的执行;成本较低。It can be seen from the technical solutions provided by the embodiments of the present invention that the present invention eliminates the cumulative error of the encoder by the cooperation of the encoder on the robot and the matching component on the predetermined track, thereby realizing the precise positioning of the robot and facilitating the execution strategy of the subsequent robot. (such as base defense, combating the fortress and other decisions) implementation; lower cost.
附图说明DRAWINGS
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the drawings used in the description of the embodiments will be briefly described below. It is obvious that the drawings in the following description are only some embodiments of the present invention. Other drawings may also be obtained from those of ordinary skill in the art in view of the drawings.
图1是本发明一实施例中的机器人的应用场景图;1 is a diagram showing an application scenario of a robot in an embodiment of the present invention;
图2是本发明一实施例中的机器人定位方法的方法流程图;2 is a flow chart of a method for positioning a robot according to an embodiment of the present invention;
图3是本发明另一实施例中的机器人的应用场景图;3 is a diagram showing an application scenario of a robot in another embodiment of the present invention;
图4是本发明一实施例中的机器人定位装置的结构框图。4 is a block diagram showing the structure of a robot positioning device in an embodiment of the present invention.
具体实施方式detailed description
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The technical solutions in the embodiments of the present invention are clearly and completely described in the following with reference to the accompanying drawings in the embodiments of the present invention. It is obvious that the described embodiments are only a part of the embodiments of the present invention, but not all embodiments. All other embodiments obtained by those skilled in the art based on the embodiments of the present invention without creative efforts are within the scope of the present invention.
下面结合附图,对本发明的机器人定位方法和装置进行详细说明。在不冲突的情况下,下述的实施例及实施方式中的特征可以相互组合。The robot positioning method and apparatus of the present invention will be described in detail below with reference to the accompanying drawings. The features of the embodiments and embodiments described below may be combined with each other without conflict.
本发明实施例的机器人100上装设有编码器,参见图1,所述机器人100与预 定轨道200配合,所述预定轨道200上设有与所述编码器适配的配合件210。配合件210可以设于所述预设轨道沿长度方向的中间位置,也可以设于所述预定轨道200的其他位置。进一步地,所述配合件210可以直接装设于所述预定轨道200上,也可以装设在其他结构上但位于所述预定轨道200上。参见图3,所述配合件210位于所述预定轨道200上方,本实施例中,所述预定轨道200包括轨道本体和用于支撑所述预定轨道200的支撑柱,所述配合件210装配在所述支撑柱上并与所述轨道本体的某一位置对准。可选地,所述配合件210悬挂在所述支撑柱上。所述配合件210可包括一个或至少两个。当所述配合件210包括至少两个时,至少两个配合件210设于所述预定轨道200的不同位置。The robot 100 of the embodiment of the present invention is provided with an encoder. Referring to Fig. 1, the robot 100 cooperates with a predetermined rail 200, and the predetermined rail 200 is provided with a fitting 210 adapted to the encoder. The mating member 210 may be disposed at an intermediate position of the preset track along the length direction, or may be disposed at other positions of the predetermined track 200. Further, the mating component 210 may be directly mounted on the predetermined rail 200 or may be mounted on other structures but on the predetermined rail 200. Referring to FIG. 3, the fitting member 210 is located above the predetermined rail 200. In the embodiment, the predetermined rail 200 includes a rail body and a support column for supporting the predetermined rail 200, and the mating member 210 is assembled on The support post is aligned with a certain position of the track body. Optionally, the fitting 210 is hung on the support column. The fitting 210 may include one or at least two. When the fitting member 210 includes at least two, at least two fitting members 210 are disposed at different positions of the predetermined rail 200.
本实施例对编码器安装在机器人100上的位置不作具体限定,例如,在一实施例中,机器人100包括夹设在所述预定轨道200两侧的第一驱动轮和第二驱动轮,所述编码器安装在所述第一驱动轮和所述第二驱动轮之间。The position of the encoder mounted on the robot 100 is not specifically limited in this embodiment. For example, in an embodiment, the robot 100 includes a first driving wheel and a second driving wheel that are sandwiched on both sides of the predetermined rail 200. The encoder is mounted between the first drive wheel and the second drive wheel.
此外,本实施例的机器人100还可以包括裁判灯柱,用于监控机器人100的血量等参数。本实施例的机器人100在安装至预定轨道200时,裁判灯柱朝向外,以便于后端实时监控当前机器人100的裁判灯柱。In addition, the robot 100 of the embodiment may further include a referee lamp post for monitoring parameters such as the blood volume of the robot 100. When the robot 100 of the embodiment is mounted to the predetermined track 200, the referee lamp post faces outward, so that the back end monitors the referee lamp post of the current robot 100 in real time.
在本实施例中,机器人100在平直段(两侧边平行的轨道)时,两个第一驱动轮和第二驱动轮之间平行夹设于平直段的两侧,第一驱动轮和第二驱动轮之间的连线(例如,第一驱动轮和第二驱动轮的中心连线)几乎是和平直段的侧边是垂直。In this embodiment, when the robot 100 is in a straight section (the rails are parallel on both sides), the two first driving wheels and the second driving wheel are parallelly sandwiched on both sides of the straight section, the first driving wheel The line between the second drive wheel and the second drive wheel (e.g., the center line of the first drive wheel and the second drive wheel) is nearly vertical and the sides of the straight section are vertical.
图2为本发明实施例提供的一种机器人定位方法的方法流程图。本实施例的机器人定位方法的执行主体为处理器,所述处理器可以为所述机器人100的中央控制器,也可以为独立设置的控制器。如图2所示,所述方法可以包括如下步骤:FIG. 2 is a flowchart of a method for positioning a robot according to an embodiment of the present invention. The execution body of the robot positioning method of the embodiment is a processor, and the processor may be a central controller of the robot 100 or a separately set controller. As shown in FIG. 2, the method may include the following steps:
步骤S201:控制所述机器人100沿着所述预定轨道200运动;Step S201: controlling the robot 100 to move along the predetermined track 200;
本实施例中,处理器通过驱动机构来驱动所述驱动轮沿着所述预定轨道200运动。其中,所述驱动机构可以包括电机,处理器通过控制电机的转动以驱动所述驱动轮转动,而处理器控制电机进行转动的控制方式可选择现有任意控制方式。本实施例中,第一驱动轮和第二驱动轮是由各自的驱动机构驱动的。In this embodiment, the processor drives the drive wheel to move along the predetermined track 200 by a drive mechanism. Wherein, the driving mechanism may comprise a motor, the processor drives the driving wheel to rotate by controlling the rotation of the motor, and the control mode of the processor controlling the rotation of the motor may select any existing control mode. In this embodiment, the first drive wheel and the second drive wheel are driven by respective drive mechanisms.
进一步地,在本实施例中,步骤S201具体包括:控制所述机器人100由所述预定轨道200的特定位置开始沿着所述预定轨道200运动。本实施例的机器人100以所述预定轨道200的特定位置作为起点开始运动,从而将该特定位置作为参照,便于后续的定位。而在其他实施例中,也可以控制所述机器人100在所述预定轨道200上来回运动,从而校准机器人100的位置。Further, in the embodiment, step S201 specifically includes: controlling the robot 100 to start moving along the predetermined track 200 from a specific position of the predetermined track 200. The robot 100 of the present embodiment starts the movement with the specific position of the predetermined track 200 as a starting point, thereby using the specific position as a reference to facilitate subsequent positioning. In other embodiments, the robot 100 can also be controlled to move back and forth on the predetermined track 200 to calibrate the position of the robot 100.
另外,在本实施例中,步骤S201还包括:控制所述机器人100沿着所述预定轨道200的特定区域范围往返运动。其中,特定区域范围可根据比赛需求设定,例如,在一些例子中,所述特定区域范围为整个轨道。在另一些例子中,所述特定区域范围 为所述预定轨道200的某个区域。In addition, in the embodiment, step S201 further includes: controlling the robot 100 to reciprocate along a specific area range of the predetermined track 200. Wherein, the specific area range may be set according to the game requirements, for example, in some examples, the specific area range is the entire track. In other examples, the particular area ranges to a certain area of the predetermined track 200.
步骤S202:基于所述编码器获取所述机器人100运动的路程;Step S202: Acquire a path of movement of the robot 100 based on the encoder;
本实施例的编码器可以为正交编码器(即光电旋转增量式编码器),也可以为霍尔元件,还可以为其他的编码器,比如绝对式编码器(相对于增量式)、电磁式编码器(相对于光电式)。The encoder of this embodiment may be a quadrature encoder (ie, a photoelectric rotary incremental encoder), may also be a Hall element, or may be other encoders, such as an absolute encoder (relative to incremental). , electromagnetic encoder (relative to photoelectric).
步骤S203:当所述编码器满足触发条件时,根据所述配合件210的位置信息,对所述路程进行校准;Step S203: When the encoder meets the trigger condition, the route is calibrated according to the location information of the mating component 210;
在一实施例中,所述编码器为正交编码器,通过正交编码器和配合件210的遮挡配合来确定机器人100是否运行至配合件210所在的位置,成本较低。本实施例中,在确定出所述正交编码器被所述配合件210遮挡时,确定所述编码器满足触发条件。In an embodiment, the encoder is a quadrature encoder, and the occlusion cooperation of the quadrature encoder and the mating member 210 determines whether the robot 100 is running to the position where the mating member 210 is located, which is low in cost. In this embodiment, when it is determined that the orthogonal encoder is occluded by the fitting 210, it is determined that the encoder satisfies a trigger condition.
进一步地,确定所述编码器满足触发条件包括:检测到所述正交编码器产生跳变信号。在一些例子中,正交编码器未被遮挡时,输出低电平;正交编码器被遮挡时,输出高电平。本实施例中,当机器人100经过配合件210时,正交编码器发出的红外光会被配合件210遮挡一段时间,正交编码器的输出结果从低电平跳变至高电平。故本实施例检测到所述正交编码器产生跳变信号包括:检测到所述正交编码器由低电平跳变至高电平。而在其他实施例中,正交编码器未被遮挡时,输出高电平;正交编码器被遮挡时,输出低电平。本实施例中,当机器人100经过配合件210时,正交编码器会被配合件210遮挡一段时间,正交编码器的输出结果从高电平跳变至低电平。Further, determining that the encoder satisfies a trigger condition comprises detecting that the quadrature encoder generates a hopping signal. In some examples, when the quadrature encoder is unoccluded, the output is low; when the quadrature encoder is occluded, the output is high. In this embodiment, when the robot 100 passes through the mating component 210, the infrared light emitted by the quadrature encoder is blocked by the mating component 210 for a period of time, and the output of the quadrature encoder jumps from a low level to a high level. Therefore, detecting that the quadrature encoder generates the hopping signal includes detecting that the quadrature encoder jumps from a low level to a high level. In other embodiments, the quadrature encoder outputs a high level when the quadrature encoder is unoccluded, and outputs a low level when the quadrature encoder is occluded. In this embodiment, when the robot 100 passes the mating component 210, the quadrature encoder is blocked by the mating component 210 for a period of time, and the output of the quadrature encoder jumps from a high level to a low level.
在另一实施例中,所述编码器为霍尔元件,所述配合件210为磁铁,通过霍尔元件与磁铁的配合,来确定当前机器人100是否运行至磁铁所在位置。本实施例总,在确定出所述霍尔元件与所述磁铁相对准时,确定所述编码器满足触发条件。In another embodiment, the encoder is a Hall element, and the mating member 210 is a magnet, and the cooperation of the Hall element and the magnet determines whether the current robot 100 is running to the position of the magnet. In this embodiment, when it is determined that the Hall element is in alignment with the magnet, it is determined that the encoder satisfies a trigger condition.
进一步地,确定所述编码器满足触发条件包括:检测到所述霍尔元件产生跳变信号。在一些例子中,霍尔元件未与磁铁对准时,输出低电平;霍尔元件与磁铁对准时,输出高电平,本实施例检测到所述霍尔元件产生跳变信号包括:检测到所述霍尔元件由低电平跳变至高电平。在另一些例子中,霍尔元件未与磁铁对准时,输出高电平;霍尔元件与磁铁对准时,输出低电平,本实施例检测到所述霍尔元件产生跳变信号包括:检测到所述霍尔元件由高电平跳变至低电平。Further, determining that the encoder satisfies a trigger condition comprises detecting that the Hall element generates a hopping signal. In some examples, when the Hall element is not aligned with the magnet, a low level is output; when the Hall element is aligned with the magnet, a high level is output. In this embodiment, detecting that the Hall element generates a transition signal includes: detecting The Hall element transitions from a low level to a high level. In other examples, when the Hall element is not aligned with the magnet, a high level is output; when the Hall element is aligned with the magnet, a low level is output. In this embodiment, detecting that the Hall element generates a transition signal includes: detecting The Hall element transitions from a high level to a low level.
本实施例中,根据所述配合件210的位置信息,对所述路程进行校准包括:根据所述路程和所述配合件210的位置信息,确定误差修正值;根据所述误差修正值,对所述路程进行修正。可选地,所述配合件210的位置信息是指所述配合件210与所述特定位置之间的距离。控制机器人100从特定位置开始运动,当机器人100第一次经过配合件210时,编码器获得的路程为S1,而配合件210的位置信息为S2,则可以根据S1和S2,确定误差修正值ΔS,根据ΔS对S1进行修正,即实现对路程的校准。In this embodiment, the calibrating the route according to the position information of the mating component 210 includes: determining an error correction value according to the route and the position information of the mating component 210; and according to the error correction value, The route is corrected. Optionally, the position information of the fitting 210 refers to the distance between the fitting 210 and the specific position. The control robot 100 starts to move from a specific position. When the robot 100 passes the mating member 210 for the first time, the encoder obtains the path S1, and the position information of the mating member 210 is S2, the error correction value can be determined according to S1 and S2. ΔS, S1 is corrected according to ΔS, that is, the calibration of the path is realized.
步骤S204:根据所述编码器的实时路程,确定所述机器人100的实时位置。Step S204: Determine the real-time location of the robot 100 according to the real-time path of the encoder.
本实施例将预定轨道200根据预设规则沿长度方向上划分为多段,例如,在一些例子中,根据所述预定轨道200的形状,对所述预定轨道200沿长度方向进行划分。可选地,所述预定轨道200包括平直段和弯曲段。在另一些例子中,所述预定轨道200由多段轨道拼接(比如焊接)形成,本实施例根据拼接位置将所述预定轨道200划分为多段。The present embodiment divides the predetermined track 200 into a plurality of segments in the length direction according to a preset rule. For example, in some examples, the predetermined track 200 is divided along the length direction according to the shape of the predetermined track 200. Optionally, the predetermined track 200 includes a straight section and a curved section. In other examples, the predetermined track 200 is formed by a plurality of track splicings (such as welding), and the present embodiment divides the predetermined track 200 into a plurality of segments according to the splicing position.
在本实施例中,所述特定位置位于所述多段轨道中特定段轨道上,所述配合件210设于所述特定段轨道的指定位置。例如,在一实施例中,所述特定位置为所述特定段轨道的端部位置,所述指定位置为所述特定段轨道的中部位置。In this embodiment, the specific position is located on a specific segment of the plurality of tracks, and the mating member 210 is disposed at a designated position of the specific segment of the track. For example, in an embodiment, the particular location is an end location of the particular segment of track, the designated location being a central location of the particular segment of the track.
进一步地,控制所述机器人100由所述预定轨道200的特定位置开始沿着所述预定轨道200运动之前,所述方法还包括:获取各段轨道的长度。Further, before controlling the robot 100 to start moving along the predetermined track 200 from a specific position of the predetermined track 200, the method further includes: acquiring a length of each segment of the track.
各段轨道的长度的获取方式可根据需要选择,在一实施例中,获取各段轨道的长度具体包括:控制所述机器人100沿着各段轨道运行;基于所述编码器检测各段轨道的长度。而在另一些实施例中,也可以采用其他现有测距方式测量各段轨道的长度。The manner of acquiring the length of each segment of the track may be selected according to requirements. In an embodiment, acquiring the length of each segment of the track specifically includes: controlling the robot 100 to run along each segment of the track; and detecting the track of each segment based on the encoder. length. In other embodiments, other existing ranging methods may also be used to measure the length of each segment of the track.
步骤S204具体包括:根据所述编码器的实时路程、各段轨道的长度以及所述特定位置的位置信息,确定所述机器人100的实时位置。Step S204 specifically includes determining a real-time location of the robot 100 according to the real-time path of the encoder, the length of each segment of the track, and the location information of the specific location.
本实施例预先保存各段轨道的长度,以作为坐标基准使用,结合每一段的长度以及编码器当前的数值就可以计算当前机器人100的位置。举例而言,参见图3,所述预定轨道200包括轨道1、轨道2、轨道3、轨道4和轨道5,轨道1与轨道2相连,轨道2远离轨道1的一端连接轨道3,轨道3远离轨道2的一端连接轨道4,轨道4远离轨道3的一端连接轨道5。其中,轨道1的长度为4000mm,控制机器人100从轨道1远离轨道2的一端开始运行,在机器人100运行前,编码器数值为0。控制机器人100运行的过程中,若编码器检测的路程为2000mm,则确定出机器人100位于轨道1的中间。若编码器检测的路程大于4000mm并小于4000mm+轨道2的长度,则能够确定机器人100已经进入轨道2。In this embodiment, the length of each track is saved in advance as a coordinate reference, and the position of the current robot 100 can be calculated by combining the length of each segment and the current value of the encoder. For example, referring to FIG. 3, the predetermined track 200 includes a track 1, a track 2, a track 3, a track 4, and a track 5, and the track 1 is connected to the track 2, and the track 2 is connected to the track 3 away from one end of the track 1, and the track 3 is away from One end of the rail 2 is connected to the rail 4, and one end of the rail 4 away from the rail 3 is connected to the rail 5. Wherein, the length of the track 1 is 4000 mm, and the control robot 100 starts from the end of the track 1 away from the track 2, and the encoder value is 0 before the robot 100 operates. In the process of controlling the operation of the robot 100, if the path detected by the encoder is 2000 mm, it is determined that the robot 100 is located in the middle of the track 1. If the encoder detects a path greater than 4000 mm and less than 4000 mm + the length of the track 2, it can be determined that the robot 100 has entered the track 2.
本发明实施例中,通过机器人100上的编码器和预定轨道200上的配合件210的配合,消除编码器的累积误差,实现机器人100的精确定位,有利于后续机器人100的执行策略(比如基地防御、打击堡垒等决策)的执行;成本较低。In the embodiment of the present invention, by the cooperation of the encoder on the robot 100 and the mating component 210 on the predetermined track 200, the cumulative error of the encoder is eliminated, and the precise positioning of the robot 100 is realized, which is beneficial to the execution strategy of the subsequent robot 100 (such as the base). Execution of defense, combating fortresses, etc.; lower cost.
参见图4,本发明实施例还提供一种机器人100定位装置,其特征在于,包括均装设于所述机器人100上的编码器和处理器,其中,所述编码器与所述处理器电连接,所述机器人100与预定轨道200配合,所述预定轨道200上设有与所述编码器适配的配合件210;Referring to FIG. 4, an embodiment of the present invention further provides a robot 100 positioning device, which includes an encoder and a processor respectively mounted on the robot 100, wherein the encoder and the processor are electrically Connected, the robot 100 cooperates with a predetermined track 200, and the predetermined track 200 is provided with a fitting 210 adapted to the encoder;
所述处理器包括一个或多个,单独地或共同地工作;所述处理器用于控制所述 机器人100沿着所述预定轨道200运动;基于所述编码器获取所述机器人100运动的路程;当所述编码器满足触发条件时,根据所述配合件210的位置信息,对所述路程进行校准;根据所述编码器的实时路程,确定所述机器人100的实时位置。The processor includes one or more, operating separately or collectively; the processor is configured to control movement of the robot 100 along the predetermined track 200; obtaining a path of movement of the robot 100 based on the encoder; When the encoder satisfies the trigger condition, the route is calibrated according to the position information of the fitting 210; and the real-time position of the robot 100 is determined according to the real-time distance of the encoder.
本发明实施例提供的机器人100定位装置的具体原理和实现方式均与图2所示实施例类似,此处不再赘述。The specific principles and implementations of the positioning device of the robot 100 provided by the embodiment of the present invention are similar to the embodiment shown in FIG. 2, and details are not described herein again.
本实施例中,所述处理器可以是中央处理器(central processing unit,CPU)。所述处理器还可以进一步包括硬件芯片。上述硬件芯片可以是专用集成电路(application-specific integrated circuit,ASIC),可编程逻辑器件(programmable logic device,PLD)或其组合。上述PLD可以是复杂可编程逻辑器件(complex programmable logic device,CPLD),现场可编程逻辑门阵列(field-programmable gate array,FPGA),通用阵列逻辑(generic array logic,GAL)或其任意组合。In this embodiment, the processor may be a central processing unit (CPU). The processor may further include a hardware chip. The hardware chip may be an application-specific integrated circuit (ASIC), a programmable logic device (PLD), or a combination thereof. The PLD may be a complex programmable logic device (CPLD), a field-programmable gate array (FPGA), a general array logic (GAL), or any combination thereof.
进一步地,所述机器人100定位装置还可包括存储装置。所述存储装置可以包括易失性存储器(volatile memory),例如随机存取存储器(random-access memory,RAM);存储装置也可以包括非易失性存储器(non-volatile memory),例如快闪存储器(flash memory),硬盘(hard disk drive,HDD)或固态硬盘(solid-state drive,SSD);第一存储装置还可以包括上述种类的存储器的组合。可选地,所述存储装置用于存储程序指令。所述处理器可以调用所述程序指令,实现如上述实施例应用在机器人100上的过弯控制方法。Further, the robot 100 positioning device may further include a storage device. The storage device may include a volatile memory such as a random-access memory (RAM); the storage device may also include a non-volatile memory such as a flash memory. (flash memory), hard disk drive (HDD) or solid-state drive (SSD); the first storage device may further include a combination of the above types of memories. Optionally, the storage device is configured to store program instructions. The processor may invoke the program instructions to implement a cornering control method applied to the robot 100 as in the above embodiment.
对于装置实施例而言,由于其基本对应于方法实施例,所以相关之处参见方法实施例的部分说明即可。以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。本领域普通技术人员在不付出创造性劳动的情况下,即可以理解并实施。For the device embodiment, since it basically corresponds to the method embodiment, reference may be made to the partial description of the method embodiment. The device embodiments described above are merely illustrative, wherein the units described as separate components may or may not be physically separate, and the components displayed as units may or may not be physical units, ie may be located A place, or it can be distributed to multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the solution of the embodiment. Those of ordinary skill in the art can understand and implement without any creative effort.
本发明实施例还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现如图2所示的机器人定位方法的步骤。The embodiment of the invention further provides a computer readable storage medium, on which a computer program is stored, which is implemented by the processor to implement the steps of the robot positioning method shown in FIG. 2.
“具体示例”、或“一些示例”等的描述意指结合所述实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。The description of the "specific examples", or "some examples" and the like are intended to be included in the particular features, structures, materials or features described in connection with the embodiments or examples. In the present specification, the schematic representation of the above terms does not necessarily mean the same embodiment or example. Furthermore, the particular features, structures, materials, or characteristics described may be combined in a suitable manner in any one or more embodiments or examples.
流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为,表示包括一个或更多个用于实现特定逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分,并且本发明的优选实施例的范围包括另外的实现,其中可以不按所示出或 讨论的顺序,包括根据所涉及的功能按基本同时的方式或按相反的顺序,来执行功能,这应被本发明的实施例所属技术领域的技术人员所理解。Any process or method description in the flowcharts or otherwise described herein may be understood to represent a module, segment or portion of code that includes one or more executable instructions for implementing the steps of a particular logical function or process. And the scope of the preferred embodiments of the present invention includes additional implementations in which the functions may be performed in a substantially simultaneous manner or in the reverse order, depending on the order in which they are illustrated. It will be understood by those skilled in the art to which the embodiments of the present invention pertain.
在流程图中表示或在此以其他方式描述的逻辑和/或步骤,例如,可以被认为是用于实现逻辑功能的可执行指令的定序列表,可以具体实现在任何计算机可读介质中,以供指令执行系统、装置或设备(如基于计算机的系统、包括处理器的系统或其他可以从指令执行系统、装置或设备取指令并执行指令的系统)使用,或结合这些指令执行系统、装置或设备而使用。就本说明书而言,"计算机可读介质"可以是任何可以包含、存储、通信、传播或传输程序以供指令执行系统、装置或设备或结合这些指令执行系统、装置或设备而使用的装置。计算机可读介质的更具体的示例(非穷尽性列表)包括以下:具有一个或多个布线的电连接部(电子装置),便携式计算机盘盒(磁装置),随机存取存储器(RAM),只读存储器(ROM),可擦除可编辑只读存储器(EPROM或闪速存储器),光纤装置,以及便携式光盘只读存储器(CDROM)。另外,计算机可读介质甚至可以是可在其上打印所述程序的纸或其他合适的介质,因为可以例如通过对纸或其他介质进行光学扫描,接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得所述程序,然后将其存储在计算机存储器中。The logic and/or steps represented in the flowchart or otherwise described herein, for example, may be considered as an ordered list of executable instructions for implementing logical functions, and may be embodied in any computer readable medium, Used in conjunction with, or in conjunction with, an instruction execution system, apparatus, or device (eg, a computer-based system, a system including a processor, or other system that can fetch instructions and execute instructions from an instruction execution system, apparatus, or device) Or use with equipment. For the purposes of this specification, a "computer-readable medium" can be any apparatus that can contain, store, communicate, propagate, or transport a program for use in an instruction execution system, apparatus, or device, or in conjunction with the instruction execution system, apparatus, or device. More specific examples (non-exhaustive list) of computer readable media include the following: electrical connections (electronic devices) having one or more wires, portable computer disk cartridges (magnetic devices), random access memory (RAM), Read only memory (ROM), erasable editable read only memory (EPROM or flash memory), fiber optic devices, and portable compact disk read only memory (CDROM). In addition, the computer readable medium may even be a paper or other suitable medium on which the program can be printed, as it may be optically scanned, for example by paper or other medium, followed by editing, interpretation or, if appropriate, other suitable The method is processed to obtain the program electronically and then stored in computer memory.
应当理解,本发明的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施例中,多个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来实现。例如,如果用硬件来实现,和在另一实施例中一样,可用本领域公知的下列技术中的任一项或他们的组合来实现:具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。It should be understood that portions of the invention may be implemented in hardware, software, firmware or a combination thereof. In the above embodiments, multiple steps or methods may be implemented in software or firmware stored in a memory and executed by a suitable instruction execution system. For example, if implemented in hardware, as in another embodiment, it can be implemented with any one or combination of the following techniques well known in the art: having logic gates for implementing logic functions on data signals. Discrete logic circuits, application specific integrated circuits with suitable combinational logic gates, programmable gate arrays (PGAs), field programmable gate arrays (FPGAs), etc.
本技术领域的普通技术人员可以理解实现上述实施方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成,所述的程序可以存储于一种计算机可读存储介质中,该程序在执行时,包括方法实施例的步骤之一或其组合。A person skilled in the art can understand that all or part of the steps carried in implementing the above implementation method can be completed by a program to instruct related hardware, and the program can be stored in a computer readable storage medium, and the program is executed. Including one or a combination of the steps of the method embodiments.
此外,在本发明各个实施例中的各功能单元可以集成在一个处理模块中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。所述集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时,也可以存储在一个计算机可读取存储介质中。In addition, each functional unit in each embodiment of the present invention may be integrated into one processing module, or each unit may exist physically separately, or two or more units may be integrated into one module. The above integrated modules can be implemented in the form of hardware or in the form of software functional modules. The integrated modules, if implemented in the form of software functional modules and sold or used as stand-alone products, may also be stored in a computer readable storage medium.
上述提到的存储介质可以是只读存储器,磁盘或光盘等。尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。The above mentioned storage medium may be a read only memory, a magnetic disk or an optical disk or the like. Although the embodiments of the present invention have been shown and described, it is understood that the above-described embodiments are illustrative and are not to be construed as limiting the scope of the invention. The embodiments are subject to variations, modifications, substitutions and variations.

Claims (41)

  1. 一种机器人定位方法,其特征在于,机器人上装设有编码器,其中,所述机器人与预定轨道配合,所述预定轨道上设有与所述编码器适配的配合件;所述方法包括:A robot positioning method is characterized in that an encoder is mounted on a robot, wherein the robot cooperates with a predetermined track, and the predetermined track is provided with a fitting matched with the encoder; the method includes:
    控制所述机器人沿着所述预定轨道运动;Controlling the robot to move along the predetermined orbit;
    基于所述编码器获取所述机器人运动的路程;Acquiring a distance of the robot motion based on the encoder;
    当所述编码器满足触发条件时,根据所述配合件的位置信息,对所述路程进行校准;When the encoder meets the trigger condition, the route is calibrated according to the position information of the fitting;
    根据所述编码器的实时路程,确定所述机器人的实时位置。The real-time position of the robot is determined based on the real-time distance of the encoder.
  2. 根据权利要求1所述的方法,其特征在于,所述编码器为正交编码器。The method of claim 1 wherein said encoder is a quadrature encoder.
  3. 根据权利要求2所述的方法,其特征在于,所述编码器满足触发条件,包括:The method according to claim 2, wherein the encoder satisfies a trigger condition, including:
    确定出所述正交编码器被所述配合件遮挡。It is determined that the quadrature encoder is blocked by the mating member.
  4. 根据权利要求2所述的方法,其特征在于,所述编码器满足触发条件,包括:The method according to claim 2, wherein the encoder satisfies a trigger condition, including:
    检测到所述正交编码器产生跳变信号。The quadrature encoder is detected to generate a hopping signal.
  5. 根据权利要求4所述的方法,其特征在于,所述检测到所述正交编码器产生跳变信号,包括:The method according to claim 4, wherein said detecting said quadrature encoder to generate a hopping signal comprises:
    检测到所述正交编码器由低电平跳变至高电平。The quadrature encoder is detected to transition from a low level to a high level.
  6. 根据权利要求1所述的方法,其特征在于,所述编码器为霍尔元件,所述配合件为磁铁。The method of claim 1 wherein said encoder is a Hall element and said mating member is a magnet.
  7. 根据权利要求6所述的方法,其特征在于,所述编码器满足触发条件,包括:The method according to claim 6, wherein the encoder satisfies a trigger condition, including:
    确定出所述霍尔元件与所述磁铁相对准。It is determined that the Hall element is in alignment with the magnet.
  8. 根据权利要求6所述的方法,其特征在于,所述编码器满足触发条件,包括:The method according to claim 6, wherein the encoder satisfies a trigger condition, including:
    检测到所述霍尔元件产生跳变信号。The Hall element is detected to generate a hopping signal.
  9. 根据权利要求8所述的方法,其特征在于,所述检测到所述霍尔元件产生跳变信号,包括:The method of claim 8 wherein said detecting said Hall element to generate a hopping signal comprises:
    检测到所述霍尔元件由低电平跳变至高电平。The Hall element is detected to transition from a low level to a high level.
  10. 根据权利要求1所述的方法,其特征在于,所述根据所述配合件的位置信息,对所述路程进行校准,包括:The method according to claim 1, wherein the calibrating the route according to the position information of the fitting comprises:
    根据所述路程和所述配合件的位置信息,确定误差修正值;Determining an error correction value according to the distance and the position information of the fitting;
    根据所述误差修正值,对所述路程进行修正。The path is corrected based on the error correction value.
  11. 根据权利要求1所述的方法,其特征在于,所述控制所述机器人沿着所述预定轨道运动,包括:The method of claim 1 wherein said controlling said robot to move along said predetermined orbit comprises:
    控制所述机器人由所述预定轨道的特定位置开始沿着所述预定轨道运动。Controlling the robot to move along the predetermined orbit from a particular position of the predetermined track.
  12. 根据权利要求11所述的方法,其特征在于,所述配合件的位置信息是指所述配合件与所述特定位置之间的距离。The method according to claim 11, wherein the positional information of the fitting member refers to a distance between the fitting member and the specific position.
  13. 根据权利要求11所述的方法,其特征在于,所述预定轨道根据预设规则沿长度方向上划分为多段;The method according to claim 11, wherein the predetermined track is divided into a plurality of segments along a length direction according to a preset rule;
    所述特定位置位于所述多段轨道中特定段轨道上,所述配合件设于所述特定段轨道的指定位置。The specific location is located on a particular segment of the plurality of segments of the track, and the mating member is disposed at a designated location of the particular segment of the track.
  14. 根据权利要求13所述的方法,其特征在于,所述特定位置为所述特定段轨道的端部位置,所述指定位置为所述特定段轨道的中部位置。The method of claim 13 wherein said particular location is an end location of said particular segment of track and said designated location is a central location of said particular segment of orbit.
  15. 根据权利要求13所述的方法,其特征在于,所述预设规则包括:The method according to claim 13, wherein the preset rule comprises:
    根据所述预定轨道的形状,对所述预定轨道沿长度方向进行划分。The predetermined track is divided along the length direction according to the shape of the predetermined track.
  16. 根据权利要求13所述的方法,其特征在于,所述控制所述机器人由所述预定轨道的特定位置开始沿着所述预定轨道运动之前,还包括:The method according to claim 13, wherein before the controlling the robot to start moving along the predetermined orbit from a specific position of the predetermined track, the method further comprises:
    获取各段轨道的长度。Get the length of each track.
  17. 根据权利要求16所述的方法,其特征在于,所述获取各段轨道的长度,包括:The method according to claim 16, wherein the obtaining the length of each segment of the track comprises:
    控制所述机器人沿着各段轨道运行;Controlling the robot to run along each segment of the track;
    基于所述编码器检测各段轨道的长度。The length of each segment of the track is detected based on the encoder.
  18. 根据权利要求17所述的方法,其特征在于,所述根据所述编码器的实时路程,确定所述机器人的实时位置,包括:The method according to claim 17, wherein the determining the real-time location of the robot according to the real-time path of the encoder comprises:
    根据所述编码器的实时路程、各段轨道的长度以及所述特定位置的位置信息,确定所述机器人的实时位置。The real-time position of the robot is determined according to the real-time path of the encoder, the length of each track, and the position information of the specific position.
  19. 根据权利要求1所述的方法,其特征在于,所述控制所述机器人沿着所述预定轨道运动,包括:The method of claim 1 wherein said controlling said robot to move along said predetermined orbit comprises:
    控制所述机器人沿着所述预定轨道的特定区域范围往返运动。The robot is controlled to reciprocate along a particular range of the predetermined track.
  20. 根据权利要求19所述的方法,其特征在于,所述特定区域范围为整个轨道。The method of claim 19 wherein said specific area ranges from the entire track.
  21. 一种机器人定位装置,其特征在于,包括均装设于所述机器人上的编码器和处理器,其中,所述编码器与所述处理器电连接,所述机器人与预定轨道配合,所述预定轨道上设有与所述编码器适配的配合件;A robot positioning device, comprising: an encoder and a processor each mounted on the robot, wherein the encoder is electrically connected to the processor, and the robot cooperates with a predetermined track, a fitting member adapted to the encoder is provided on the predetermined track;
    所述处理器包括一个或多个,单独地或共同地工作;所述处理器用于:The processor includes one or more, operating separately or collectively; the processor is configured to:
    控制所述机器人沿着所述预定轨道运动;Controlling the robot to move along the predetermined orbit;
    基于所述编码器获取所述机器人运动的路程;Acquiring a distance of the robot motion based on the encoder;
    当所述编码器满足触发条件时,根据所述配合件的位置信息,对所述路程进行校准;When the encoder meets the trigger condition, the route is calibrated according to the position information of the fitting;
    根据所述编码器的实时路程,确定所述机器人的实时位置。The real-time position of the robot is determined based on the real-time distance of the encoder.
  22. 根据权利要求21所述的装置,其特征在于,所述编码器为正交编码器。The apparatus of claim 21 wherein said encoder is a quadrature encoder.
  23. 根据权利要求22所述的装置,其特征在于,所述处理器确定编码器满足触发条件,包括:The apparatus according to claim 22, wherein the processor determines that the encoder satisfies a trigger condition, and includes:
    确定出所述正交编码器被所述配合件遮挡。It is determined that the quadrature encoder is blocked by the mating member.
  24. 根据权利要求22所述的装置,其特征在于,所述处理器确定编码器满足触发条件,包括:The apparatus according to claim 22, wherein the processor determines that the encoder satisfies a trigger condition, and includes:
    检测到所述正交编码器产生跳变信号。The quadrature encoder is detected to generate a hopping signal.
  25. 根据权利要求24所述的装置,其特征在于,所述处理器检测到所述正交编码器产生跳变信号,包括:The apparatus according to claim 24, wherein said processor detects that said quadrature encoder generates a hopping signal, comprising:
    检测到所述正交编码器由低电平跳变至高电平。The quadrature encoder is detected to transition from a low level to a high level.
  26. 根据权利要求21所述的装置,其特征在于,所述编码器为霍尔元件,所述配合件为磁铁。The device according to claim 21, wherein said encoder is a Hall element and said mating member is a magnet.
  27. 根据权利要求26所述的装置,其特征在于,所述处理器确定编码器满足触发条件,包括:The apparatus according to claim 26, wherein said processor determines that the encoder satisfies a trigger condition, and comprises:
    确定出所述霍尔元件与所述磁铁相对准。It is determined that the Hall element is in alignment with the magnet.
  28. 根据权利要求26所述的装置,其特征在于,所述处理器确定编码器满足触发条件,包括:The apparatus according to claim 26, wherein said processor determines that the encoder satisfies a trigger condition, and comprises:
    检测到所述霍尔元件产生跳变信号。The Hall element is detected to generate a hopping signal.
  29. 根据权利要求28所述的装置,其特征在于,所述处理器检测到所述霍尔元件产生跳变信号,包括:The apparatus according to claim 28, wherein said processor detects that said Hall element generates a hopping signal, comprising:
    检测到所述霍尔元件由低电平跳变至高电平。The Hall element is detected to transition from a low level to a high level.
  30. 根据权利要求21所述的装置,其特征在于,所述处理器根据所述配合件的位置信息,对所述路程进行校准,包括:The device according to claim 21, wherein the processor calibrates the route according to the location information of the mating component, including:
    根据所述路程和所述配合件的位置信息,确定误差修正值;Determining an error correction value according to the distance and the position information of the fitting;
    根据所述误差修正值,对所述路程进行修正。The path is corrected based on the error correction value.
  31. 根据权利要求21所述的装置,其特征在于,所述处理器用于:The apparatus of claim 21 wherein said processor is operative to:
    控制所述机器人由所述预定轨道的特定位置开始沿着所述预定轨道运动。Controlling the robot to move along the predetermined orbit from a particular position of the predetermined track.
  32. 根据权利要求31所述的装置,其特征在于,所述配合件的位置信息是指所述配合件与所述特定位置之间的距离。The device according to claim 31, wherein the positional information of the fitting member refers to a distance between the fitting member and the specific position.
  33. 根据权利要求31所述的装置,其特征在于,所述预定轨道根据预设规则沿长度方向上划分为多段;The apparatus according to claim 31, wherein the predetermined track is divided into a plurality of segments along a length direction according to a preset rule;
    所述特定位置位于所述多段轨道中特定段轨道上,所述配合件设于所述特定段轨道的指定位置。The specific location is located on a particular segment of the plurality of segments of the track, and the mating member is disposed at a designated location of the particular segment of the track.
  34. 根据权利要求33所述的装置,其特征在于,所述特定位置为所述特定段轨道的端部位置,所述指定位置为所述特定段轨道的中部位置。The apparatus according to claim 33, wherein said specific position is an end position of said specific segment track, and said designated position is a middle position of said specific segment track.
  35. 根据权利要求33所述的装置,其特征在于,所述预设规则包括:The device according to claim 33, wherein the preset rule comprises:
    根据所述预定轨道的形状,对所述预定轨道沿长度方向进行划分。The predetermined track is divided along the length direction according to the shape of the predetermined track.
  36. 根据权利要求33所述的装置,其特征在于,所述处理器在控制所述机器人由所述预定轨道的特定位置开始沿着所述预定轨道运动之前,还用于:The apparatus according to claim 33, wherein said processor is further configured to: before controlling said robot to start moving along said predetermined orbit from said specific position of said predetermined track;
    获取各段轨道的长度。Get the length of each track.
  37. 根据权利要求36所述的装置,其特征在于,所述处理器用于:The apparatus of claim 36 wherein said processor is operative to:
    控制所述机器人沿着各段轨道运行;Controlling the robot to run along each segment of the track;
    基于所述编码器检测各段轨道的长度。The length of each segment of the track is detected based on the encoder.
  38. 根据权利要求37所述的装置,其特征在于,所述处理器用于:The apparatus according to claim 37, wherein said processor is configured to:
    根据所述编码器的实时路程、各段轨道的长度以及所述特定位置的位置信息,确定所述机器人的实时位置。The real-time position of the robot is determined according to the real-time path of the encoder, the length of each track, and the position information of the specific position.
  39. 根据权利要求21所述的装置,其特征在于,所述处理器用于:The apparatus of claim 21 wherein said processor is operative to:
    控制所述机器人沿着所述预定轨道的特定区域范围往返运动。The robot is controlled to reciprocate along a particular range of the predetermined track.
  40. 根据权利要求39所述的装置,其特征在于,所述特定区域范围为整个轨道。The apparatus of claim 39 wherein said specific area ranges from the entire track.
  41. 一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现权利要求1至20任一项所述的机器人定位方法的步骤。A computer readable storage medium having stored thereon a computer program, wherein the program is executed by a processor to implement the steps of the robot positioning method according to any one of claims 1 to 20.
PCT/CN2018/084331 2018-04-25 2018-04-25 Method and apparatus for positioning robot WO2019205001A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2018/084331 WO2019205001A1 (en) 2018-04-25 2018-04-25 Method and apparatus for positioning robot
CN201880011046.XA CN110546462A (en) 2018-04-25 2018-04-25 Robot positioning method and device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2018/084331 WO2019205001A1 (en) 2018-04-25 2018-04-25 Method and apparatus for positioning robot

Publications (1)

Publication Number Publication Date
WO2019205001A1 true WO2019205001A1 (en) 2019-10-31

Family

ID=68294368

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2018/084331 WO2019205001A1 (en) 2018-04-25 2018-04-25 Method and apparatus for positioning robot

Country Status (2)

Country Link
CN (1) CN110546462A (en)
WO (1) WO2019205001A1 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111044080A (en) * 2019-12-30 2020-04-21 珠海市一微半导体有限公司 Calibration parameter acquisition device and method based on optical flow sensor
CN112382088A (en) * 2020-11-10 2021-02-19 苏州艾氪英诺机器人科技有限公司 Vehicle data compensation method and system

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111174785B (en) * 2020-01-19 2023-07-18 广东自来物智能科技有限公司 Cableway shuttle machine positioning system and positioning method
WO2021174391A1 (en) * 2020-03-02 2021-09-10 深圳市大疆创新科技有限公司 Acquisition method and device for game screen, and method and device for controlling photographing device

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070006658A1 (en) * 2005-07-11 2007-01-11 The Boeing Company Ultrasonic inspection apparatus, system, and method
CN103286782A (en) * 2013-06-07 2013-09-11 上海发那科机器人有限公司 Flexible tracking and positioning system and flexible tracking and positioning method of robot
CN106197472A (en) * 2016-09-27 2016-12-07 中信重工开诚智能装备有限公司 A kind of rail mounted robot Distance positioning and mileage calibrating installation and method
CN106708053A (en) * 2017-01-26 2017-05-24 湖南人工智能科技有限公司 Autonomous navigation robot and autonomous navigation method thereof
CN107020757A (en) * 2017-06-02 2017-08-08 福建海源自动化机械股份有限公司 Carbon fibre composite production line and production method
CN107901023A (en) * 2018-01-12 2018-04-13 长沙理工大学 The holder two-dimensional positioning system and localization method of a kind of substation's track machine people

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070006658A1 (en) * 2005-07-11 2007-01-11 The Boeing Company Ultrasonic inspection apparatus, system, and method
CN103286782A (en) * 2013-06-07 2013-09-11 上海发那科机器人有限公司 Flexible tracking and positioning system and flexible tracking and positioning method of robot
CN106197472A (en) * 2016-09-27 2016-12-07 中信重工开诚智能装备有限公司 A kind of rail mounted robot Distance positioning and mileage calibrating installation and method
CN106708053A (en) * 2017-01-26 2017-05-24 湖南人工智能科技有限公司 Autonomous navigation robot and autonomous navigation method thereof
CN107020757A (en) * 2017-06-02 2017-08-08 福建海源自动化机械股份有限公司 Carbon fibre composite production line and production method
CN107901023A (en) * 2018-01-12 2018-04-13 长沙理工大学 The holder two-dimensional positioning system and localization method of a kind of substation's track machine people

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111044080A (en) * 2019-12-30 2020-04-21 珠海市一微半导体有限公司 Calibration parameter acquisition device and method based on optical flow sensor
CN111044080B (en) * 2019-12-30 2023-10-27 珠海一微半导体股份有限公司 Calibration parameter acquisition device and method based on optical flow sensor
CN112382088A (en) * 2020-11-10 2021-02-19 苏州艾氪英诺机器人科技有限公司 Vehicle data compensation method and system

Also Published As

Publication number Publication date
CN110546462A (en) 2019-12-06

Similar Documents

Publication Publication Date Title
WO2019205001A1 (en) Method and apparatus for positioning robot
US10444358B2 (en) Distance measuring apparatus, distance measuring method, and table creating method
JP4228132B2 (en) Position measuring device
JP5653715B2 (en) Laser surveyor
EP2103905A2 (en) Surveying instrument, surveying system, method for detecting measured object, and computer-readable recording medium for detecting measured object
US20090133467A1 (en) Robot Equipped with a Gyro and Gyro Calibration Apparatus, Program, and Method
US7214917B2 (en) Rotating position measuring instrument
WO2014012351A1 (en) Positioning system of mobile robot and positioning method thereof
US20220174267A1 (en) Tof camera calibration device and method
CN111381237B (en) Pipeline train positioning method and system based on laser reflection
JP4525473B2 (en) Mobile robot position control system and position control method
US11703357B2 (en) Method and system for calibrating laser level
JPH1114357A (en) Automatic tracking device of surveying equipment
JP2017062398A (en) Rotation angle detector and laser radar device
US7360314B2 (en) Leveling method and leveling device
WO2019064750A1 (en) Distance measurement device and moving body
US11761764B2 (en) Method and laser tracking system for using laser level to track detector
JP2017187386A (en) Laser range-finder
US20210181349A1 (en) Electronic apparatus and method for controlling thereof
CN113330332A (en) Laser detection device, control method and control device thereof, and terminal
CN108680117B (en) Laser sensor
AU2020330972A1 (en) Improved position accuracy mobile robot printing system
WO2020085311A1 (en) Optical distance measurement device and optical distance measurement method
JPWO2020110801A1 (en) Distance measurement sensor and vehicle lighting equipment, distance measurement method
JP2007212184A (en) Position measuring method and position measuring system of mobile robot

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: 18916716

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 18916716

Country of ref document: EP

Kind code of ref document: A1